JP2017500595A - 正確な車線レベル地図の生成方法 - Google Patents

正確な車線レベル地図の生成方法 Download PDF

Info

Publication number
JP2017500595A
JP2017500595A JP2016521775A JP2016521775A JP2017500595A JP 2017500595 A JP2017500595 A JP 2017500595A JP 2016521775 A JP2016521775 A JP 2016521775A JP 2016521775 A JP2016521775 A JP 2016521775A JP 2017500595 A JP2017500595 A JP 2017500595A
Authority
JP
Japan
Prior art keywords
road
lane
data
particle filter
marker
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.)
Granted
Application number
JP2016521775A
Other languages
English (en)
Other versions
JP6142086B2 (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 JP2017500595A publication Critical patent/JP2017500595A/ja
Application granted granted Critical
Publication of JP6142086B2 publication Critical patent/JP6142086B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G09EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
    • G09BEDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
    • G09B29/00Maps; Plans; Charts; Diagrams, e.g. route diagram
    • G09B29/10Map spot or coordinate position indicators; Map reading aids
    • G09B29/106Map spot or coordinate position indicators; Map reading aids using electronic means
    • 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/20Instruments for performing navigational calculations
    • 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/3807Creation or updating of map data characterised by the type of data
    • G01C21/3815Road data
    • G01C21/3819Road shape data, e.g. outline of a route
    • 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
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V30/00Character recognition; Recognising digital ink; Document-oriented image-based pattern recognition
    • G06V30/40Document-oriented image-based pattern recognition
    • G06V30/42Document-oriented image-based pattern recognition based on the type of document
    • G06V30/422Technical drawings; Geographical maps

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Theoretical Computer Science (AREA)
  • Mathematical Physics (AREA)
  • Business, Economics & Management (AREA)
  • Educational Administration (AREA)
  • Educational Technology (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Artificial Intelligence (AREA)
  • Multimedia (AREA)
  • Traffic Control Systems (AREA)
  • Instructional Devices (AREA)
  • Navigation (AREA)
  • Image Analysis (AREA)

Abstract

本発明は、コース地図情報と、センサ搭載の車両が道路に沿って通過をする間に取得されたライダデータとに基づいて正確な車線レベルの地図を生成する方法に関する。本方法は、パーティクルフィルタリングの対象とされるコース地図データ及びライダデータについてのコンピュータ実装方法を使用して、各車線の中心、車線の数、二輪車用パスの存在及び入口や出口の照明を含めて、正確な車線の推定を生成する。【選択図】図5

Description

本発明は、一般に、正確な地図を生成する方法と装置、より具体的には、道路車線地図を生成する方法と装置に関する。
地図は、印刷又はデジタルのいずれの表示形式においても、一車線として又は狭い間隔の二車線として道路を示す。間隔や線の幅は実際の道路幅に比例する。しかし、これらの地図は、道路にある車線の数又は追加的な出口用車線、二輪車用車線等を示さない。
完全自動操縦システムは、運転手の介入又は他の外部制御なく、例えば、自動運転車や自立走行車のように、道路で車両を操縦するように設計されている。このようなシステムには、車線レベルの情報を高精度で符号化する地図を必要とする。車線レベルの情報は、多くの状況で使用される。例えば、他の車両の行動を予測し、パス(通過)計画にとって円滑な経路を生成し、又は、交差点に適した車両の行動を計画し且つ推論する。
多くの場合、これらの地図は、煩雑な手操作によるアノテーション(注釈)プロセスを介して、又は、試験車両とともに実際に車線を走行することによって又はGPS経路の収集を分析することによってのいずれかで生成される。これらの方法は、アノテーションを介して又は収集のいずれにおいても、膨大な量の手作業を要する。
正確な車線レベルの地図をより少ない準備努力で提供することが望ましい。
本方法は、コンピュータで実行され、道路の道路車線特徴を決定するために、
道路の道路マーカーのライダデータを取得することと、道路地図データにアクセスすることと、道路地図データから道路区分ノードの位置を決定することと、ライダ生成道路車線マーカーデータを、各々の道路区分ノードの位置に対して結びつけることと、及び、道路車線特徴を推定するために、パーティクルフィルタを、道路車線マーカー及び道路区分ノードの位置に対して適用することと、を含める方法に関する。
本方法において、パーティクルフィルタを適用し、通常のパーティクルフィルタ、デュアルパーティクルフィルタ、及び、通常のパーティクルフィルタ及びデュアルパーティクルフィルタのミックスのうち1つを使用することを含む。
本方法において、二輪車用車線及び道路の1つの車線に隣接する道路出口又は入口のうち1つの特徴を推定するために、デュアルパーティクルフィルタを使用することを含む。
本方法において、1つの道路車線から少なくとも1つの別の道路車線への変更、及び2つの隣り合う道路車線から1つの道路車線への変更を検出するために、通常のパーティクルフィルタ及びデュアルパーティクルフィルタのミックスを使用することを含む。
本方法において、ライダデータから道路車線マーカーデータを抽出することを含む。
本方法において、GraphSlamアルゴリズムの使用により前記道路車線マーカーデータを精緻化することを含む。
本方法において、ライダ生成道路車線マーカーデータを、道路区分ノードの位置に対して結びつけることには、各々の地図道路区分ノードの位置を一つずつ生成すること、隣接ノード位置に対する1つのノード位置の角度を計算すること、1つのノード位置に対して側方の線マーカーを検索すること、長方形内にある全ての線区分のセットを形成すること、長方形内にある線区分のセットをフィルタリングすること、車線マーカーに対する線区分をクラスタリングすること、各ノードからの平均オフセット距離を計算すること、車線マーカーを長手方向にグルーピングすること、及び、ライダ生成マーカーデータ及び地図ノードの2値特徴を計算することと、を含む。
本方法において、道路車線特徴の推定に、車線の数、車線の幅及び各車線の中心のうち少なくとも1つを含む。
道路マーカーのライダデータを取得する方法は、GPSロケーター、回転レーザー光線及び反射レーザー光線検出器を車両に搭載すること、車両を道路の1つの車線に沿って移動させること、及び、車両が道路の1つの車線に沿って移動するにつれて、道路の全ての車線上にある反射性道路マーカーから反射されたレーザー光線の強度を検出することと、を含む。
正確な車線レベルの地図を生成する本方法の様々な機能、利点、他の用途は、以下の詳細な説明及び図面を参照してより明確にされる。
開示された方法を実施するコンピュータ装置のブロック図である。 ライダ情報の収集の際に辿る道路コースを図示したものである。 本方法により作成された初期の車線の特徴を図示したものである。 本方法により作成された初期の車線の特徴を図示したものである。 本方法により作成された初期の車線の特徴を図示したものである。 パーティクルフィルタアルゴリズムを使用して実装された道路車線を図示したものである。 デュアルパーティクル機能により作成された道路車線の特徴を図示したものである。 本方法により生成された道路車線の推定を図示したものである。 本方法により生成された道路車線の推定を図示したものである。 本方法により生成された道路車線の推定を図示したものである。 本方法により生成された道路車線の推定を図示したものである。 正確な車線レベルの地図を生成するために、本方法で使用するステップを描いたブロック図である。
正確な車線レベルの地図を生成する本方法は、図1中、ブロック図の形式で示すコンピュータ装置100で実行される。すなわち、コンピュータ装置100は携帯端末、デスクトップ、他の形態をした単一のコンピュータ装置、又は、複数のコンピュータ装置を成しえるものを含めて、いかなるコンピュータ装置であってもよい。コンピュータ装置100の内部にあるCPU102は、情報の操作又は処理が可能な従来の中央処理装置又は他のあらゆる形態の装置、又は複数の装置であってもよい。コンピュータ装置100の内部にあるメモリ104は、ランダムアクセスメモリ装置(RAM)又は他のあらゆる適切な記憶媒体であってもよい。メモリ104は、オペレーティングシステム110及びインストール済みのアプリケーション112を含んでもよい。インストール済みのアプリケーション112は、CPU102に本文中に記載された車線レベルの地図生成方法の実行を許可するプログラムを含む。
コンピュータ装置100は、第2の、追加的な、又は外部の記憶装置114、例えば、メモリカード、フラッシュドライブ、又は他のあらゆる形態のコンピュータ読取可能メディアを含んでもよい。インストール済みのアプリケーション112は、第2記憶装置114の全体又は一部に記憶され、そして処理の必要に応じてメモリ104に読み込まれてもよい。
コンピュータ装置100は、大まかな又はコース地図データの形式で入力116を受け取る。例えば、オープンストリートマップ(OSM)プロジェクト及びセンサから受け取ったコース地図データがある。あるいは、コンピュータ装置100は、3次元のライダ入力118を高精度の車両測位システムを有する車両に取り付けられたセンサから受け取る。
地図データ116及びライダデータ118は、メモリ104及び/又は第2記憶装置114に保存されてもよい。
試験車両搭載センサは、自律型車両システムにおいて一般的に使用され、ライダデータ118を生成する。停止及び動きの予測は、Applanix POS-LV 220の慣性GPS航法システムからくる。このシステムは、停止予測を100Hzで生成する。ライダデータ118は、64本のレーザー光を使用し且つ10Hzで回転するVelodyne HDL-64 Eによる。各ライダ戻り値の3次元位置に加えて、HDL 64Eは8ビットの強度値を測定する。各ライダ回転の適切なサブセットは、Applanixデータにタイムスタンプが押されるので、後述するアルゴリズムの使用で停止車両を精緻化することにより、ライダ位置が精緻化する結果となる。
試験車両は、前方向き高精度色カメラ、前方向きレーダー、GPSアンテナ及び慣性測定ユニット、側方向きレーダー及び車両移動距離情報用の回転エンコーダを含む。
試験車両は、図2の例に見られるように、ルート130沿いを特定の方向に走る。ルート130は、様々な異なる道路を含み、入口及び出口に照明がある多車線の高速道路、2車線の田舎道及び多車線の双方向道路といった道路を含む。
試験用車両は、最低でも1回はルート130沿いの特定の車線を走る。後述するように、近隣の交通量、ポールの反射、車両速度及びその他の要因により非表示又は破壊の可能性がある付加的な道路インジケータを拾いあげ、ライダデータの精度を向上するために、複数回の通過が採用されてもよい。
本方法は、コースが構成されている従来の地図データと、試験車両が道路沿いを1回限り通過することで、正確な道路レベルの情報を生成する複数の推論アルゴリズムによる正確なライダ測定とを組み合わせた推論問題をモデル化したものである。本方法は、コースと正確なライダデータから、車線の数、二輪車用道路、入口及び出口の照明及び車線の数の変化等の有無とともに各車線の中心を生成する。
本方法の第1ステップ130は、図7に示すように、ライダデータにアクセスする。これは図3A及び図7のステップ132に図示する一般的な車線の特徴を生成する。
一貫性のあるデータセットは、Graph Slamアルゴリズムの異型、つまり、ライダデータから速やかに特定される複数の特徴に応じて、車両の経路を最適化するように修正したものを適用して生成される。これらの特徴は、車線マーカー/塗装、カーブ、道路標識及びポールを含む。車線マーカーは、車線の推定に使用する第1センサのデータを構成可能であるので特に重要である。
最初のステップである一貫性のあるデータの生成ステップは、1次元のラプラシアンフィルタを3次元レーザーの各光線の強度(反射)戻り値に適用する。これは、路面とは異なる反射特徴をもつ道路塗装により反応を得る。次に、RANSACアルゴリズムは、各反応に関連付けられた3次元の位置データを使用し適用され、外れ値を除外し、図3A中の3本の線で示す車線の区分特徴を生成する。
Graph Slamアルゴリズム、図7のステップ134は、データ関連付けステップと最適化ステップとの間を繰り返す。データ関連付けステップは、距離に基づく閾値を使用する。各データ関連ステップにおいて、新しい位置は、最適化ステップにより生成する新しい車両の位置に基づく各特徴について計算される。この閾値は、次第に狭くなり、収束するまで繰り返す。Graph Slamアルゴリズムの出力は、精緻化した車両の軌跡であり、図3A及び図7のステップ136に示すライダスキャンデータを再投影するために、後に使用される。
本方法は、Open Street Map(OSM)地図情報といった、従来の弱点のある又はコース地図の情報を利用する。この情報は、大きな位置ずれは数メートルまでに限られ、そして特定の道路における車線の数のデータは含まない。本方法は、ある道路における全ての車線の正確な位置の推定値を測るために、ライダスキャンデータを利用する。
OSM地図データは、図7のステップ138を参照すれば、位置や道路の存在について弱点がある従前のデータとして用いられる。OSM上での道路は、道に沿ったノードの集合{p1,p2, … pn}により定義される。これらのノードは、δo=1メートル間隔で均等に配置される。車線マーカー推定プロセスは、Graph Slamアルゴリズムで使用した車線マーカー/塗装といった同じ特徴を使用し、この特徴は、図7のステップ140において、両端点の3次元の座標により特定した比較的短い(0.5から2メートル)車線区分λの形式をとる。各OSMノードp1に対して、まず、ノードpi+1についての角度θiが算出され、そしてOSMノードの側方にある車線マーカーを探すために検索が実行される。検索は、θiに沿って前進・後進する距離δo/2の複数のベクトル及びθiに対する垂直方向の両方が一定距離であることにより定義される長方形の上で行われる。この直方形の範囲内にある全ての線区分は、
Figure 2017500595
のセットに集められる。このセットは、各区分をθiごとに配列したものに基づいてフィルタにかけられる。その結果、
Figure 2017500595
となる。そして全ての車線区分λは、隔離距離に基づく貪欲法を使用しクラスタ化される。これによるクラスタは、車線マーカーと呼ばれる。各車線マーカーについて、OSMノードpiから平均オフセット距離ziが算出される。このオフセット距離は、図3Bに示すように、パーティクルフィルタ内の特定のOSMノードに関する考察に使用される。
次に、車線マーカーは、貪欲法、長手方向におけるflood-fillアルゴリズムを使用して、長手方向にグループ化される。このステップの目的は、各車線マーカーについて付加的な2値特徴を生成することにある。あるグループ、例えば、重厚、よく塗装された車線に対応するグループの車線マーカーは、田舎又はやや田舎の道では長い長手方向の距離(数十又は数百メートル)にわたっている。一方で、ほかの場合、例えば、破線や多くの交差点を伴うエリアでは、グループの車線マーカーは短く、およそ数メートルである。
これら所定のグループについて、3つの付加的な特徴が計算され、車線の推定にとって有益であることが判明する。最初の2つの2値特徴は、車線マーカーのどちら側(又は両方)に車線が存在するか(例えば、最右の車線マーキングに対しては、右側に車線は存在しない)を符号化して計算される。これらの2値特徴、つまりhas-l 及びhas-rは、車線の区分データ全体をみることにより計算される。車線の区分全体について、車線の数がカウントされ、一方側
Figure 2017500595
にある観察値(zi)が、次にカウントされる。すなわち、
Figure 2017500595
となる。ここで、δcは閾値である。第3の2値変数は、車線マーカーが破線のものについて符号化する。米国で見られる標準的な破線よりも大きな全ての車線は除外される。次に、車線マーカーグループは、離れた距離に位置するものと関連付けられて、類似する方向性をもつ。これらは破線としてマークされる。
図3Cに示す上記の2値特徴は、後述するパーティクルフィルタ用の測定機能の開発において、車線データを読み取るために重要な手がかりを与える。
この領域に対するパーティクルフィルタ化する複数のアプローチが存在する。これらのアプローチは、いくつかの一般的な基本定義とともに、以下概略を説明する。上述した通り、パーティクルフィルタの進化は、OSMノードの構造に基づき、あるOSMノードから次のノードへのフィルタ移動の際に一連のステップを伴う。各パーティクルの状態は、OSMノード(物理的位置と関連付けられている)との関係に基づいている。これを踏まえ、フィルタリング方程式は、推定される地図の状態の基本定義から導き出される。
Figure 2017500595
ここでmは、OSMの道路上n番目のノードに位置する推定の車線の数であり、
Figure 2017500595
は、推定の車線の状態である。各車線の状態は、OSMノードからの車線のオフセット及び車線の幅
Figure 2017500595
である。観測値znを使用→車線マーカーは、n番目のOSMノードで観測され、その信念状態は、
Figure 2017500595
である。
再帰ベイズフィルタリングを使用すると、定義する方程式(1)は、
Figure 2017500595
となる。
図7中のステップ142において、パーティクルフィルタを実施するために、p(zn|xn)及びp(zn|xn-1)Bel(xn-1)の値が推定される。全てのアルゴリズムについて、Bel(xn)は、重みmのパーティクルのセットとして表される。
Figure 2017500595
ここでx(i)は、状態(推定車線)のサンプル及びφ(i)は、重要因子又は重みと称される非負変数である。その他の必要な量については、後述するセクションでそれぞれ詳細に説明する。
通常のパーティクルフィルタの実施は、以下の3つのステップに従う:
1.サンプリング:Bel(xn-1)を表す重みづけされたサンプルセットからのサンプル
Figure 2017500595
2.提案分布:
Figure 2017500595
をサンプリングする。パーティクルフィルタの状態は、OSMノードと関連して進化するのみであり、OSM地図は、位置と方向の両方において著しく不正確であるので、xnは、ガウス雑音を
Figure 2017500595
に加えることによりサンプリングされる。
Figure 2017500595
また、
Figure 2017500595
によれば、一対の
Figure 2017500595
が分布される。
3)関数の更新:各サンプルの重みは、以下の分布により更新される。
Figure 2017500595
zn:{l1, l2, … lk}、ここでljは、n番目のノードで観測される車線マーカーである。

Figure 2017500595
について、車線の観測値と関連するデータを実行する。すなわち、
Figure 2017500595
についての関連する車線マーキングを決定する。
観測値から新しく観測された車線のオフセット及び車線の幅を計算する。
Figure 2017500595
以下の方程式を用いて
Figure 2017500595
を計算する。
Figure 2017500595
σo及びσwは、我々のデータに基づく幅と位置に適する特有の標準偏差が選択された変数である。
データの関連付けの間、適切な2値変数has-l 及び has-rがチェックされ、あいまいなデータの関連付けは削除される。(例えば、もしパーティクルの状態が最左にある車線の左にあれば、いずれの車線マーカーとも関連付けられない。)もし、上記のデータの関連付けが失敗すれば、
Figure 2017500595
は、ペナルティ要素γによりペナルティが課される。もし破線の車線マーカーが、周期的に欠落があると考えられるマーカーとして表わされる場合は、このペナルティ要素は緩和される。
自然な道路環境での車線の追加又は出口を改善するため、上述のサンプリングスキームは拡張される。本システム中に更新ごとに導入する新しいパーティクルの割合、新しい変数tが導入される。故に、アルゴリズム1によりサンプリングが実行され、μwが車線の幅と予想される。なお、大きい標準偏差を選択することは、新しく提案した多くのパーティクル(及び付随する計算)が、空間の状態を十分に埋めることを必要とする。さらに、大きな標準偏差をもつことは、データ中のノイズに合致する誤りのあるパーティクルを提案する機会を増加させる。
図4は、図7のステップ144で、OSMノードのうちの1つの推定車線について、通常のパーティクルフィルタの出力を図示する。
Figure 2017500595
通常のパーティクルフィルタを適用するとき、図4に示すように、通常とは異なる形態(例えば、二輪車用車線又は幅広の照明)とともに車線を捉え損ねるといった問題がみられる。一方で、新たなパーティクルの標準偏差を増加することにより、上述の理由から次善の解決となる。パーティクルフィルタリングのデュアル方式は、この問題に改めて取組むために詳述する。上述の通り、デュアルパーティクルフィルタリングの構成では、提案分布及び計測機能の役割は逆になる。それぞれの繰り返しにおいて、新しいパーティクルは、観測値
Figure 2017500595
及び以下の方程式を用いて設定する重要因子の一致に基づいて、サンプリングされる。
Figure 2017500595
そしてアルゴリズムは、
1)提案分布: 新しいパーティクルは、これらの観測値に基づいて提案される。
Zn:{l1, …lk}をn番目のOSMノードで観測される車線マーカーとして、位置j ∈ {1, (k - 1)}は、均一に選択され、そして;
Figure 2017500595
更新関数: 各パーティクルの重要因子は、以前の信念状態Bel(xn-1)を用いて修正される。連続した空間の状態にわたり分散を近似するには、カーネル密度アプローチをとる。従来のパーティクルフィルタで、提案する分散においても、最初にmサンプルが生成される。
Figure 2017500595
Figure 2017500595
は、分散を近似するパラメータ化されたカーネル密度関数を表し、各パーティクルの重要因子は、以下により与えられる。
Figure 2017500595
図5に示すように、デュアルパーティクルフィルタは、通常のパーティクルフィルタでは捉え損えることができなかった非標準的な二輪車用車線の推定が可能である。
純粋なデュアルパーティクルフィルタは、通常ではない車線の形態をとらえることができるが、新しい車線が追加されたり、図6Bに示すように多車線が1つの車線に統合されたりといった状況では失敗する。新しい車線についての提案パーティクルは、前回の分散においては、いずれにも合致することができず、それ故、実質的に重みゼロとなる。上述のアプローチは、通常及びデュアルパーティクルフィルタの両方をミックスして使用し、この問題を解決する。ミックスアプローチでは、変数ミックス比率θ(0 θ 1)が使用され、確率1 - θで通常のパーティクルフィルタ方法を、確率θでデュアルパーティクルフィルタを用いてサンプルを採取する。
さらに、ミックスパーティクルフィルタは、状況情報に基づいてより柔軟なモデリングを可能にさせる。例えば、ミックス比率θは、OSM地図からの構造情報に基づいて変化させることができる。具体的には、車線マーカーの欠落が原因でデュアルパーティクルフィルタの実効性を著しく損なう交差点に近くなるほど、比率は低くなる。
生成された地図は、有限個の車線のみを含め、各々の単一車線の位置及び幅は、図7のステップ144の各OSMノードについて推定する。さらに、これらの車線は、IDを用いて繰返しリンクされるべきである。これは、さらにもう一つの処理ステップを必要とする。上記のパーティクルフィルタは、パーティクルのセットにより表わされるBel(xn|zn)の離散近似をもたらす。この分散は、図4においてみられる分散は複合的であり、モードの数は不明、先天的である。EM法ベースの重み付けクラスタリングアルゴリズムは、最大の後天的モードを検索し、分散に使用する。これらのクラスタの中心は、最後の車線の推定である。このクラスタリングは、xの空間(すなわち、オフセットと幅の両方において)において実行される。
イテレーションの間で一時的なリンクを生成するには、インデックスが、クラスタインデクシングアルゴリズムを用いて各クラスタに割当てられる。
Figure 2017500595
図6A及び図6Bを参照すると、本方法を用いた車線の推定が図示されている。図6A及び図6Bは、田舎道における車線の推定を示す。交差点のデータ欠落があるにも関わらず、2つの道路車線を辿ることに成功している。
図6Cは、破線を伴う高速道路の車線の推定を表示する。図6Dは、多車線の都市道路における車線の推定を図示する。
図6Aから図6Dに示す全ての車線の推定状況において、この方法は、それぞれの道路について車線数のいかなる事前情報を有さない。

Claims (11)

  1. 道路の道路車線特徴を決定する方法であって、
    道路の道路マーカーのライダデータを取得することと、
    道路地図データにアクセスすることと、
    前記地図データから道路区分ノードの位置を決定することと、
    コンピュータによって、前記ライダ生成道路マーカーデータを、前記道路区分ノードの位置に対して結びつけることと、及び、
    道路車線地図用に道路車線特徴の推定を生成するために、パーティクルフィルタを、前記道路区分ノードの位置に対して適用することと、を含む、道路の道路車線特徴を決定する方法。
  2. 請求項1に記載の方法であって、パーティクルフィルタを適用する前記ステップは、
    通常のパーティクルフィルタ、デュアルパーティクルフィルタ、及び、前記通常のパーティクルフィルタ及び前記デュアルパーティクルフィルタのミックスのうち1つを使用することを含む、道路の道路車線特徴を決定する方法。
  3. 請求項2に記載の方法であって、二輪車用車線及び道路の1つの車線に隣接する道路出口又は入口のうち1つの前記特徴を推定するために、前記デュアルパーティクルフィルタを使用することをさらに含む、道路の道路車線特徴を決定する方法。
  4. 請求項3に記載の方法であって、1つの道路車線のうちの1から少なくとも1つの別の道路車線への変更、及び2つの隣り合う道路車線から1つの道路車線への変更を検出するために、前記通常のパーティクルフィルタ及び前記デュアルパーティクルフィルタの前記ミックスを使用することをさらに含む、道路の道路車線特徴を決定する方法。
  5. 請求項2に記載の方法であって、前記ライダデータから道路車線マーカーデータを抽出することをさらに含む、道路の道路車線特徴を決定する方法。
  6. 請求項5に記載の方法であって、GraphSlamの使用により、前記車線マーカーデータを精緻化することをさらに含む、道路の道路車線特徴を決定する方法。
  7. 請求項1に記載の方法であって、前記ライダデータから道路車線マーカーデータを抽出することをさらに含む、道路の道路車線特徴を決定する方法。
  8. 請求項7に記載の方法であって、GraphSlamアルゴリズムの使用により、前記車線マーカーデータを精緻化することをさらに含む、道路の道路車線特徴を決定する方法。
  9. 請求項1に記載の前記方法であって、前記ライダ生成道路車線マーカーデータを、前記道路区分ノードの位置に対して結びつけることは、
    各々の前記地図道路区分ノードの位置を一つずつ生成すること、
    1つのノード位置と隣接ノード位置との間の角度を計算すること、
    前記1つのノード位置に対して側方の線マーカーを検索すること、
    長方形内にある全ての線マーカーのセットを形成すること、
    長方形内にある線マーカーの前記セットをフィルタリングすること、
    各ノードからの平均オフセット距離を計算することにより前記車線マーカーに関連する線区分をクラスタリングすること、
    車線区分を形成するために車線マーカーを長手方向にグルーピングすること、及び、
    関連付けた車線区分を定義するために車線区分特徴を計算することと、を含む、道路の道路車線特徴を決定する方法。
  10. 請求項1に記載の方法であって、前記車線特徴の推定は、車線の前記数、車線の前記幅及び各車線の前記中心のうち少なくとも1つを含む、道路の道路車線特徴を決定する方法。
  11. 請求項1に記載の方法であって、道路マーカーのライダデータを取得する前記ステップは、
    GPSロケーター、及び回転レーザー光線及び反射レーザー光線検出器を車両に搭載すること、
    前記車両を道路の1つの車線に沿って移動させること、及び、
    前記車両が前記道路の1つの車線に沿って移動するにつれて、前記道路の全ての車線上にある反射性道路マーカーから反射されたレーザー光線の強度を検出することと、を含む、道路の道路車線特徴を決定する方法。
JP2016521775A 2013-10-31 2014-10-09 正確な車線レベル地図の生成方法 Active JP6142086B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
US14/069,069 2013-10-31
US14/069,069 US9384394B2 (en) 2013-10-31 2013-10-31 Method for generating accurate lane level maps
PCT/US2014/059955 WO2015065678A1 (en) 2013-10-31 2014-10-09 Method for generating accurate lane level maps

Publications (2)

Publication Number Publication Date
JP2017500595A true JP2017500595A (ja) 2017-01-05
JP6142086B2 JP6142086B2 (ja) 2017-06-07

Family

ID=51794984

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016521775A Active JP6142086B2 (ja) 2013-10-31 2014-10-09 正確な車線レベル地図の生成方法

Country Status (4)

Country Link
US (1) US9384394B2 (ja)
JP (1) JP6142086B2 (ja)
DE (1) DE112014004990B4 (ja)
WO (1) WO2015065678A1 (ja)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20180131154A (ko) * 2017-05-31 2018-12-10 현대엠엔소프트 주식회사 Mms 차량의 고정밀 주행 궤적을 이용한 차선 필터링 및 차선 지도 구축 방법
KR20190080009A (ko) * 2017-12-28 2019-07-08 한국국토정보공사 차선 정보를 이용한 자동 도화 방법
KR20190104304A (ko) * 2019-09-03 2019-09-09 주식회사 모빌테크 점군을 포함하는 라이다 지도 생성 방법
WO2019176043A1 (ja) * 2018-03-15 2019-09-19 パイオニア株式会社 レーン情報生成方法
KR20210060068A (ko) * 2019-11-18 2021-05-26 (주)이노시뮬레이션 육상이동체 시뮬레이션을 위한 정밀도로지도 데이터 처리 및 포맷변경방법
KR20210063720A (ko) * 2019-11-25 2021-06-02 한국교통대학교산학협력단 정밀지도 생성 시스템
KR20210066957A (ko) * 2019-11-28 2021-06-08 한국전자기술연구원 벡터맵을 이용한 라이다 데이터 범위 최적화를 위한 차량 제어 장치 및 방법

Families Citing this family (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9321461B1 (en) * 2014-08-29 2016-04-26 Google Inc. Change detection using curve alignment
US10013508B2 (en) * 2014-10-07 2018-07-03 Toyota Motor Engineering & Manufacturing North America, Inc. Joint probabilistic modeling and inference of intersection structure
US11370422B2 (en) * 2015-02-12 2022-06-28 Honda Research Institute Europe Gmbh Method and system in a vehicle for improving prediction results of an advantageous driver assistant system
JP6082415B2 (ja) * 2015-03-03 2017-02-15 富士重工業株式会社 車両の走行制御装置
DE102015209467A1 (de) * 2015-05-22 2016-11-24 Continental Teves Ag & Co. Ohg Verfahren zur Schätzung von Fahrstreifen
JP2017161363A (ja) * 2016-03-09 2017-09-14 株式会社デンソー 区画線認識装置
US10121367B2 (en) * 2016-04-29 2018-11-06 Ford Global Technologies, Llc Vehicle lane map estimation
JP6874343B2 (ja) * 2016-11-24 2021-05-19 株式会社豊田中央研究所 地図作成装置
US10620310B2 (en) 2016-11-29 2020-04-14 Waymo Llc Rotating radar platform
US10845820B2 (en) 2016-12-30 2020-11-24 DeepMap Inc. Route generation using high definition maps for autonomous vehicles
KR20180088149A (ko) 2017-01-26 2018-08-03 삼성전자주식회사 차량 경로 가이드 방법 및 장치
DE102017209346A1 (de) * 2017-06-01 2019-01-10 Robert Bosch Gmbh Verfahren und Vorrichtung zur Erstellung einer fahrspurgenauen Straßenkarte
CN109084782B (zh) * 2017-06-13 2024-03-12 蔚来(安徽)控股有限公司 基于摄像头传感器的车道线地图构建方法以及构建系统
US10859389B2 (en) * 2018-01-03 2020-12-08 Wipro Limited Method for generation of a safe navigation path for a vehicle and system thereof
US10699565B2 (en) 2018-04-04 2020-06-30 Toyota Motor Engineering & Manufacturing North America, Inc. Systems and methods for inferring lane obstructions
CN108981701B (zh) * 2018-06-14 2022-05-10 广东易凌科技股份有限公司 一种基于激光slam的室内定位和导航方法
US10753750B2 (en) 2018-07-12 2020-08-25 Toyota Research Institute, Inc. System and method for mapping through inferences of observed objects
US11199413B2 (en) * 2018-07-19 2021-12-14 Qualcomm Incorporated Navigation techniques for autonomous and semi-autonomous vehicles
CN110377776B (zh) * 2018-07-23 2022-06-07 北京京东尚科信息技术有限公司 生成点云数据的方法和装置
KR102349159B1 (ko) * 2019-05-21 2022-01-10 엘지전자 주식회사 경로 제공 장치 및 그것의 경로 제공 방법
US11391576B2 (en) * 2019-12-02 2022-07-19 Here Global B.V. System and method for generating map data of a region
CN111189449B (zh) * 2020-01-21 2023-04-25 杭州大数云智科技有限公司 一种机器人地图构建方法
CN111709322B (zh) * 2020-05-28 2022-09-06 武汉中海庭数据技术有限公司 一种计算车道线置信度的方法及装置
CN112433203B (zh) * 2020-10-29 2023-06-20 同济大学 一种基于毫米波雷达数据的车道线形检测方法
US11796323B2 (en) 2021-03-23 2023-10-24 Here Global B.V. System and method for generating feature line data for a map
US11776282B2 (en) 2021-03-26 2023-10-03 Here Global B.V. Method, apparatus, and system for removing outliers from road lane marking data
DE102021203016A1 (de) 2021-03-26 2022-09-29 Zf Friedrichshafen Ag Verfahren und Vorrichtungen zur Bestimmung von Spurbegrenzungen
US20230021813A1 (en) * 2021-07-21 2023-01-26 Wejo Limited Data product generation and production based on resegmenting and/or merging road segments
US20230194268A1 (en) * 2021-12-20 2023-06-22 Gm Cruise Holdings Llc Longitudinal-limited lane marking localizer

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008021102A (ja) * 2006-07-12 2008-01-31 Toyota Motor Corp 区画線検出装置及び車線検出装置
WO2012119595A1 (de) * 2011-03-04 2012-09-13 Continental Teves Ag & Co. Ohg Begrenzung der aktivierung eines ausweichassistenten

Family Cites Families (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IT1284976B1 (it) 1996-10-17 1998-05-28 Sgs Thomson Microelectronics Metodo per l'identificazione di strisce segnaletiche di corsie stradali
US6047234A (en) 1997-10-16 2000-04-04 Navigation Technologies Corporation System and method for updating, enhancing or refining a geographic database using feedback
US6278942B1 (en) 2000-03-21 2001-08-21 Navigation Technologies Corp. Method and system for providing routing guidance
JP2001289654A (ja) * 2000-04-11 2001-10-19 Equos Research Co Ltd ナビゲーション装置、ナビゲーション装置の制御方法、及びそのプログラムを記録した記録媒体
DE10146744A1 (de) 2001-09-22 2003-04-17 Bosch Gmbh Robert Verfahren und System zum Bereitstellen von Fahrspurempfehlungen
JP4107587B2 (ja) * 2003-12-17 2008-06-25 三菱電機株式会社 車線認識画像処理装置
US7689321B2 (en) * 2004-02-13 2010-03-30 Evolution Robotics, Inc. Robust sensor fusion for mapping and localization in a simultaneous localization and mapping (SLAM) system
JP4377284B2 (ja) 2004-06-02 2009-12-02 株式会社ザナヴィ・インフォマティクス 車載ナビゲーション装置
KR100762507B1 (ko) 2004-09-24 2007-10-02 김민석 수치지도와 LiDAR 자료를 이용한 도시지역 도로의 선형 설계요소 추출 방법 및 그 프로그램을 기록한 컴퓨터로 읽을 수 있는 기록매체
JP2006162409A (ja) 2004-12-07 2006-06-22 Aisin Aw Co Ltd 交差点進出道路のレーン判定装置
JP4682870B2 (ja) 2006-02-24 2011-05-11 株式会社デンソー 運転支援装置
JP5028851B2 (ja) 2006-04-24 2012-09-19 株式会社デンソー 道路情報検出装置及びプログラム
US20080033645A1 (en) 2006-08-03 2008-02-07 Jesse Sol Levinson Pobabilistic methods for mapping and localization in arbitrary outdoor environments
JP4738360B2 (ja) 2007-02-13 2011-08-03 アイシン・エィ・ダブリュ株式会社 レーン判定装置及びレーン判定方法、並びにそれを用いたナビゲーション装置
JP4861851B2 (ja) 2007-02-13 2012-01-25 アイシン・エィ・ダブリュ株式会社 レーン判定装置及びレーン判定方法、並びにそれを用いたナビゲーション装置
JP4886597B2 (ja) * 2007-05-25 2012-02-29 アイシン・エィ・ダブリュ株式会社 レーン判定装置及びレーン判定方法、並びにそれを用いたナビゲーション装置
JP4506790B2 (ja) 2007-07-05 2010-07-21 アイシン・エィ・ダブリュ株式会社 道路情報生成装置、道路情報生成方法および道路情報生成プログラム
US9310210B2 (en) 2007-11-02 2016-04-12 Continental Teves Ag & Co. Ohg Verification of digital maps
CA2705375A1 (en) 2007-11-16 2009-05-22 Tele Atlas B.V. Method of and apparatus for producing lane information
US8364334B2 (en) * 2008-10-30 2013-01-29 Honeywell International Inc. System and method for navigating an autonomous vehicle using laser detection and ranging
DE102009024153A1 (de) 2009-06-05 2010-12-09 Daimler Ag Verfahren zur sukzessiven Prognostizierung eines mit einem Kraftfahrzeug zurückzulegenden wahrscheinlichsten Streckenabschnitts
DE102009029117A1 (de) 2009-09-02 2011-03-03 Robert Bosch Gmbh Verfahren zum Unterstützen eines Fahrbetriebs eines Kraftfahrzeugs sowie Fahrerassistenzvorrichtung
KR101010678B1 (ko) 2010-06-25 2011-01-24 한국항공우주연구원 네비게이션 장치 및 이의 주행 차선 구분 방법
WO2012129424A2 (en) 2011-03-23 2012-09-27 Tk Holdings Inc. Driver assistance system
US9140792B2 (en) * 2011-06-01 2015-09-22 GM Global Technology Operations LLC System and method for sensor based environmental model construction
US9562778B2 (en) 2011-06-03 2017-02-07 Robert Bosch Gmbh Combined radar and GPS localization system
ITTO20111243A1 (it) 2011-12-30 2013-07-01 Magneti Marelli Spa Sistema e procedimento per la stima del percorso stradale piu'probabile per un veicolo in marcia
US9037403B2 (en) * 2013-03-26 2015-05-19 Toyota Motor Engineering & Manufacturing North America, Inc. Intensity map-based localization with adaptive thresholding

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008021102A (ja) * 2006-07-12 2008-01-31 Toyota Motor Corp 区画線検出装置及び車線検出装置
WO2012119595A1 (de) * 2011-03-04 2012-09-13 Continental Teves Ag & Co. Ohg Begrenzung der aktivierung eines ausweichassistenten

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20180131154A (ko) * 2017-05-31 2018-12-10 현대엠엔소프트 주식회사 Mms 차량의 고정밀 주행 궤적을 이용한 차선 필터링 및 차선 지도 구축 방법
KR102384430B1 (ko) 2017-05-31 2022-04-07 현대오토에버 주식회사 Mms 차량의 고정밀 주행 궤적을 이용한 차선 필터링 및 차선 지도 구축 방법
KR20190080009A (ko) * 2017-12-28 2019-07-08 한국국토정보공사 차선 정보를 이용한 자동 도화 방법
KR102035030B1 (ko) * 2017-12-28 2019-10-22 한국국토정보공사 차선 정보를 이용한 자동 도화 방법
WO2019176043A1 (ja) * 2018-03-15 2019-09-19 パイオニア株式会社 レーン情報生成方法
JPWO2019176043A1 (ja) * 2018-03-15 2021-02-18 パイオニア株式会社 レーン情報生成方法
US11859983B2 (en) 2018-03-15 2024-01-02 Pioneer Corporation Lane information generating method
JP7022197B2 (ja) 2018-03-15 2022-02-17 パイオニア株式会社 レーン情報生成方法
KR20190104304A (ko) * 2019-09-03 2019-09-09 주식회사 모빌테크 점군을 포함하는 라이다 지도 생성 방법
KR102083911B1 (ko) * 2019-09-03 2020-03-04 주식회사 모빌테크 점군을 포함하는 라이다 지도 생성 방법
KR102288623B1 (ko) 2019-11-18 2021-08-11 (주)이노시뮬레이션 육상이동체 시뮬레이션을 위한 정밀도로지도 데이터 처리 및 포맷변경방법
KR20210060068A (ko) * 2019-11-18 2021-05-26 (주)이노시뮬레이션 육상이동체 시뮬레이션을 위한 정밀도로지도 데이터 처리 및 포맷변경방법
KR102278307B1 (ko) 2019-11-25 2021-07-15 한국교통대학교산학협력단 정밀지도 생성 시스템
KR20210063720A (ko) * 2019-11-25 2021-06-02 한국교통대학교산학협력단 정밀지도 생성 시스템
KR102276597B1 (ko) 2019-11-28 2021-07-14 한국전자기술연구원 벡터맵을 이용한 라이다 데이터 범위 최적화를 위한 차량 제어 장치 및 방법
KR20210066957A (ko) * 2019-11-28 2021-06-08 한국전자기술연구원 벡터맵을 이용한 라이다 데이터 범위 최적화를 위한 차량 제어 장치 및 방법

Also Published As

Publication number Publication date
DE112014004990B4 (de) 2019-01-10
DE112014004990T5 (de) 2016-07-14
US9384394B2 (en) 2016-07-05
US20150117723A1 (en) 2015-04-30
WO2015065678A1 (en) 2015-05-07
JP6142086B2 (ja) 2017-06-07

Similar Documents

Publication Publication Date Title
JP6142086B2 (ja) 正確な車線レベル地図の生成方法
US9170116B1 (en) Method for generating accurate lane level maps
US10663305B2 (en) Map matched aggregation for K-anonymity in trajectory data
Huval et al. An empirical evaluation of deep learning on highway driving
US10846511B2 (en) Automatic detection and positioning of pole-like objects in 3D
Nedevschi et al. Accurate ego-vehicle global localization at intersections through alignment of visual data with digital map
CN111656135A (zh) 基于高清地图的定位优化
US11590989B2 (en) Training data generation for dynamic objects using high definition map data
Ai et al. Automatic horizontal curve identification and measurement method using GPS data
JP2016075905A (ja) 交差点の構造の接合確率モデリング及び推定
US11927449B2 (en) Using map-based constraints for determining vehicle state
EP3798576A2 (en) Method and apparatus for providing a map matcher tolerant to wrong map features
US11193789B2 (en) Method, apparatus, and computer program product for identifying at-risk road infrastructure
US11335189B2 (en) Method for defining road networks
EP4001843A1 (en) Method, apparatus, and system for creating doubly-digitised maps
CN114518122A (zh) 行车导航方法、装置、计算机设备、存储介质和计算机程序产品
CN113924459A (zh) 用于车辆导航的动态传感器范围检测
Vlachogiannis et al. Intersense: An XGBoost model for traffic regulator identification at intersections through crowdsourced GPS data
Zhang et al. An improved virtual intersection model for vehicle navigation at intersections
Jiang et al. itv: Inferring traffic violation-prone locations with vehicle trajectories and road environment data
Ranacher et al. A model to estimate and interpret the energy-efficiency of movement patterns in urban road traffic
EP3872669A1 (en) Systems and methods for reconstructing a trajectory from anonymized data
EP4012336A2 (en) Method, apparatus, and system for identifying special areas and cleaning-up map data
Magrath et al. Evaluating different methods for determining road grade best suited to advanced bus transportation systems
EP3872519A1 (en) Systems and methods for reconstructing a trajectory from anonymized data

Legal Events

Date Code Title Description
A975 Report on accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A971005

Effective date: 20161025

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20161101

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170119

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: 20170404

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20170508

R150 Certificate of patent or registration of utility model

Ref document number: 6142086

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350