JP2021111366A - 静的及び動的オブジェクトを含む確率的フリー空間地図を作成するための方法 - Google Patents

静的及び動的オブジェクトを含む確率的フリー空間地図を作成するための方法 Download PDF

Info

Publication number
JP2021111366A
JP2021111366A JP2020202006A JP2020202006A JP2021111366A JP 2021111366 A JP2021111366 A JP 2021111366A JP 2020202006 A JP2020202006 A JP 2020202006A JP 2020202006 A JP2020202006 A JP 2020202006A JP 2021111366 A JP2021111366 A JP 2021111366A
Authority
JP
Japan
Prior art keywords
predicted
predicted time
free space
static
dynamic
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.)
Pending
Application number
JP2020202006A
Other languages
English (en)
Inventor
フランク・エドリング
Edling Frank
マルクス・ルクス
Lux Markus
ハーゲン・シュテュビング
Stuebing Hagen
グンナー・ユルゲンス
Juergens Gunnar
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Continental Automotive GmbH
Original Assignee
Continental Automotive GmbH
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 Continental Automotive GmbH filed Critical Continental Automotive GmbH
Publication of JP2021111366A publication Critical patent/JP2021111366A/ja
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • B60W60/00276Planning or execution of driving tasks using trajectory prediction for other traffic participants for two or more other traffic participants
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • B60W60/00272Planning or execution of driving tasks using trajectory prediction for other traffic participants relying on extrapolation of current movement
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/167Driving aids for lane monitoring, lane changing, e.g. blind spot detection
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • B60W60/00274Planning or execution of driving tasks using trajectory prediction for other traffic participants considering possible movement changes
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/01Detecting movement of traffic to be counted or controlled
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions
    • G08G1/0962Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0967Systems involving transmission of highway information, e.g. weather, speed limits
    • G08G1/096708Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control
    • G08G1/096725Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control where the received information generates an automatic action on the vehicle control
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/165Anti-collision systems for passive traffic, e.g. including static obstacles, trees
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/20Static objects
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4041Position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4049Relationship among other objects, e.g. converging dynamic objects

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Human Computer Interaction (AREA)
  • General Physics & Mathematics (AREA)
  • Physics & Mathematics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Atmospheric Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Traffic Control Systems (AREA)
  • Instructional Devices (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

【課題】改善された確率的フリー空間マップ作成方法を提供する。【解決手段】確率的フリー空間マップ作成方法は、既存の周辺モデルから静的オブジェクト2a,2b,3と認識領域ポリゴンWPを呼び出すステップ、動的オブジェクトV1−V7の予測された軌道T1,T2を集めるステップ、静的オブジェクト、認識領域ポリゴン及び予測された軌道を一枚のマップに統合するステップ、最長予測時間を設定するステップ、予測時間ステップを設定するステップ、最新の予測時間を設定し、設定された予測期間のスタート時点を設定するために、該最新の予測時間の値を0にセットするステップ、信頼性領域を静的及び動的オブジェクトの周りに設定するステップ、少なくとも一つの静的乃至動的オブジェクトの周りに少なくとも一つの不確実な領域を設定するステップ、最新の予測時間用に第一確率的フリー空間マップを作成するステップ、を含む。【選択図】図1

Description

本発明は、走行機能の確立に基づく反応に関わる、静的及び動的オブジェクトを含む確率的フリー空間マップを作成するための方法に関する。
従来の技術からは、例えば、アダプティブ速度調整(adaptive cruise control,ACC)とレーン維持アシスタントの組み合わせに基づく所謂「渋滞アシスタント」が既知である。更に昨今、車線変更アシスタントも導入されるようになったが、これは、ドライバーが、能動的に作動させる乃至始動させる必要があるものである。交通情報やレーン情報(オブジェクト)に対する反応は、オブジェクトまでの相対的距離を測定し、(例えば、ACCやレーン維持アシスタントによって)間隔を制御すること、或いは、グリッドセルが占有されている確率に関する情報を有するグリッドマップ(例えば、自動駐車用のデンプスター・シェーファー・グリッドマップ)を作成することのいずれかによって実施されている。
しかし、従来の解決策(占有グリッドマップや自車両に対する相対的なオブジェクトのリスト)は、現時点のフリー空間の状態に関する情報を提供しているに過ぎない。要するに、特定の領域(例えば、グリッドセル)は、「フリーとして測定された」/「占有されているとして測定された」、或いは、「未測定」としてマークされることができる。このようにして得られるその時点における最新のマップは、他の交通参加者の今後の挙動に基づいて予測されるフリーな空間/占有される空間に関する情報は、包含していない。安全、快適、且つ、効率的な走行の実現を目的とし、ある走行ストラテジーを計画する場合、この先ある領域内を動くことが賢明か否かを知らなければならない。
よって、本発明の課題は、改善されたフリー空間マップを作成できる、従来の技術の弱点を克服する方法を提供することにある。
本発明によれば、上記目的は、独立請求項1に記載されている対象によって達成される。更らに、好ましい形態は、従属請求項の対象である。
本質的に、本発明は、周辺捕捉と交通参加者予測における不確実性を回避することを目指している。自律走行では、周辺捕捉の際に、常に、周辺モデル内の不確実な領域が残る。この機能につながれている走行機能にとっての問題は、ドライバーは、タイムリーで穏やかな反応を実施する代わりとして、例えば、質の低い予測機能を有するシステムが取るであろうと思われる挙動を:即ち、典型的なシナリオとしては、「割り込む形で車線変更をする交通参加者が突然認識され、緊急ブレーキが作動する」と言った、緊急的な介入を、容認しないということにある。要するにそのドライバーは、例えば、この様な「割り込む形の車線変更」を数秒前には察知しているであろうことから、該ドライバーは、システムが、穏やかに減速する、或いは、タイムリーに車線変更することを期待しているであろう。本発明の目標は、数秒後になって緊急介入のみが可能になる前に、早期かつ快適に「不確実な領域」に反応することである。ドライバーは、後に必要が無かったことが明らかになろうとも快適な反応(例えば、実際に車線変更があろうがなかろうが、割り込む形での車線変更を可能にするためにブレーキを用いずに軽く減速すること)は、質の低い車線変更の予測に基づいた遅い時点における緊急ブレーキよりも、容認する。
しかしながら、希であっても、セーフティ・クリティカルなケースにおいては、緊急反応は、正当であることから、低い存在確率を有するオブジェクトも無視することはできない。
本発明は、上述の問題を、予測された挙動と予測に包含される不確定要素を含む、確率的フリー空間マップを作成することによって回避することができると言う基本アイデアに基づいている。
よって、本発明に係る、静的及び動的オブジェクトを含む確率的フリー空間マップを作成するための方法は、以下のステップを包含している:
−既存の周辺モデルから静的オブジェクトと認識領域ポリゴンを呼び出すステップ;
−動的オブジェクトの予測された軌道を集めるステップ;
−静的オブジェクト、認識領域ポリゴン及び予測された軌道を一枚のマップに統合するステップ;
−最長予測時間を設定するステップ;
−予測時間ステップを設定するステップ;
−最新の予測時間を設定し、設定された予測期間のスタート時点を設定するために、該最新の予測時間の値を0にセットするステップ;
−信頼性領域を静的及び動的オブジェクトの周りに設定するステップ;
−少なくとも一つの静的乃至動的オブジェクトの周りに少なくとも一つの不確実な領域を設定するステップ;
−最新の予測時間用に第一確率的フリー空間マップを作成するステップ;
−少なくとも一つの予測時間ステップ用に少なくとも一枚の更なるフリー空間マップを作成するステップ;
−作成されたフリー空間マップを評価するステップ
ここにおいて用いられた周辺モデルは、少なくとも二つの周辺センサ、例えばレーダセンサとカメラセンサのセンサデータから、例えばセンサデータ統合法によって生成されたものである。但し、静的なオブジェクトに関しては、保存されている周辺モデル、例えば、意味論的グリッドマップであっても良いが、これらに対応するデータは、GPS及び/或いはランドマーク認識を用いた自車両の自己トラッキングに基づいて呼び出される。保存されている周辺モデルを用いる場合、静的オブジェクトの如何なる変化をも信頼性高く考慮することができるように、規則的に予め定められたサイクルで更新することが好ましい。
該認識領域ポリゴンとは、本発明の範囲においては、自車両の周りのポリゴントラックのことであり、要するに、その時点における最新の360°FOV(Field−of−view)を意味している。このポリゴンに対して影響を与える値としては、センサの到達距離も然り、道路のジオメトリ(カーブや峠など)も挙げられる。
自車両の周りに動的オブジェクトや他の交通参加者が検出された場合、各々の動的オブジェクトに対して一本乃至複数本の軌道が、予測される。各々の軌道の予測は、例えば、移動方向、速度、及び/或いは、加速に基づいて実施される。
これら上記のデータは、後の方法ステップの基となる共通のマップに記入される。
更には、動的オブジェクト乃至他の交通参加者が動き得る軌道を最長どれ程予測できるかを示す最長予測時間も設定される。また、予測時間ステップも設定される。これは、どれ程の間隔で予測が更新されるかを設定できるため、好ましい。即ち、最長予測時間を、例えば10秒として、各々の予測ステップを、例えば0.5秒毎に実施することができる。
予測を開始するためには、先ず、最新の予測時間を設定し、値を0にセットする。この時点からは、予め定められた予測時間ステップ内において複数の予測が、最長予測時間に達するまで、実施される。ここでは、最新の予測時間から、予測時間ステップ毎に、一枚の確率的フリー空間マップが、作成される。各々の予測時間ステップは、最長予測時間に達するまで、最新の予測時間に加算される。最新の予測時間に加えて、静的及び動的オブジェクトの周りに信頼性領域が、設定される。この信頼性領域は、この際、グリッドセル毎に、各々のオブジェクトによって、ある確率をもって占有されていると見ることができる範囲を記述している。付加的に、少なくとも動的オブジェクトの周りには、少なくとも一つの不確実な領域が、設定される。但し、複数の動的オブジェクトに対して、少なくとも一つの不確定な領域を設定することも考え得る。
この不確定な領域は、ここでは、この領域への動きによって、今後、動的オブジェクトによって占有される可能性を有している領域を記述している。また、確率的フリー空間マップも評価される。これは、必要とあれば、後続の走行機能に合わせることができるため好ましい。
予測を実施するためには、例えば、ベイジアン・ネットワークを用いることができる。ある動的オブジェクトやある交通参加者が取り得る一つの軌道の確率を計算するための入力値としては、例えば、周辺部における静的乃至動的オブジェクトの有無、該当する交通参加者の速度、加速、移動方向、及び、道路の推移などが考慮される。更には、天候などの環境ファクタも考慮できるであろう。
ある特に好ましい実施形態においては、予測時間ステップ毎に、フリー空間マップが、最長予測時間に達するまで、作成される。これは、予測時間ステップから次の予測時間ステップまでに、周辺が変化し得るため、有利である。この様にすることで、全ての変化の可能性を捕捉することを確実にできる。
ある特に好ましい実施形態においては、少なくとも一つの不確定な領域が、既存の周辺モデルと動的オブジェクトの軌道予測に基づいて設定される。
ある他の好ましい実施形態においては、少なくとも一つの不確定な領域は、ある動的オブジェクトの少なくとも一本の予測された軌道にそって拡張される。尚、該不確定な領域は、最長予測時間において、全ての予測し得る軌道が、不確定な領域によって少なくとも部分的に覆われるように拡張されることが特に好ましい。これは、予測が、該不確定な領域によって考慮され得る、ある程度の不確実性を、常に有しているため有利である。
但し、不確定な領域は、タイムステップ毎に適合されることが特に好ましい。予測された軌道に沿って不確定性が増すため、予測時間が増すにつれ、不確定な領域も大きくなる。例えば、車両が、前方を走行中の車両に接近すると、時間の増加と間隔の減少により、車線変更の確率が増すため、不確定性も増加する。しかしながら、該車両は、減速することもあり得るため、予測の不確定性にもつながり得る。
また、全対象期間用の確率的フリー空間マップの評価後に、快適性、効率および安全性に関して最適化された自車両の軌道が計画されることも好ましい。そうすることで、不確実性が大きい場合、後になって急激な制動介入や操舵介入を回避するために、自車両の車線変更を、先を見越して実施することも可能になる。そのために、例えば、不確実性のための閾値を設定することが可能である。この閾値を超えた場合、予防的な運転マヌーバが実施される。代案的に、不確定な領域の占有確率を、最適化のためのコスト・ファンクションにおいて直接的に用いる事も可能である。車線変更の代わりに、自車両の減速を予防的な対策とすることも考え得る。
尚、少なくとも一つの走行機能及び/或いは自車両の軌道を、該コスト・ファンクションによって最適化することは、特に好ましい。この様なコスト・ファンクションを用いることにより、自車両の軌道は、例えば、目標速度、前後方向加速や前後方向の揺れ(jolt)、横方向の加速や横方向の揺れ、他の交通参加者に対する間隔、他の交通参加者に対して必要な反応(例えば、急ブレーキ)を達成すると言う観点から、及び、この先、他の交通参加者の占有領域を通過する確率、乃至、後になって快適でない介入を実施する確率と言う観点から最適化される。尚、代案的乃至付加的に、該最適化を、車線維持の正確性や車両のコース角度の車線中央のコース角度に対するずれと言う観点から実施することも考え得る。
ある更なる特に好ましい実施形態においては、軌道の最適化のために認識領域ポリゴンも考慮される。尚、例えば、(右側通行の)アウトバーンの左カーブ内においては、センサ類が十分に先を見越せない道路の最も左縁までは、走行しないことも好ましい。道路縁に突然、例えば、失われたタイヤの一部が落ちていたと言った場合、衝突は、緊急マヌーバによってのみ回避し得る。しかしながら、動的オブジェクトによって覆われている場合の評価は、これとは異なる:ある車両の後方を追走する場合、該車両の前方の領域は、覆われている可能性はあるが、該他のオブジェクトがその走行曲線上を移動している最中であることから、そこには、数秒間走行し得るフリー空間は、存在していると仮定することができる。
尚、方向、加速、速度及び予測された軌道は、グローバル座標系で出力することは、考え得る。また、該座標を一般的な座標系に転換することも考え得る。即ち、座標を道路座標系において出力することも好ましく可能である。
特に、信頼性領域は、オブジェクトの存在確率、位置ベクトル並びに速度ベクトルの分散、及び、速度ベクトルと加速ベクトルの値に基づいて設定されることが、好ましい。これにより、速度と加速なども考慮されるため、静的オブジェクト用の信頼性領域のみならず、動的オブジェクト用のものも設定することが可能になる。
ある更なる好ましい実施形態においては、不確定な領域は、軌道の確率、最後に予測されたオブジェクト(V1−V7)の軌道ポイントの位置、速度、加速の分散の値に基づいて設定される。
更には、フリー空間マップの評価の前に、同じ占有確率を有するグリッドセルをそれぞれ、お互いから対応するポリゴントラックによって区分される領域に統合することも好ましい。ここで言う占有確率は、必ずしも、固定された値である必要はなく、ある確率の値が含まれる範囲であると解釈される。即ち、該範囲は、例えば、90%を超える占有確率を有する全てのグリッドセルを包含していることができる。この様にすることで、例えば、交通参加者の周りの信頼性領域を考慮することができる。グリッドセルの統合は、領域に統合することにより評価に必要な計算能力を低減できることからも好ましい。
更なる構成と実施形態は、添付されている図面によって示される。図の説明:
本発明のある実施形態に係るフリー空間マップの概略的な描写であり; 本発明のある実施形態に係る拡張されたフリー空間マップの概略的な描写であり; 本発明のある実施形態に係る拡張されたフリー空間マップの更なる概略的な描写であり; 本発明のある実施形態に係る拡張されたフリー空間マップの更なる概略的な描写であり; 本発明のある更なる実施形態に係る拡張されたフリー空間マップ類の更なる概略的な描写であり; 本発明の実施形態の概略的フローチャートを示している。
図1は、本発明のある実施形態に係るフリー空間マップの概略的な描写を示している。この描写において、自車両1は、他の複数の交通参加者V1 − V7と共に、3車線F1−F3からなる道路上を動いている。自車両1は、この時点において、最新の軌道Taに沿って動いている。交通参加者V1−V7の他、それぞれ、例えば、ガードレールなどの車線境界3、及び、更なる静的オブジェクト2a,2bが示されている。交通参加者V1−V7に対しては、少なくとも二本の軌道T1,T2が、予測されている。尚、T1は、最も確率の高い軌道を示している。軌道T2は、低めの確率を有する取り得る軌道を記述している。ここでT1は、実線の矢印で示され、軌道T2は、破線の矢印で示されている。見易さを確保するため、全ての交通参加者V1−V7の全ての軌道T1,T2にではなく、それぞれ一度のみ軌道T1とT2の符号がつけられている。また、認識領域ポリゴンWPも示されている。この認識領域ポリゴンWPは、本発明では、自車両の周り360°視野を示すものである。静的オブジェクト2a,2b,3及び認識領域ポリゴンWPは、ここでは、例えば、周辺モデルから呼び出されることができる。
図2は、本発明のある実施形態に係る拡張されたフリー空間マップの概略的な描写を示している。ここに示されている描写では、静的オブジェクト2a,2b,3と動的オブジェクト乃至交通参加者V1−V7の周りに、信頼性領域Kが設定されている。この概略的な描写では、各々の静的オブジェクト2a,2b,3と各々の交通参加者V1−V7に対して、長方形の信頼性領域Kが想定されており、この描写では、複数の信頼性領域が、重なり合っている。この信頼性領域は、フリー空間マップにおいて、占有されていると仮定される。更には、交通参加者V1の取り得る軌道T1,T2に沿って不確定な領域Uが設定されている。この不確定な領域Uは、交通参加者V1の挙動に応じて占有され得る、乃至、フリーであり続ける。この文脈において、代案的乃至付加的に、他の交通参加者V2−V7の各々一つの不確定な領域Uも設定される。図2では、例えば、第一予測時間ステップに対応する時点が示されている。不確定な領域Uは、この際、自車両1の車線F2に少しだけしかかかっていない。即ち、運転マヌーバを実施する必要性が、まだ十分にはないことから、この先自車両1が取り得る軌道Te1は、現在走行しているTaに対応している。
図3は、本発明のある実施形態に係る拡張されたフリー空間マップの更なる概略的な描写を示している。図3は、図2の内容に対応している。但し、この描写は、後の時点における予測時間ステップのものであるため、不確定な領域Uは、図2のそれよりも大きくなっている。それは、V1は、時間が経つにつれ、例えば、V2に接近し、車線変更の可能性が高まるが、V1が制動することもあり得るため、100%とは言えないことに起因している。よって、不確定な領域Uは、大きくなっている。同時に、自車両1から、もう一本の取り得る軌道Te2が、先ほどの軌道Te1に加えて、現在走行中の方向に沿って、予定される。この更なる軌道Te2は、実施されるかもしれない車線F3への車線変更に対応するものである。
図4は、本発明のある実施形態に係る拡張されたフリー空間マップの更なる概略的な描写を示している。この図でも、描写は、図2と3のそれに相当するものである。図4は、図3よりも後の予測時間ステップを記述している。よって、不確定な領域Uも、図2と3と比較すると拡大され、自車両1の車線F2の全幅まで既に広がっている。自車両1のここで計画されている軌道Te2では、V1が実施し得る車線変更の前によけてしまうために、車線変更が想定されている。これにより、タイムリーに穏やかな運転マヌーバが実施され、自車両1のドライバーにとって快適でない操舵介入や制動介入には、至らない。
図5は、本発明のある更なる実施形態に係る拡張されたフリー空間マップの更なる概略的な描写を示している。この描写では、同じ占有確率Bを有するグリッドセルが、対応する領域4に統合されている。該領域4は、それぞれ、ポリゴントラックPによって区分されている。図に示されている如く、領域には、占有確率Bが0.1未満である領域4、占有確率Bが10%未満の領域4、占有確率Bが50%を超える領域4、及び、占有確率Bが90%を超える領域4がある。占有確率が90%を超える領域4は、例えば、その中に交通参加者が検出された、及び、交通参加者の周りの信頼性領域Kであるグリッドセルであることができる。更に、複数の領域4をまたぐ不確定な領域Uも示されている。
図6は、本発明の実施形態の概略的フローチャートを示している。ステップS1では、静的オブジェクト2a,2b,3と認識領域ポリゴンWPが、既存の周辺モデルから呼び出される。ステップS2では、動的オブジェクトV1−V7の予測された軌道T1,T2が集められる。それに続くステップS3では、静的オブジェクト2a,2b,3、認識領域ポリゴンWP及び予測された軌道T1,T2が、第一フリー空間マップに統合される。ステップS4では、最長予測時間が設定され、ステップS4と並行して実施されても良いステップS5では、対応する予測時間ステップが設定される。その後、ステップS6では、最新の予測時間が設定され、最新の予測時間の値が、設定された予測期間のスタートを設定するために、0にセットされる。ステップS7では、静的オブジェクト2a,2b,3と動的オブジェクトV1−V7の周りに、信頼性領域Kが設定される。更に、ステップS8では、少なくとも一つの不確定な領域Uが、少なくとも一つの静的オブジェクト2a,2b,3乃至動的オブジェクトV1−V7の周りに設定される。ステップS9では、第一確率的フリー空間マップが、最新の予測時間用に作成される。ステップS10では、少なくとも一つの更なるフリー空間マップが、一つの予測時間ステップ用に作成される。このステップS10は、最長予測時間に達するまで、反復される。更なるステップS11では、作成されたフリー空間マップ、特に、最長予測時間に至った時点において作成されたフリー空間マップが、評価される。
1 EGO車両
2a,2b 静的オブジェクト
3 車線境界
4 領域
B 占有確率
F1−F3 車線
K 信頼性領域
P ポリゴントラック
S1−S11 方法ステップ
Ta 自車両の最新の軌道
Te1,Te2 自車両の代案となり得る軌道
T1,T2 動的オブジェクトが取り得る軌道
U 不確定な領域
V1−V7 動的オブジェクト/交通参加者
WP 認識領域ポリゴン

Claims (11)

  1. 以下のステップを有することを特徴とする静的(2a,2b,3)及び動的オブジェクト(V1−V7)を含む確率的フリー空間マップを作成するための方法:
    −既存の周辺モデルから静的オブジェクト(2a,2b,3)と認識領域ポリゴン(WP)を呼び出すステップ(S1);
    −動的オブジェクト(V1−V7)の予測された軌道(T1,T2)を集めるステップ(S2);
    −静的オブジェクト(2a,2b,3)、認識領域ポリゴン(WP)及び予測された軌道(T1,T2)を一枚のマップに統合するステップ(S3);
    −最長予測時間を設定するステップ(S4);
    −予測時間ステップを設定するステップ(S5);
    −最新の予測時間を設定し、設定された予測期間のスタート時点を設定するために、該最新の予測時間の値を0にセットするステップ(S6);
    −信頼性領域(K)を静的(2a,2b,3)及び動的オブジェクト(V1−V7)の周りに設定するステップ(S7);
    −少なくとも一つの静的(2a,2b,3)乃至動的オブジェクト(V1−V7)の周りに少なくとも一つの不確実な領域(U)を設定するステップ(S8);
    −最新の予測時間用に第一確率的フリー空間マップを作成するステップ(S9);
    −少なくとも一つの予測時間ステップ用に少なくとも一枚の更なるフリー空間マップを作成するステップ(S10);
    −作成されたフリー空間マップを評価するステップ(S11)。
  2. 最長予測時間に達するまで、予測時間ステップ毎に一枚のフリー空間マップが作成されることを特徴とする請求項1に記載の方法。
  3. 少なくとも一つの不確定な領域(U)が、既存の周辺モデルと動的オブジェクト(V1−V7)の軌道予測に基づいて設定されることを特徴とする請求項1に記載の方法。
  4. 少なくとも一つの不確定な領域(U)が、ある動的オブジェクト(V1−V7)の少なくとも一本の予測された軌道(T1,T2)にそって拡張されることを特徴とする請求項1から3に記載の方法。
  5. 不確定な領域(U)が、タイムステップ毎に適合されることを特徴とする請求項1から4のうち何れか一項に記載の方法。
  6. 全対象期間用の確率的フリー空間マップの評価後に、少なくとも一つの走行機能が、適合される、及び/或いは、快適性、効率および安全性に関して最適化された自車両(1)の軌道(Te1,Te2)が、計画されることを特徴とする先行請求項のうち何れか一項に記載の方法。
  7. 自車両(1)の軌道(Te1,Te2)の計画のために、認識領域ポリゴン(WP)も考慮されることを特徴とする請求項1から6のうち何れか一項に記載の方法。
  8. 少なくとも一つの走行機能及び/或いは自車両(1)の軌道(Te1,Te2)を、コスト・ファンクションによって最適化することを特徴とする請求項6に記載の方法。
  9. 信頼性領域(K)を、オブジェクト(2a,2b,3,V1−V7)の存在確率、位置ベクトル並びに速度ベクトルの分散、及び、速度ベクトルと加速ベクトルの値に基づいて設定することを特徴とする先行請求項のうち何れか一項に記載の方法。
  10. 不確定な領域が、軌道の確率、最後に予測されたオブジェクト(V1−V7)の軌道ポイントの位置、速度、加速の分散の値に基づいて設定されることを特徴とする先行請求項のうち何れか一項に記載の方法。
  11. フリー空間マップの評価の前に、同じ占有確率を有するグリッドセルをそれぞれ、お互いからポリゴントラックによって区分される領域に統合することを特徴とする請求項1に記載の方法。
JP2020202006A 2020-01-09 2020-12-04 静的及び動的オブジェクトを含む確率的フリー空間地図を作成するための方法 Pending JP2021111366A (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102020200183.9 2020-01-09
DE102020200183.9A DE102020200183A1 (de) 2020-01-09 2020-01-09 Verfahren zum Erstellen einer probabilistischen Freiraumkarte mit statischen und dynamischen Objekten

Publications (1)

Publication Number Publication Date
JP2021111366A true JP2021111366A (ja) 2021-08-02

Family

ID=74103821

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020202006A Pending JP2021111366A (ja) 2020-01-09 2020-12-04 静的及び動的オブジェクトを含む確率的フリー空間地図を作成するための方法

Country Status (6)

Country Link
US (1) US11820404B2 (ja)
EP (1) EP3848266A1 (ja)
JP (1) JP2021111366A (ja)
CN (1) CN113178097B (ja)
DE (1) DE102020200183A1 (ja)
SG (1) SG10202100162WA (ja)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113936481B (zh) * 2021-12-02 2022-07-26 公安部交通管理科学研究所 一种信号控制交叉口的空间利用状况评价方法
DE102021214977A1 (de) 2021-12-23 2023-06-29 Robert Bosch Gesellschaft mit beschränkter Haftung Verfahren und Vorrichtung zum Betreiben eines automatisierten Fahrzeugs an einer Verkehrskreuzung
US20230202516A1 (en) * 2021-12-29 2023-06-29 Baidu Usa Llc Planning under prediction with confidence region for an autonomous driving vehicle
EP4276791A1 (en) * 2022-05-09 2023-11-15 Zenseact AB Prediction of near-future behavior of road users
DE102022002253B3 (de) 2022-06-21 2023-08-24 Mercedes-Benz Group AG Verfahren zur Planung einer Solltrajektorie für ein automatisiert fahrendes Fahrzeug
CN115731708B (zh) * 2022-11-15 2023-10-17 东南大学 一种基于贝叶斯理论的实时车辆轨迹换道点监测方法
DE102022132345A1 (de) 2022-12-06 2024-06-06 Connaught Electronics Ltd. Objektmodellierung auf der Basis einer Belegungsgitterkarte
DE102023203666A1 (de) 2023-04-20 2024-10-24 Robert Bosch Gesellschaft mit beschränkter Haftung Computer-implementiertes Verfahren zur Prädiktion des Verhaltens eines Teilnehmers einer Verkehrsszene
CN116541727B (zh) * 2023-07-07 2023-09-12 中国兵工物资集团有限公司 一种轨迹相似度计算方法和系统

Family Cites Families (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6590507B2 (en) * 2001-03-05 2003-07-08 Hrl Laboratories, Llc Method and system for providing personalized traffic alerts
US8024112B2 (en) * 2005-09-29 2011-09-20 Microsoft Corporation Methods for predicting destinations from partial trajectories employing open-and closed-world modeling methods
DE102006060893A1 (de) * 2006-05-12 2007-11-15 Adc Automotive Distance Control Systems Gmbh Vorrichtung und Verfahren zum Bestimmen eines Freiraums vor einem Fahrzeug
EP2562060B1 (en) * 2011-08-22 2014-10-01 Honda Research Institute Europe GmbH A method and system for predicting movement behavior of a target traffic object
GB201211614D0 (en) * 2012-06-29 2012-08-15 Tomtom Dev Germany Gmbh Generating alternative routes
EP2950294B1 (en) * 2014-05-30 2019-05-08 Honda Research Institute Europe GmbH Method and vehicle with an advanced driver assistance system for risk-based traffic scene analysis
DE102014212478A1 (de) * 2014-06-27 2015-12-31 Bayerische Motoren Werke Aktiengesellschaft Verfahren zur Erstellung eines Umfeldmodells eines Fahrzeugs
EP3845427A1 (en) * 2015-02-10 2021-07-07 Mobileye Vision Technologies Ltd. Sparse map for autonomous vehicle navigation
JP6520740B2 (ja) * 2016-02-01 2019-05-29 トヨタ自動車株式会社 物体検出方法、物体検出装置、およびプログラム
US10585409B2 (en) * 2016-09-08 2020-03-10 Mentor Graphics Corporation Vehicle localization with map-matched sensor measurements
WO2018078413A1 (en) * 2016-10-31 2018-05-03 Toyota Motor Europe Driving assistance method and system
EP3805889A1 (en) 2016-12-23 2021-04-14 Mobileye Vision Technologies Ltd. Navigational system monitoring host and target vehicle behaviour
CN110832348B (zh) * 2016-12-30 2023-08-15 辉达公司 用于自主车辆的高清晰度地图的点云数据丰富
WO2018126215A1 (en) * 2016-12-30 2018-07-05 DeepMap Inc. High definition map updates
DE102017103154A1 (de) 2017-02-16 2018-08-16 Connaught Electronics Ltd. Verfahren zum Erzeugen einer digitalen Umgebungskarte einer Umgebung eines Kraftfahrzeugs unter Berücksichtigung eines Freiraums, Recheneinrichtung, Fahrerassistenzsystem sowie Kraftfahrzeug
WO2018175441A1 (en) * 2017-03-20 2018-09-27 Mobileye Vision Technologies Ltd. Navigation by augmented path prediction
US10471955B2 (en) * 2017-07-18 2019-11-12 lvl5, Inc. Stop sign and traffic light alert
US10579063B2 (en) * 2017-07-21 2020-03-03 Uatc, Llc Machine learning for predicting locations of objects perceived by autonomous vehicles
DE102017009435B4 (de) * 2017-10-10 2023-05-11 Volkswagen Ag Evaluation von Komponenten automatischer Fahrfunktionen und Fahrbahnerkennung auf unterschiedlichen Verarbeitungsstufen
WO2019092159A1 (de) * 2017-11-09 2019-05-16 Robert Bosch Gmbh VERFAHREN UND VORRICHTUNG ZUM EINLEITEN GEFAHRENREDUZIERENDER MAßNAHMEN IN REAKTION AUF DAS ERKENNEN EINER FALSCHFAHRT EINES KRAFTFAHRZEUGS
US11906625B2 (en) * 2018-01-08 2024-02-20 The Regents Of The University Of California Surround vehicle tracking and motion prediction
US10480952B2 (en) * 2018-02-01 2019-11-19 Didi Research America, Llc Probabilistic navigation system and method
EP3803833A4 (en) * 2018-05-31 2022-03-09 TuSimple, Inc. SYSTEM AND METHOD FOR PREDICTING THE INTENT OF A FOLLOWING VEHICLE FOR AUTONOMOUS VEHICLES
US11099561B1 (en) * 2018-06-19 2021-08-24 Zoox, Inc. Control of an autonomous vehicle in unmapped regions
CN110893858B (zh) * 2018-09-12 2021-11-09 华为技术有限公司 一种智能驾驶方法及智能驾驶系统
US11215997B2 (en) * 2018-11-30 2022-01-04 Zoox, Inc. Probabilistic risk assessment for trajectory evaluation
US11555903B1 (en) * 2018-11-30 2023-01-17 Zoox, Inc. Sensor calibration using dense depth maps
US11415992B2 (en) * 2019-12-27 2022-08-16 Woven Planet North America, Inc. Resource prioritization based on travel path relevance

Also Published As

Publication number Publication date
CN113178097B (zh) 2023-03-14
US20210213978A1 (en) 2021-07-15
CN113178097A (zh) 2021-07-27
SG10202100162WA (en) 2021-08-30
US11820404B2 (en) 2023-11-21
EP3848266A1 (de) 2021-07-14
DE102020200183A1 (de) 2021-07-15

Similar Documents

Publication Publication Date Title
JP2021111366A (ja) 静的及び動的オブジェクトを含む確率的フリー空間地図を作成するための方法
US11220261B2 (en) Method for assisting a driver, driver assistance system, and vehicle including such driver assistance system
US9280899B2 (en) Dynamic safety shields for situation assessment and decision making in collision avoidance tasks
EP2950114B1 (en) Method for assisting a driver in driving a vehicle, a driver assistance system, a computer software program product and vehicle
EP3091370B1 (en) Method and arrangement for determining safe vehicle trajectories
US11225249B2 (en) Vehicle control device, vehicle control method, and storage medium
US8571786B2 (en) Vehicular peripheral surveillance device
JP7440324B2 (ja) 車両制御装置、車両制御方法、及びプログラム
JP4957752B2 (ja) 進路評価装置
JP7347523B2 (ja) 車両制御装置及び車両制御方法
WO2021075454A1 (ja) 車載装置及び運転支援方法
US20110313664A1 (en) Apparatus for predicting the movement of a mobile body
US11794728B2 (en) Electronic control device
JP2009037561A (ja) 走行計画生成装置
US20230123418A1 (en) Method for planning a target trajectory
US20190258269A1 (en) Vehicle control device
US20220314968A1 (en) Electronic control device
JP7369078B2 (ja) 車両制御装置、車両制御方法、及びプログラム
JP7170637B2 (ja) 車両制御システム、車両制御方法、およびプログラム
JP2019156271A (ja) 車両制御装置、車両制御方法、およびプログラム
JP2019070900A (ja) 車両制御装置
JP2020019455A (ja) 車両制御装置、車両制御方法、およびプログラム
JP7369077B2 (ja) 車両制御装置、車両制御方法、及びプログラム
JP2021033536A (ja) 車両制御装置および車両制御方法
US20230339507A1 (en) Contextual right-of-way decision making for autonomous vehicles

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230829

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20240620

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240703

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240930