Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP6695866B2 - 測位・マッピング方法及び測位・マッピングシステム - Google Patents
[go: Go Back, main page]

JP6695866B2 - 測位・マッピング方法及び測位・マッピングシステム - Google Patents

測位・マッピング方法及び測位・マッピングシステム Download PDF

Info

Publication number
JP6695866B2
JP6695866B2 JP2017514865A JP2017514865A JP6695866B2 JP 6695866 B2 JP6695866 B2 JP 6695866B2 JP 2017514865 A JP2017514865 A JP 2017514865A JP 2017514865 A JP2017514865 A JP 2017514865A JP 6695866 B2 JP6695866 B2 JP 6695866B2
Authority
JP
Japan
Prior art keywords
positioning
type
sensor
data
lid
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2017514865A
Other languages
English (en)
Other versions
JP2017538915A (ja
Inventor
パウロ、レゼンド
Original Assignee
ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー filed Critical ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー
Publication of JP2017538915A publication Critical patent/JP2017538915A/ja
Application granted granted Critical
Publication of JP6695866B2 publication Critical patent/JP6695866B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G05D1/0248Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means in combination with a laser
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804Creation or updating of map data
    • G01C21/3833Creation or updating of map data characterised by the source of data
    • G01C21/3837Data obtained from a single source
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/4808Evaluating distance, position or velocity data

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Electromagnetism (AREA)
  • Optics & Photonics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)
  • Optical Radar Systems And Details Thereof (AREA)
  • Image Analysis (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Description

本発明は、移動物体を含む環境内で移動機械により使用される測位・マッピング技術に関する。
より具体的には、本発明は、そのような移動機械に適合するための測位・マッピング方法及び測位・マッピングシステムに関する。
本発明は、測位・マッピングシステムを備える移動機械の通過中に環境内に存在する特定の物体が固定される場合に特に有利に適用され得るが、物体はその後に移動されても構わない。
移動機械に搭載される1つ以上のセンサにより供給される情報のみに基づいて環境の地図を構築するために環境内で移動機械(例えば、ロボット又は自動車両)により使用される測位・マッピング方法が知られている。
このタイプの方法は、通常、英語の頭字語SLAM(「同時測位・マッピング(Simultaneous Localization And Mapping)」)によって表される。
視覚センサ(例えば、ビデオカメラ)を使用するこのタイプの方法の一例が国際公開第2004/059,900号パンフレットに記載される。
測位・マッピングアルゴリズムは、通常、環境の固定された部分のみの地図を作成するように設計されており、したがって、移動する物体の位置を、アルゴリズムの実行中に、すなわち、これらの物体の近くで移動機械が通過する最中に記憶しない。
しかしながら、問題は、移動機械の通過中には固定されているが、その後になって移動される場合があり、したがって、地図が作成されるべき固定環境の一部を実際には形成しない物体に関して生じる。
特に、測位・マッピングアルゴリズムは、移動した物体が位置していた領域をその後に通過する最中に、既に地図が作成された環境を認識できず、地図構築プロセスを一からやり直すことになり、これは明らかに効率が悪い。
これに関連して、本発明は、環境内で移動機械により使用される測位・マッピング方法であって、
−移動機械に搭載されるセンサから受けられるデータに基づいて、環境の一領域内に位置される物体のタイプを決定するステップと、
−前記領域に関連する又は決定されたタイプが移動物体タイプであれば前記物体に関連する検出データを考慮に入れることなく、検出データを使用して測位アルゴリズムを実行するステップと、
を備える測位・マッピング方法を提案する。
このように、測位・マッピングアルゴリズムは、長期的に固定される環境の構成要素に基づいて実行される。したがって、そのような方法により構築される地図は、ロバスト性がより高いとともに、容易に再使用できる。これは、地図の構成要素部分が全て同じ環境内の移動機械のその後の通過中に存在するからである。
随意的であり、したがって非限定的な他の特徴によれば、
−センサがライダーセンサである;
−決定する前記ステップは、受けられたデータにおける形状又は署名の認識によって行われる;
−センサがイメージセンサである;
−決定する前記ステップは、受けられたデータにより表される少なくとも1つの画像における形状の認識によって行われる;
−検出データが搭載センサから得られる;
−検出データが前記搭載センサとは別個の他のセンサから得られる;
−測位アルゴリズムは、決定されたタイプが固定物体タイプであれば前記物体を基準点として使用する;
−測位アルゴリズムは、所定の領域に関連する検出データを、前記所定の領域内に位置される物体が移動物体タイプに対応するタイプを伴って検出されない場合に使用する;
−実行される測位アルゴリズムは、例えば構築されている地図のバージョンと搭載センサにより供給される走査データ及び/又は組み込まれる搭載センサにより供給される画像中で検出される対象点との間の一致を探し出し、それにより移動機械の位置を前記地図上で突き止めることもできるようにすることによって環境の地図を構築する;
また、測位・マッピング方法は、
−構築された地図を保存するステップと、
−その後に(例えば、構築された地図内に表される環境と似ている隣接環境の検出時に)、測位アルゴリズムによって構築された地図を取り込んで再使用するステップと、
を備えてもよい。
また、本発明は、環境内の移動機械に設けられるべき測位・マッピングシステムであって、移動機械に搭載されるセンサから受けられるデータに基づいて、環境の一領域内に位置される物体のタイプを決定するためのモジュールと、前記領域に関連する又は決定されたタイプが移動物体タイプであれば前記物体に関連する検出データを考慮に入れることなく、検出データに基づいて移動機械の位置を突き止めるようになっている測位モジュールとを備える測位・マッピングシステムも提案する。
また、方法に関して前述した随意的な特徴がこのシステムに適用できてもよい。
典型的な実施形態の詳細な説明
非限定的な例として与えられる添付図面を参照する以下の説明は、本発明の本質及び用途を明らかにする。
本発明に係る測位・マッピングシステムを備える自動車両を示す。 図1の車両が遭遇する場合がある特定の状況の一例を示す。 本発明に係る測位・マッピングシステムの第1の例を概略的に示す。 図3のシステムで使用されるデータのテーブルを示す。 発明に係る測位・マッピングシステムの第2の例を概略的に示す。 本発明に係る測位・マッピング方法の主要なステップを示す。
図1は、測位・マッピングシステムSを備える自動車両Vを示す。
この場合、測位・マッピングシステムSは、マイクロプロセッサベースの処理装置の形態を成して構成される。
この処理装置は、コンピュータプログラム命令を記憶するようになっているメモリ(例えばリードオンリーメモリ又は書換可能な不揮発性メモリ、又は、一般的には任意のランダムアクセスメモリ)を備え、処理装置のマイクロプロセッサによるコンピュータプログラム命令の実行が後述する方法及びプロセスの実行をもたらす。
自動車両Vは、1つ以上の搭載センサ、例えば、ビデオカメラCAMなどの視覚センサ及び/又はレーザ遠隔センサ或いはライダー(lidar)(「光検出及び測距(light detection and ranging)」における頭字語)センサLIDなどの距離センサを備える。
測位・マッピングシステムSは、搭載センサにより生成されるデータINFOCAM,INFOLIDを受けるとともに、自動車両Vが走行する環境の地図Cを構築し且つ構築された地図C内で車両Vの位置を突き止めるためにこれらのデータを処理する。
図2は、車両Vが遭遇する場合がある状況の一例を示す。
この例では、車両Vが双方向道路Rを走行し、双方向道路Rは、車道の両側が歩道TRに隣接した後、歩道TRを越えて家屋Hと隣接する。
車両Vの前方に位置される道路Rの一部には、第三者の車両V’が、道路Rの車道上に部分的に位置し且つ歩道TR上に部分的に位置して駐車される。
図3は、本発明に係る測位・マッピングシステムの第1の例を概略的に示す。この例において、測位・マッピングシステムSは、2つのセンサ(この場合には、ビデオカメラCAM及びライダーセンサLID)により供給されるデータINFOCAM,INFOLIDを使用する。
図3は機能モジュールを示し、各機能モジュールは、測位・処理システムSにより実行される特定のプロセスに対応する。ここに記載される例において、プロセスは、システムSのメモリに記憶されるコンピュータプログラム命令のシステムSのマイクロプロセッサによる実行の結果として前述したように行われる。変形例において、1つ以上の機能モジュールにより行われるプロセスは、専用の集積回路、例えば特定用途向け集積回路(すなわちASIC)によって実行され得る。
図3のシステムは検出モジュール10を備え、検出モジュール10は、第1のセンサ、この場合にはビデオカメラCAMにより生成されるデータINFOCAMを受けて、それぞれの検出された物体OBJごとに、関連する物体の測位に関する情報Lを生成する。測位情報Lは、例えば、システムSのメモリに記憶された図4に概略的に示されるテーブルTABに記憶される。
ここに記載される例において、データINFOCAMは、ビデオカメラCAMによって連続的に撮られる画像に相当し、例えば先の序文で言及された国際公開第2004/059,900号パンフレットに記載されるように、これらの画像の解析によって物体OBJが検出されて自動車両Vに対する物体OBJの位置が突き止められる。
図2の状況において、検出モジュール10は、例えば、第三者の車両V’を物体OBJとして検出し、車両Vに対するその位置(測位情報Lによって規定される)をビデオカメラCAMにより供給される画像の解析によって決定する。
また、図3のシステムは分類モジュール12も備え、分類モジュール12は、第1のセンサ(この場合にはビデオカメラCAM)により生成されるデータINFOCAMと、検出された物体OBJの表示(例えば、ビデオカメラCAMから受けられる画像中の物体の位置を含む)とをその入力で受ける。
分類モジュール12は、第1のセンサから受けられるデータINFOCAMに基づき、例えばデータINFOCAMが画像に相当するここに記載されるケースでは形状認識アルゴリズムを用いて、各物体OBJのタイプTを特定するように設計される。
変形例では、第1のセンサがライダーセンサLIDであってもよく、その場合、物体OBJのタイプの特定は、例えば、物体OBJからの反射によってライダーセンサLIDで受けられる信号の署名に基づいて行われ得る。
物体OBJのタイプTの特定により、様々な物体タイプ(例えば、車両、歩行者、自転車、家屋、道路照明器具又は道路信号器等)間を分類することができ、それにより、この物体OBJが可動タイプなのか又は固定タイプなのかどうかを決定できる。車両Vの通過中に関連する物体が実際に固定されているのか又は移動しているのかどうかにかかわらず物体のタイプにしたがった分類が行われることに留意すべきである。
例えば、図2の状況において、分類モジュール12は、物体OBJ(すなわち、前述したような第三者の車両V’)が車両タイプを成すことを形状認識によって決定する。
物体タイプTは、関連する物体OBJに関して、図4に示されるような前述のテーブルTABに記憶される。変形例において、記憶される情報は、関連する物体OBJの移動性又は固定性の表示に制限することができ、この表示は、前述したように特定されるタイプTに基づいて決定される。
説明を明確にするために、検出モジュール10及び分類モジュール12は2つの別個のモジュールとして説明されてきた。しかしながら、例えばビデオカメラCAMにより供給される画像において形状認識のためのアルゴリズムを用いて同じステップ中に物体OBJの検出と物体のタイプTの特定(移動物体又は固定物体として分類できるようにする)とを行うことができる。
システムSは、第2のセンサ、この場合にはライダーセンサLIDから受けられるデータINFOLIDを受けるフィルタリングモジュール14を備える。また、フィルタリングモジュール14は、検出モジュール10によって検出される各物体OBJの測位情報L及び分類モジュール12により決定される各物体のタイプTiも使用する(この情報は、関連するモジュールから受けられ或いは記憶されたテーブルTABから読み取られてもよい)。
ここに記載される例において、ライダーセンサにより供給されるデータINFOLIDは、例えば、0°〜360°の全角度範囲にわたる角度αとそれぞれ関連付けられる検出距離d(α)の一組の値に相当する。
データINFOLIDの中から、フィルタリングモジュール14は、前述したように検出モジュール及び分類モジュール10,12により生成される情報にしたがって、物体が検出されなかった領域又は物体OBJが固定物体タイプTを伴って検出された領域に対応するデータINFOFIXのみを送信する。言い換えると、フィルタリングモジュール14は、物体OBJが移動物体タイプTを伴って検出された領域に関連するデータINFOFIXを送信しない。
図2の状況において、移動物体タイプT(車両)を伴って検出される物体OBJ(第三者の車両V’)は、測位情報Lにしたがって角度範囲α−αを占め、それにより、移動物体タイプを伴って特定される任意の他の物体がない場合、フィルタリングモジュール14は、角度範囲と関連付けられるデータINFOFIX[0°、α[及び]α、360°[(すなわち、0≦α<α及びα<α<360°に関してのみd(α)の値を表すデータ)のみを送信する。
送信データINFOFIXは、フィルタリングモジュール14によるフィルタリングの後、測位モジュール16によって受けられ、測位モジュール16は、同時測位・マッピングのためのアルゴリズム、例えばITS World Congr.2010におけるJ.Xie、F.Nashashibi、M.N.Parent、及び、O.Garcia−Favrotによる論文「大規模な屋外環境のためのリアルタイムロバストSLAM」に記載されるアルゴリズムの実行のためにこれらのデータINFOFIXを使用する。
測位モジュール16は、第2のセンサ(記載される例ではライダーセンサLID)から得られるデータINFOFIXに基づき、この場合にはフィルタリング後に、先の繰り返しで測位モジュール16により構築された地図Cを使用して、地図C上における車両Vの現在位置(又は定位)LOCを決定するとともに、特に先の繰り返しでライダーセンサにより到達されない領域に関するデータのデータINFOFIX間での存在の結果として、地図Cの質を高めるために用いられてもよい。
しかしながら、物体OBJが移動物体タイプTを伴って検出された領域に関連するデータINFOLIDの(フィルタリングモジュール14による)拒絶に起因して、恒久的に存在する物体に関連するデータのみが測位モジュール16によって処理され、したがって、実際には使いものにならないデータの処理が防止される(それにより処理速度がアップする)一方で、後に移動される場合がある物体を含まない地図の構築も可能になり、すなわち、そのような地図のロバスト性がより高く且つ再利用が容易であることに留意すべきである。
図5は、本発明に係る測位・マッピングシステムの第2の例を概略的に示す。この例において、測位・マッピングシステムSは、単一のセンサ、この場合にはビデオカメラCAMによって供給されるデータDATを使用する。
図3の場合と同様に、図5は機能モジュールを示し、各機能モジュールは、測位・処理システムSにより実行される特定のプロセスに対応し、この場合、プロセスは、システムSのメモリに記憶されるコンピュータプログラム命令のシステムSのマイクロプロセッサによる実行の結果として行われる。変形例において、1つ以上の機能モジュールにより行われるプロセスは、専用の集積回路、例えば特定用途向け集積回路(すなわちASIC)によって実行され得る。
図5のシステムは検出モジュール20を備え、検出モジュール20は、センサにより生成されるデータDAT、この場合にはビデオカメラCAMにより撮られる画像を表すデータを受けて、(この場合には画像解析により)検出されるそれぞれの物体OBJごとに、関連する物体の測位に関する情報Lを生成する。測位情報Lは、例えば、システムSのメモリに記憶された図4に概略的に示されるテーブルTABに記憶される。
図5のシステムは分類モジュール22を備え、分類モジュール22は、センサ(この場合にはビデオカメラCAM)により生成されるデータDATと、検出された物体OBJの表示(例えば、ビデオカメラCAMから受けられる画像中の物体の位置を含む)とをその入力で受ける。
分類モジュール12は、センサから受けられるデータDATに基づき、例えばデータDATが画像に相当するここに記載されるケースでは形状認識アルゴリズムを用いて、各物体OBJのタイプTを特定するように設計される。
図3に関連して前述したように、物体OBJのタイプTの特定は、物体を様々な物体タイプ間で分類できるようにし、それにより、車両Vの通過中に物体が実際には固定されているのか又は移動しているのか否かにかかわらず、この物体OBJが移動タイプなのか又は固定タイプなのかどうかを決定できる。
物体タイプTは、関連する物体OBJに関して、図4に示されるような前述のテーブルTABに記憶される。変形例において、記憶される情報は、関連する物体OBJに関して認識される物体タイプTの移動性又は固定性の表示に制限され得る。
図3に関連して前述したように、変形例では、同じ処理ステップ中に(すなわち、同じ機能モジュールにより)物体OBJの検出と物体のタイプTの特定(移動物体又は固定物体として分類できるようにする)とを行うことができる。
検出モジュール20によって検出されるそれぞれの物体ごとに、測位モジュール26は、この物体OBJの表示、物体の測位情報L、及び、物体の特定されたタイプTを受けるとともに、この情報に基づいて、同時測位・マッピングアルゴリズムを、該アルゴリズムの先の繰り返しで構築された地図Cも使用して行う。
地図Cは例えば基準点(又はそれらが英語で知られているように「ランドマーク」)の組を含み、各基準点は、先の繰り返しで検出された物体に対応する。
測位モジュール26は、関連するタイプTが移動物体タイプに対応しない物体OBJのみを測位モジュールにより行われる処理が考慮に入れるように設計される。例えば、同時測位・マッピングアルゴリズムにおいて物体OBJの測位情報Lを考慮に入れる前に、測位モジュール26は、物体OBJのタイプTを(この場合には、システムSのメモリに記憶されるテーブルTABを調べることにより)チェックし、タイプTが固定物体タイプであって移動物体タイプでなければ、実際にはアルゴリズムにおいて測位情報Lのみを使用する。
そのタイプTが固定物体タイプに対応する物体に関する測位情報Lに基づいて(しかし、そのタイプTが移動物体タイプに対応する物体に関する測位情報Lを考慮せずに)、測位モジュール26は、地図C上における車両Vの現在位置(又は定位)LOCを(一般的には、検出された各物体OBJと地図Cに含まれる基準点とを比較することにより)決定するとともに、地図Cの質を(一般的には、任意の基準点に対応しない検出された物体OBJを地図Cに加えて、それぞれの物体が完成した地図C中で新たな基準点を形成するようにすることによって)高める。
測位・マッピングシステムの第1の例に関連して前述したように、構築された地図Cはロバスト性が高く且つ容易に再利用可能である。これは、地図が移動に晒されない物体に基づいて構築されるからである。
図6は、本発明に係る測位・マッピング方法の主要なステップを示す。
この方法は、ステップE30から始まり、すなわち、車両V内の搭載センサ、この場合にはビデオカメラCAM又はライダーセンサLIDによって生成されるデータを受けることにより始まる。
方法は、ステップE30で車載センサから受けられるデータを解析することにより車両Vが走行する環境に存在する物体を検出するステップE32によって続く。このステップは、前述した例では、検出モジュール10,20によって実行される。
方法は、その後、E32で検出されたそれぞれの物体ごとに、ステップE30で搭載センサから受けられるデータに基づき、例えば形状認識アルゴリズムを用いることにより(搭載センサから受けられるデータが画像に相当する場合)、或いは、署名認識アルゴリズムを用いることにより(搭載センサから受けられるデータが信号に相当する場合)関連する物体のタイプを決定するステップE34を備える。このステップは、前述した例では、分類モジュール12,22によって実行される。
変形例では、必要に応じて異なるセンサから得られるデータをマージするステップの後、複数のセンサから得られるデータを使用して、物体をそれらのタイプにしたがって分類できることに留意すべきである。
2つのセンサがそれぞれ物体を分類するための、移動機械の測位のためのものである場合には、図3を参照して上述した第1の例と同様に、方法は、第2のセンサにより生成されたデータを受信するステップE36を有している。
方法は、その後、必要に応じて、ステップE34で決定されるそのタイプが移動物体タイプである物体に関連するデータ又は物体が移動物体タイプに対応する(ステップE34で決定される)タイプを伴って検出された環境の領域に関連するデータを拒絶するために、ステップE36で受けられるデータをフィルタリングするステップE38を含んでもよい。図3に関連して前述した第1の例で使用されるフィルタリングモジュール14がこの種のステップを実行する。
変形例では、図5に関連して説明された第2の例の場合と同様に、方法は特にフィルタリングステップを含まず、この場合、後述する測位ステップは、ステップE34で決定されるそのタイプが移動物体タイプである物体に関連するデータ又は物体が移動物体タイプに対応する(ステップE34で決定される)タイプを伴って検出された環境の領域に関連するデータを考慮に入れることなく作用するようになっている。
方法は、ステップE30で受けられるデータ及び/又はステップE36で受けられるデータ(そのようなステップが実行される場合)であってもよい検出データに基づいて及び方法の先の繰り返しで構築された地図に基づいて移動機械(この場合には自動車両V)の位置を突き止めるステップE40により続く。
このステップE40は、同時測位・マッピングアルゴリズムの実行を備え、それにより、機械の位置を突き止めることができるだけでなく、地図の質を高めることもできる。
前述したように、必要に応じて異なるセンサから得られるデータをマージするステップの後に、測位・マッピングアルゴリズムによって使用されるデータが複数の搭載センサから得られてもよいことに留意すべきである。
この場合、通常、方法は、その後の瞬間に、ステップE30〜E40の新たな繰り返しの実行のために元のステップE30に戻るようにする。
前述したプロセス中に構築された地図は、その後に、例えば暫く経ってから(例えば、別の日に、地図が構築された日の後)環境内で移動機械(この場合には自動車両V)が通過する最中にそれを再使用できるように恒久的に維持される。
この目的のため、測位・マッピングシステムSは、例えば、構築されている地図と既に構築された(及び記憶された)地図とをそれらの再使用を視野に入れて比較するための機構を組み込む。したがって、移動機械が再び前記した暫く経った後に同じ環境内で走行する場合、比較機構は、隣接する環境を既に構築された地図で表される環境として認識するために及び既に構築された地図を(この地図をメモリに取り込んでそれを測位・マッピングアルゴリズムで使用することにより)用いるために使用されてもよい。
比較機構は、記憶されたカードが前述した方法により構築された場合に特にうまく動作する。これは、この種の地図が固定されたままである物体に関連する情報のみを含み且つその後の通過中にもはや存在しない物体に関連する情報を含まないからである。このように、本発明は、移動機械の測位のために長期的に使用され得るマッピングを提供する。

Claims (11)

  1. 環境内で移動機械(V)により使用される測位・マッピング方法であって、
    −前記移動機械(V)に搭載されるセンサ(CAM)から受けられるデータ(INFOCAM;DAT)に基づいて、前記環境の一領域内に位置される物体(OBJ)のタイプ(T)を決定するステップ(E34)と、
    −前記領域に関連する又は決定されたタイプ(T)が移動物体タイプであれば前記物体(OBJ)に関連する検出データ(INFOLID;DAT)を考慮に入れることなく、検出データ(INFOLID;DAT)を使用して測位アルゴリズムを実行するステップ(E40)と、
    を備え
    前記検出データ(INFO LID )が前記搭載センサ(CAM)とは別個の他のセンサ(LID)から得られる測位・マッピング方法。
  2. 前記他のセンサ(LID)がライダーセンサである請求項1に記載の方法。
  3. 決定する前記ステップは、受けられたデータにおける形状の認識によって行われる請求項2に記載の方法。
  4. 前記センサ(CAM)がイメージセンサである請求項1に記載の方法。
  5. 決定する前記ステップは、受けられたデータ(INFOCAM)により表される少なくとも1つの画像における形状の認識によって行われる請求項4に記載の方法。
  6. 前記検出データ(DAT)が前記搭載センサ(CAM)から得られる請求項1から5のいずれか一項に記載の方法。
  7. 前記測位アルゴリズムは、決定されたタイプ(T)が固定物体タイプであれば前記物体(OBJ)を基準点として使用する請求項1からのいずれか一項に記載の方法。
  8. 前記測位アルゴリズムは、所定の領域に関連する検出データ(INFOLID)を、前記所定の領域内に位置される物体が移動物体タイプに対応するタイプを伴って検出されない場合に使用する請求項1からのいずれか一項に記載の方法。
  9. 実行される前記測位アルゴリズムが前記環境の地図(C)を構築する請求項1からのいずれか一項に記載の方法。
  10. −構築された地図(C)を保存するステップと、
    −その後に、前記測位アルゴリズムによって構築された地図(C)を取り込んで再使用するステップと、
    を備える請求項に記載の方法。
  11. 環境内で移動機械(V)に取り付けられるべき測位・マッピングシステム(S)であって、
    −前記移動機械(V)に搭載されるセンサ(CAM)から受けられるデータ(INFOCAM;DAT)に基づいて、前記環境の一領域内に位置される物体(OBJ)のタイプ(T)を決定するためのモジュール(12;22)と、
    −前記領域に関連する又は決定されたタイプ(T)が移動物体タイプであれば前記物体(OBJ)に関連する検出データを考慮に入れることなく、検出データ(INFOLID;DAT)に基づいて前記移動機械(V)の位置を突き止めるようになっている測位モジュール(16;26)と、
    を備え
    前記検出データ(INFO LID )が前記搭載センサ(CAM)とは別個の他のセンサ(LID)から得られる測位・マッピングシステム(S)。
JP2017514865A 2014-09-17 2015-09-17 測位・マッピング方法及び測位・マッピングシステム Active JP6695866B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
FR1402084A FR3025898B1 (fr) 2014-09-17 2014-09-17 Procede et systeme de localisation et de cartographie
FR14/02084 2014-09-17
PCT/EP2015/071378 WO2016042106A1 (fr) 2014-09-17 2015-09-17 Procédé et système de localisation et de cartographie

Publications (2)

Publication Number Publication Date
JP2017538915A JP2017538915A (ja) 2017-12-28
JP6695866B2 true JP6695866B2 (ja) 2020-05-20

Family

ID=52423753

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017514865A Active JP6695866B2 (ja) 2014-09-17 2015-09-17 測位・マッピング方法及び測位・マッピングシステム

Country Status (6)

Country Link
US (1) US20170254651A1 (ja)
EP (1) EP3195077B1 (ja)
JP (1) JP6695866B2 (ja)
CN (1) CN107003671B (ja)
FR (1) FR3025898B1 (ja)
WO (1) WO2016042106A1 (ja)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11670180B2 (en) * 2016-06-10 2023-06-06 Metal Raptor, Llc Obstruction detection in air traffic control systems for passenger drones
US11670179B2 (en) * 2016-06-10 2023-06-06 Metal Raptor, Llc Managing detected obstructions in air traffic control systems for passenger drones
FR3057693B1 (fr) * 2016-10-13 2022-04-15 Valeo Schalter & Sensoren Gmbh Dispositif de localisation et dispositif de production de donnees d'integrite
US10339708B2 (en) 2016-11-01 2019-07-02 Google Inc. Map summarization and localization
DE102017215868A1 (de) * 2017-09-08 2019-03-14 Robert Bosch Gmbh Verfahren und Vorrichtung zum Erstellen einer Karte
CN112204349B (zh) * 2018-04-03 2024-10-18 御眼视觉技术有限公司 用于车辆导航的系统和方法
DE102018208182A1 (de) 2018-05-24 2019-11-28 Robert Bosch Gmbh Verfahren und Vorrichtung zum Ausführen wenigstens einer sicherheitssteigernden Maßnahme für ein Fahrzeug
WO2020091111A1 (ko) * 2018-11-01 2020-05-07 엘지전자 주식회사 차량용 전자 장치, 차량용 전자 장치의 동작 방법 및 시스템
JP7180399B2 (ja) * 2019-01-18 2022-11-30 株式会社豊田自動織機 走行制御装置
GB201909556D0 (en) * 2019-07-03 2019-08-14 Tomtom Traffic Bv Collecting user-contributed data relating to a navibable network
DE102019220616B4 (de) * 2019-12-30 2022-03-24 Automotive Research & Testing Center Verfahren zur simultanen lokalisierung und abbildung
JP7707958B2 (ja) * 2022-02-21 2025-07-15 コニカミノルタ株式会社 補正システム、補正方法、および補正プログラム

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07191743A (ja) * 1993-12-27 1995-07-28 Toshiba Corp 移動経路生成方法
DE19749086C1 (de) * 1997-11-06 1999-08-12 Daimler Chrysler Ag Vorrichtung zur Ermittlung fahrspurverlaufsindikativer Daten
JP4978099B2 (ja) * 2006-08-03 2012-07-18 トヨタ自動車株式会社 自己位置推定装置
CN100483283C (zh) * 2007-08-01 2009-04-29 暨南大学 一种基于机器视觉的二维定位装置
KR101572851B1 (ko) * 2008-12-22 2015-11-30 삼성전자 주식회사 동적 환경에서 모바일 플랫폼의 지도 작성방법
JP5141644B2 (ja) * 2009-06-23 2013-02-13 トヨタ自動車株式会社 自律移動体、自己位置推定装置、およびプログラム
CN101839722A (zh) * 2010-05-06 2010-09-22 南京航空航天大学 一种中低空下目标自动识别及载体高精度定位方法
CN102591332B (zh) * 2011-01-13 2014-08-13 同济大学 用于无人驾驶汽车局部路径规划的装置及方法
CN202033665U (zh) * 2011-04-12 2011-11-09 中国科学院沈阳自动化研究所 轨道式自主移动机器人
WO2013076829A1 (ja) * 2011-11-22 2013-05-30 株式会社日立製作所 自律移動システム
JP5429901B2 (ja) * 2012-02-08 2014-02-26 富士ソフト株式会社 ロボット及び情報処理装置のプログラム
JP5817611B2 (ja) * 2012-03-23 2015-11-18 トヨタ自動車株式会社 移動ロボット
AU2012376428B2 (en) * 2012-04-05 2015-06-25 Hitachi, Ltd. Map data creation device, autonomous movement system and autonomous movement control device
CN102968121B (zh) * 2012-11-27 2015-04-08 福建省电力有限公司 一种沿轨道行驶定位装置
JP2014203429A (ja) * 2013-04-10 2014-10-27 トヨタ自動車株式会社 地図生成装置、地図生成方法及び制御プログラム

Also Published As

Publication number Publication date
US20170254651A1 (en) 2017-09-07
EP3195077B1 (fr) 2021-04-14
JP2017538915A (ja) 2017-12-28
EP3195077A1 (fr) 2017-07-26
FR3025898A1 (fr) 2016-03-18
CN107003671B (zh) 2021-04-16
CN107003671A (zh) 2017-08-01
WO2016042106A1 (fr) 2016-03-24
FR3025898B1 (fr) 2020-02-07

Similar Documents

Publication Publication Date Title
JP6695866B2 (ja) 測位・マッピング方法及び測位・マッピングシステム
US11003921B2 (en) Apparatus and method for distinguishing false target in vehicle and vehicle including the same
JP5399027B2 (ja) 自動車の運転を支援するための、立体画像を捕捉することができるシステムを有するデバイス
CN109478324B (zh) 图像处理装置、外界识别装置
JP5594246B2 (ja) 車線認識装置
JP4973736B2 (ja) 路面標示認識装置,路面標示認識方法及び路面標示認識プログラム
JP5917697B2 (ja) 車両のフロントガラス上の雨滴を検出するための方法およびカメラアセンブリ
JP5480917B2 (ja) 車両周辺監視装置
JP6910452B2 (ja) より高度に自動化された、例えば、高度自動化車両(haf)をデジタル式位置特定マップで位置特定するための方法
CN106415690A (zh) 求得运行机动车车辆系统时使用的位置数据的方法及位置数据求得和分配系统
US20150220796A1 (en) Sign recognition apparatus and method for determining left- or right-hand traffic division and distance unit
JP6411933B2 (ja) 車両状態判定装置
CN115100628B (zh) 一种自动驾驶车辆的障碍物识别方法及装置
Kim et al. Algorithm & SoC design for automotive vision systems: for smart safe driving system
JP5997962B2 (ja) 車載レーンマーカ認識装置
JP5962442B2 (ja) 標識認識システム、標識認識方法、及び標識認識プログラム
CN115546744A (zh) 使用dbscan进行车道检测
JP2011103058A (ja) 誤認識防止装置
CN113591673A (zh) 用于识别交通标志的方法和设备
JP7529462B2 (ja) 機械学習に基づく運転支援システムの検出能力を改善する方法およびシステム
CN110942668B (zh) 图像处理系统、图像处理方法和图像处理设备
EP3287940A1 (en) Intersection detection system for a vehicle
CN118843892A (zh) 通过比较传感器数据与期望较高安全完整性地识别情景的特性
EP2851840B1 (en) Vision system and vision method for a motor vehicle
WO2016050377A1 (en) Perspective transform of mono-vision image

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180817

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190807

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190820

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191101

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20200331

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200422

R150 Certificate of patent or registration of utility model

Ref document number: 6695866

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250