JP7194755B2 - 軌道計画 - Google Patents

軌道計画 Download PDF

Info

Publication number
JP7194755B2
JP7194755B2 JP2020566219A JP2020566219A JP7194755B2 JP 7194755 B2 JP7194755 B2 JP 7194755B2 JP 2020566219 A JP2020566219 A JP 2020566219A JP 2020566219 A JP2020566219 A JP 2020566219A JP 7194755 B2 JP7194755 B2 JP 7194755B2
Authority
JP
Japan
Prior art keywords
trajectory
determining
drivable area
vehicle
adjusted
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
JP2020566219A
Other languages
English (en)
Other versions
JP2021526474A (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 JP2021526474A publication Critical patent/JP2021526474A/ja
Application granted granted Critical
Publication of JP7194755B2 publication Critical patent/JP7194755B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/0015Planning or execution of driving tasks specially adapted for safety
    • 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/0011Planning or execution of driving tasks involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles
    • 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/04Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
    • 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/10Conjoint control of vehicle sub-units of different type or different function including control of change-speed gearings
    • 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
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/18Conjoint control of vehicle sub-units of different type or different function including control of braking systems
    • 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
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • 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
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • 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/14Adaptive cruise control
    • B60W30/143Speed control
    • B60W30/146Speed limiting
    • 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18145Cornering
    • 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18159Traversing an intersection
    • 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • 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
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/04Traffic conditions
    • 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
    • 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
    • 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/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • 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/0287Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
    • G05D1/0289Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling with means for avoiding collisions between vehicles
    • 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
    • G08G1/042Detecting movement of traffic to be counted or controlled using inductive or magnetic detectors
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/161Decentralised systems, e.g. inter-vehicle communication
    • G08G1/163Decentralised systems, e.g. inter-vehicle communication involving continuous checking
    • 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
    • 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
    • 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
    • B60W2554/404Characteristics
    • B60W2554/4044Direction of movement, e.g. backwards
    • 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/4045Intention, e.g. lane change or imminent movement
    • 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/80Spatial relation or speed relative to objects

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Multimedia (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本出願は、自律走行車に関するものであり、自律走行車の軌道計画のための方法、装置、システム、及び非一時的なコンピュータ可読媒体を含む。
自律走行車の使用の増加によって、交通ネットワークを介して乗客及び積荷がより効率的に移動する可能性が生み出される。さらに、自律走行車の使用は、車両安全性の改善及び車両間のより効率的な通信をもたらし得る。しかしながら、自律走行車が静的物体を検出し、及び/又は近傍の他の動的物体の軌道を予測して、自律走行車が交通ネットワークを安全に横断し、そのような物体を回避し得るように軌道を計画し得ることが重要である。
本明細書には、車両の自律操作を遠隔支援するための態様、特徴、要素、及び実装が開示される。この実装は、既存のルートを目的地における代替終点まで拡張する遠隔操作を支援する。
開示された実装の一態様は、自律走行車(AV)による物体回避のための方法である。装置は、メモリとプロセッサとを含む。この方法は、AVの走行可能領域の粗走行線に沿って第1の物体を検出するステップと、第1の物体の予測経路を受信するステップと、第1の物体の予測経路に基づいて、調整された走行可能領域を決定するステップと、調整された走行可能領域を通るAVの軌道を決定するステップとを含む。
開示された実装の一態様は、自律走行車(AV)による物体回避のためのシステムである。システムは、AVの走行可能領域の粗走行線に沿って第1の物体を検出し、第1の物体の予測経路を受信し、第1の物体の予測経路に基づいて、調整された走行可能領域を決定し、調整された走行可能領域を通るAVの軌道を決定するように構成される軌道プランナを含む。
開示された実装の一態様は、自律走行車(AV)による物体回避のための方法である。この方法は、AVの走行可能領域の粗走行線に沿って第1の物体を検出するステップと、調整された走行可能領域を決定するステップと、調整された走行可能領域を通るAVの軌道を決定するステップとを含む。調整された走行可能領域を決定するステップは、粗走行線の少なくとも一部をビンに分割することと、第1の物体を複数のビンの中の1つのビンに割り当てることと、1つのビンに基づいて調整された走行可能領域を決定することとを含む。
本開示のこうした特徴及びその他の特徴は、以下の実装の詳細な説明、添付の請求項及び添付の図面に開示されている。
本開示の技術は、添付の図面と併せて読む場合に、以下の詳細な説明から最良に理解される。慣行により、図面の様々な特徴は正確な縮尺ではないことを強調する。対照的に、様々な特徴の寸法は、明確のため任意に拡大又は縮小されている。さらに、別の注記がない限り、図面全体を通して、同じ参照番号は同じ要素を指している。
本明細書に開示の態様、特徴及び要素が実装され得る車両の一部の例示の図面である。
本明細書に開示の態様、特徴及び要素が実装され得る車両交通及び通信システムの一部の例示の図面である。
本開示の実装による予測可能な応答の状況の図である。
本開示の実装による自律車両用システムのコンポーネントの一例である。
本開示の実装による自律走行車の軌道プランナのレイヤの例である。
本開示の実装による粗走行線連結の例を示す図である。
本開示の実装による戦略的速度計画を決定する例である。
本開示の実施による走行可能領域及び離散時間速度計画を決定するための処理のフローチャート図である。
本開示の実装による走行可能領域及び離散時間速度計画を決定する図である。
本開示の実装による静的物体のための走行可能領域を調整する例である。 本開示の実装による静的物体のための走行可能領域を調整する例である。 本開示の実装による静的物体のための走行可能領域を調整する例である。
本開示による静的境界を決定するための処理のフローチャートである。
本開示の実装による動的境界を決定する例である。 本開示の実装による動的境界を決定する例である。 本開示の実装による動的境界を決定する例である。
本開示の実施による軌道計画のさらなる例を示す。
本開示による物体回避のための処理のフローチャートである。
自律走行車又は半自律走行車等の車両は、車両交通ネットワークの一部を横断する場合がある。車両交通ネットワークは、建物等の1つ以上の通行不能領域、駐車領域(例えば、駐車場、駐車スペース等)等の1つ以上の部分的通行可能領域、道路(車線、中央分離帯、交差点等を含む)の1つ以上の通行可能領域、又はこれらの組み合わせを含み得る。
車両は、1つ以上のセンサを含み得る。車両交通ネットワークを横断することは、車両の動作環境又はその一部に対応するデータ等のセンサデータを生成又は捕捉するセンサを含み得る。例えば、センサデータは、1つ以上の外部物体(又は単に物体)に対応する情報を含み得る。
外部物体は静的物体であり得る。静的物体とは、静止していて、数秒以内に移動することが予想されない物体である。静的物体の例としては、運転者のいない自転車、コールドビークル、空車、道路標識、壁、建物、穴等が含まれる。
外部物体は、停止した物体であってもよい。停止した物体とは、静止しているが、いつでも移動し得る物体である。停止物体の例としては、信号機で停止している車両、及び乗員(例えば、運転者)がいる道路側の車両等が含まれる。実装によっては、停止した物体は静的物体とみなされる。
外部物体は、歩行者、遠隔車両、自動二輪車、自転車等の動的(すなわち、移動)物体であってもよい。動的物体は、(車両に向かって)対向しているものであり、又は車両と同じ方向に移動していてもよい。動的物体は、車両に対して縦方向又は横方向に移動し得る。静的物体は動的物体になる可能性があり、その逆もしかりである。
一般に、車両交通ネットワークを横断する(例えば、その中を走行する)ことは、ロボット的な動作とみなされ得る。すなわち、特定の状況(例えば、交通状況又は道路状況)に対する車両の予測可能な応答は予想することが可能である。例えば、交通状況の観測者は、次の数秒間における車両の応答がどのようなものであるかを予想することが可能である。すなわち、例えば、走行環境(すなわち、車両交通ネットワーク、道路)が動的であっても、道路状態に対する車両(すなわち、人に運転される、遠隔操作されるもの等)による応答は予測/予想することが可能である。
(複数の)応答は、車両交通ネットワークを横断することが道路の規則(例えば、左折する車両は対向する交通に譲らなければならず、車両は車線の標示の間を走行しなければならない)、社会的慣習(例えば、停止標識において、右側の運転者が譲られるべきである)、及び物理的制約(例えば、静的物体が車両の進行方向に瞬間的に横方向に移動することはない)により支配されるので予測可能である。予測可能な応答のさらなる例が、図3に関して示されている。
本開示による実装は、静的物体の存在を検出し(例えば、感知、観測等)、車両交通ネットワークの他のユーザ(例えば、道路ユーザ、動的物体)の軌道を予想(すなわち、予測)することによって、自律走行車の軌道を決定する。本開示による実装は、自律走行車の円滑な制御(例えば、停止、待機、加速、減速、合流等)及び自律走行車の社会的に許容可能な挙動(例えば、操作)に寄与する動的物体(例えば、他の道路ユーザ)の軌道を正確かつ効率的に計画することが可能である。
以下にさらに説明するように、本開示による軌道プランナの実装は、例えば、HD地図データ、遠隔操作データ、及び他の入力データを受信すること、起点位置から目的地位置までの経路の速度プロファイルを決定するために、入力データを縦方向に縫い合わせ(例えば、融合、接続等)すること(例えば、起点位置から目的地位置までの経路の異なる区間に沿ってAVを走行し得る速度を指定する速度プロファイル)、及び離散的な時点において(例えば、数ミリ秒ごとに)、AVのセンサデータに基づいて観測される静的及び動的物体に関連する制約を軌道プランナに処理させることにより、次の時間ウィンドウ(例えば、6秒の先読み時間)のためのAVの円滑な軌道を生成することによって、自律走行車(AV)のための円滑な軌道を起点位置から目的地位置まで生成し得る。
本明細書では自律走行車を参照して記載されているが、本明細書に記載の方法及び装置は、自律的又は半自律的動作が可能な任意の車両で実装されてもよい。車両交通ネットワークを参照して記載されているが、本明細書に記載の方法及び装置は、車両によって走行可能な任意の領域で自律走行車が動作することを含んでもよい。
本明細書の教示のいくつかの実装をより詳細に説明するために、まず、本開示が実装され得る環境を参照する。
図1は、本明細書に開示の態様、特徴及び要素が実装され得る車両100の一部の例示の図面である。車両100は、シャーシ102、パワートレイン104、コントローラ114、車輪132/134/136/138を含み、又は車両の任意の他の要素又は要素の組み合わせを含んでもよい。簡潔のため車両100は4つの車輪132/134/136/138を含むように示されているが、プロペラ又はトレッド等の1つ以上の任意の他の推進装置が使用されてもよい。図1において、パワートレイン104、コントローラ114及び車輪132/134/136/138等の要素を相互接続する線は、データ又は制御信号等の情報、電力又はトルク等の力、又は情報及び電力の両方が各要素間で伝達され得ることを示している。例えば、コントローラ114は、パワートレイン104から電力を受信して、パワートレイン104、車輪132/134/136/138、又は両方と通信して、車両100を制御してもよく、これは、車両100を加速、減速、操縦又は他のやり方で制御することを含み得る。
パワートレイン104は、電源106、トランスミッション108、ステアリング装置110、車両アクチュエータ112を含み、サスペンション、駆動シャフト、アクセル若しくは排気システム等のパワートレインの任意の他の要素又は要素の組み合わせを含んでもよい。別々に示されているが、車輪132/134/136/138は、パワートレイン104に含まれてもよい。
電源106は、電気エネルギ、熱エネルギ又は運動エネルギ等のエネルギを提供するように動作する任意の装置又は装置の組み合わせであってもよい。例えば、電源106は、内燃エンジン、電気モータ又は内燃エンジン及び電気モータの組み合わせ等のエンジンを含み、車輪132/134/136/138の1つ以上に原動力として運動エネルギを提供するように動作する。いくつかの実施形態では、電源106は、ニッケルカドミウム(NiCd)、ニッケル亜鉛(NiZn)、ニッケル水素(NiMH)、リチウムイオン(Li-ion)等の1つ以上の乾電池、太陽電池、燃料電池、又はエネルギを提供することが可能な任意の他の装置等のポテンシャルエネルギ装置を含む。
トランスミッション108は、電源106から運動エネルギ等のエネルギを受信して、原動力を提供するために車輪132/134/136/138にエネルギを送る。トランスミッション108は、コントローラ114、車両アクチュエータ112又は両方によって制御されてもよい。ステアリング装置110は、コントローラ114、車両アクチュエータ112又は両方によって制御され、車両を操縦するために車輪132/134/136/138を制御する。車両アクチュエータ112は、コントローラ114から信号を受信してもよく、車両100を動作させるために電源106、トランスミッション108、ステアリング装置110又はこれらの任意の組み合わせを作動又は制御してもよい。
例示の実施形態では、コントローラ114は、位置決め装置116、電子通信装置118、プロセッサ120、メモリ122、ユーザインターフェース124、センサ126、及び電子通信インターフェース128を含む。単一の装置として示されているが、コントローラ114の任意の1つ以上の要素が任意の数の分離した物理装置に組み込まれてもよい。例えば、ユーザインターフェース124及びプロセッサ120は、第1の物理装置に組み込まれてもよく、メモリ122は、第2の物理装置に組み込まれてもよい。図1には示されていないが、コントローラ114は、バッテリ等の電源1210を含んでもよい。別個の要素として示されているが、位置決め装置116、電子通信装置118、プロセッサ120、メモリ122、ユーザインターフェース124、センサ126、電子通信インターフェース128、又はこれらの任意の組み合わせは、1つ以上の電子装置、回路又はチップに組み込まれ得る。
いくつかの実施形態では、プロセッサ120は、信号又は他の情報を操作又は処理することが可能な現存する又は今後開発される任意の装置又は装置の組み合わせ、例えば、光プロセッサ、量子プロセッサ、分子プロセッサ、又はそれらの組み合わせを含む。例えば、プロセッサ120は、1つ以上の専用プロセッサ、1つ以上のデジタル信号プロセッサ、1つ以上のマイクロプロセッサ、1つ以上のコントローラ、1つ以上のマイクロコントローラ、1つ以上の集積回路、1つ以上の特定用途向け集積回路、1つ以上のフィールド・プログラマブル・ゲート・アレイ、1つ以上のプログラマブル・ロジック・アレイ、1つ以上のプログラマブル・ロジック・コントローラ、1つ以上の状態機械、又はこれらの任意の組み合わせを含んでもよい。プロセッサ120は、位置決め装置116、メモリ122、電子通信インターフェース128、電子通信装置118、ユーザインターフェース124、センサ126、パワートレイン104、又はこれらの任意の組み合わせと動作可能に結合されてもよい。例えば、プロセッサは、通信バス130を介してメモリ122と動作可能に結合されてもよい。
プロセッサ120は、命令を実行するように構成されてもよい。このような命令は、オペレーションセンタを含む遠隔地から車両100を操作するために使用され得る遠隔操作のための命令を含んでもよい。遠隔操作のための命令は、車両100に記憶され、又は交通管理センタ又はクラウド型サーバコンピュータ装置を含むサーバコンピュータ装置等の外部ソースから受信されてもよい。遠隔操作は、2018年2月21日に出願され、“REMOTE OPERATION EXTENDING AN EXISTING ROUTE TO A DESTINATION”と題された米国仮特許出願第62/633,414号で紹介されている。
メモリ122は、プロセッサ120によって使用される又はそれと接続される、機械可読命令又はそれに関連付けられる任意の情報を、例えば、保持、記憶、伝達又は搬送することが可能な任意の有形の非一時的コンピュータ使用可能又はコンピュータ可読媒体を含んでもよい。メモリ122は、例えば、1つ以上の半導体ドライブ、1つ以上のメモリカード、1つ以上のリムーバブル媒体、1つ以上の読み取り専用メモリ(ROM)、1つ以上のランダムアクセスメモリ(RAM)、1つ以上のレジストリ、1つ以上の低電力ダブルデータレート(LPDDR)メモリ、1つ以上のキャッシュメモリ、1つ以上のディスク(ハードディスク、フロッピーディスク、又は光学ディスクを含む)、磁気若しくは光学カード、又は電子情報を記憶するのに適した任意のタイプの非一時的な媒体、又はこれらの任意の組み合わせを含んでもよい。
電子通信インターフェース128は、図示のような無線アンテナ、有線通信ポート、光学通信ポート、又は有線若しくは無線電子通信媒体140とインターフェース接続することが可能な任意の他の有線若しくは無線装置であってもよい。
電子通信装置118は、電子通信インターフェース128等を介して、有線又は無線電子通信媒体140を介して信号を送信又は受信するように構成されてもよい。図1に明示されていないが、電子通信装置118は、無線周波数(RF)、紫外線(UV)、可視光、光ファイバ、有線回線、又はこれらの組み合わせ等の任意の有線又は無線通信媒体を介して送信、受信又は両方を行うように構成される。図1は、単一の電子通信装置118及び単一の電子通信インターフェース128を示しているが、任意の数の通信装置及び任意の数の通信インターフェースが使用されてもよい。いくつかの実施形態では、電子通信装置118は、専用の短距離通信(DSRC)装置、無線安全装置(WSU)、IEEE802.11p(WiFi-P)、又はそれらの組み合わせを含み得る。
位置決め装置116は、限定されないが、車両100の経度、緯度、高度、進行方向又は速さを含む地理情報を決定してもよい。例えば、位置決め装置は、広域補強システム(Wide Area Augmentation System;WAAS)対応米国海洋電子機器協会(National Marine Electronics Association;NMEA)装置、無線三角測量装置、又はこれらの組み合わせ等の全地球測位システム(GPS)装置を含む。位置決め装置116は、例えば、車両100の現在の向き、2次元又は3次元での車両100の現在地、車両100の現在の角度方向、又はこれらの組み合わせを表す情報を取得するために使用され得る。
ユーザインターフェース124は、仮想キーパッド、物理キーパッド、タッチパッド、ディスプレイ、タッチスクリーン、スピーカ、マイクロホン、ビデオカメラ、センサ、及びプリンタのいずれかを含む、人間がインターフェースとして使用することが可能な任意の装置を含んでもよい。ユーザインターフェース124は、図示のようにプロセッサ120と、又はコントローラ114の任意の他の要素と動作可能に結合されてもよい。単一の装置として示されているが、ユーザインターフェース124は、1つ以上の物理装置を含み得る。例えば、ユーザインターフェース124は、人物との音声通信を行うための音声インターフェース、及び人物との視覚及びタッチに基づく通信を行うためのタッチディスプレイを含む。
センサ126は、車両を制御するために使用され得る情報を提供するように動作し得るセンサの配列等の1つ以上のセンサを含んでもよい。センサ126は、車両の現在の動作特徴又はその周囲に関する情報を提供し得る。センサ126は、例えば、速度センサ、加速度センサ、ステアリング角センサ、トラクション関連センサ、ブレーキ関連センサ、又は車両100の現在の動的状況の何らかの態様に関する情報を報告するように動作可能な任意のセンサ若しくはセンサの組み合わせを含む。
いくつかの実施形態では、センサ126は、車両100の周囲の物理環境に関する情報を取得するように動作可能なセンサを含む。例えば、1つ以上のセンサが、道路形状、及び固定妨害物、車両、サイクリスト及び歩行者等の妨害物を検出する。センサ126は、既知の又は後に開発される、1つ以上のビデオカメラ、レーザ感知システム、赤外線感知システム、音響感知システム、又は任意の他の適切なタイプの車載環境感知装置、又は装置の組み合わせであるか、又はこれらを含み得る。センサ126及び位置決め装置116は結合されてもよい。
別に示されてはいないが、車両100は、軌道コントローラを含んでもよい。例えば、コントローラ114は、軌道コントローラを含んでもよい。軌道コントローラは、車両100の現在の状態及び車両100に対して計画された経路を記述する情報を取得し、この情報に基づいて、車両100に対する軌道を決定及び最適化するように動作可能であってもよい。いくつかの実施形態では、軌道コントローラは、車両100が軌道コントローラによって決定される軌道に従うように、車両100を制御するように動作可能な信号を出力する。例えば、軌道コントローラの出力は、パワートレイン104、車輪132/134/136/138又は両方に供給され得る最適化された軌道であり得る。最適化された軌道は、一組のステアリング角等の制御入力であってもよく、各ステアリング角は1つの時点又は位置に対応する。最適化された軌道は、1つ以上の経路、線、曲線、又はこれらの組み合わせであり得る。
1つ以上の車輪132/134/136/138は、ステアリング装置110の制御下でステアリング角に枢動される操縦された車輪、トランスミッション108の制御下で車両100を推進するためのトルクを与えられる推進された車輪、又は車両100を操縦及び推進する操縦及び推進された車輪であってもよい。
車両は、エンクロージャ、ブルートゥース(登録商標)(登録商標)モジュール、周波数変調(FM)ラジオ装置、近距離無線通信(NFC)モジュール、液晶ディスプレイ(LCD)ディスプレイ装置、有機発光ダイオード(OLED)ディスプレイ装置、スピーカ、又はこれらの任意の組み合わせ等の図1に示されていない装置又は要素を含んでもよい。
図2は、本明細書に開示の態様、特徴及び要素が実装され得る車両交通及び通信システム200の一部の例示の図面である。車両交通及び通信システム200は、図1に示された車両100等の車両202、及び図1に示された車両100、歩行者、サイクリスト等の任意の交通手段の形態と共に建物等の任意の形態の構造を含み得る外部物体206等の1つ以上の外部物体を含む。車両202は、交通ネットワーク208の1つ以上の部分を介して移動してもよく、1つ以上の電子通信ネットワーク212を介して外部物体206と通信してもよい。図2には明示されていないが、車両は、オフロード領域等の交通ネットワークに明示的に又は完全には含まれていない領域を横断してもよい。いくつかの実施形態では、交通ネットワーク208は、誘導ループセンサ等の1つ以上の車両検出センサ210を含んでもよく、これは交通ネットワーク208において車両の移動を検出するために使用されてもよい。
電子通信ネットワーク212は、車両202、外部物体206及びオペレーションセンタ230の間の音声通信、データ通信、映像通信、メッセージング通信、又はこれらの組み合わせ等の通信を提供する多重アクセスシステムであってもよい。例えば、車両202又は外部物体206は、電子通信ネットワーク212を介してオペレーションセンタ230から交通ネットワーク208を表す情報等の情報を受信してもよい。
オペレーションセンタ230は、図1に示されたコントローラ114の特徴の一部又は全てを含むコントローラ装置232を含む。コントローラ装置232は、自律走行車を含む車両の移動を監視及び調整し得る。コントローラ装置232は、車両202等の車両及び外部物体206等の外部物体の状態又は状況を監視してもよい。コントローラ装置232は、車両速度、車両位置、車両動作状態、車両目的地、車両経路、車両センサデータ、外部物体速度、外部物体位置、外部物体動作状態、外部物体目的地、外部物体経路及び外部物体センサデータのいずれかを含む車両データ及びインフラストラクチャデータを受信し得る。
さらに、コントローラ装置232は、車両202等の1つ以上の車両又は外部物体206等の外部物体に対する遠隔制御を確立し得る。このようにして、コントローラ装置232は、遠隔地から車両又は外部物体を遠隔操作してもよい。コントローラ装置232は、無線通信リンク226等の無線通信リンク又は有線通信リンク228等の有線通信リンクを介して、車両202、外部物体206又はサーバコンピュータ装置234等の車両、外部物体又はコンピュータ装置と状態データを交換(送信又は受信)してもよい。
サーバコンピュータ装置234は、電子通信ネットワーク212を介して、車両202、外部物体206又はオペレーションセンタ230を含む1つ以上の車両又はコンピュータ装置と状態信号データを交換(送信又は受信)し得る1つ以上のサーバコンピュータ装置を含んでもよい。
いくつかの実施形態では、車両202又は外部物体206は、有線通信リンク228、無線通信リンク214/216/224、又は任意の数若しくはタイプの有線若しくは無線通信リンクの組み合わせを介して通信を行ってもよい。例えば、図示のように、車両202又は外部物体206は、陸上無線通信リンク214を介して、非陸上無線通信リンク216を介して、又はこれらの組み合わせを介して通信を行う。いくつかの実装では、陸上無線通信リンク214は、イーサネット(登録商標)リンク、シリアルリンク、ブルートゥース(登録商標)リンク、赤外線(IR)リンク、紫外線(UV)リンク、又は電子通信を可能にする任意のリンクを含む。
車両202等の車両又は外部物体206等の外部物体は、別の車両、外部物体又はオペレーションセンタ230と通信してもよい。例えば、ホスト又は物体の車両202が、直接通信リンク224を介して又は電子通信ネットワーク212を介して、オペレーションセンタ230から基本安全メッセージ(basic safety message;BSM)等の1つ以上の自動車両間メッセージを受信してもよい。例えば、オペレーションセンタ230は、300メートル等の既定のブロードキャスト範囲内のホスト車両に又は定義された地理領域にメッセージをブロードキャストしてもよい。いくつかの実施形態では、車両202は、信号リピータ(図示せず)又は別の遠隔車両(図示せず)等のサードパーティを介してメッセージを受信する。いくつかの実施形態では、車両202又は外部物体206は、100ミリ秒等の既定の間隔に基づいて周期的に1つ以上の自動車両間メッセージを送信する。
車両202は、アクセスポイント218を介して電子通信ネットワーク212と通信してもよい。コンピュータ装置を含み得るアクセスポイント218は、無線又は有線通信リンク214/220を介して、車両202と、電子通信ネットワーク212と、オペレーションセンタ230と、又はこれらの組み合わせと通信するように構成される。例えば、アクセスポイント218は、基地局、BTS(base transceiver station)、Node-B、eNode-B(enhanced Node-B)、HNode-B(Home Node-B)、無線ルータ、有線ルータ、ハブ、リレー、スイッチ、又は任意の類似の有線若しくは無線装置である。単一の装置として示されているが、アクセスポイントは、任意の数の相互接続要素を含み得る。
車両202は衛星222又は他の非陸上通信装置を介して電子通信ネットワーク212と通信してもよい。コンピュータ装置を含み得る衛星222は、1つ以上の通信リンク216/236を介して、車両202と、電子通信ネットワーク212と、オペレーションセンタ230と、又はこれらの組み合わせと通信するように構成されてもよい。単一の装置として示されているが、衛星は、任意の数の相互接続要素を含み得る。
電子通信ネットワーク212は、音声、データ、又は任意の他のタイプの電子通信装置を提供するように構成される任意のタイプのネットワークであってもよい。例えば、電子通信ネットワーク212は、ローカルエリアネットワーク(LAN)、ワイドエリアネットワーク(WAN)、仮想プライベートネットワーク(VPN)、モバイル若しくはセルラ電話ネットワーク、インターネット、又は任意の他の電子通信システムを含む。電子通信ネットワーク212は、トランスミッション・コントロール・プロトコル(TCP)、ユーザ・データグラム・プロトコル(UDP)、インターネット・プロトコル(IP)、リアルタイム・トランスポート・プロトコル(RTP)、ハイパー・テキスト・トランスポート・プロトコル(HTTP)、又はこれらの組み合わせ等の通信プロトコルを使用してもよい。単一の装置として示されているが、電子通信ネットワークは、任意の数の相互接続要素を含み得る。
いくつかの実施形態では、車両202は、電子通信ネットワーク212、アクセスポイント218又は衛星222を介して、オペレーションセンタ230と通信する。オペレーションセンタ230は、車両202等の車両からのデータ、外部物体206等の外部物体からのデータ、又はサーバコンピュータ装置234等のコンピュータ装置からのデータを交換(送信又は受信)し得る1つ以上のコンピュータ装置を含んでもよい。
いくつかの実施形態では、車両202は、交通ネットワーク208の一部又は状態を識別する。例えば、車両202は、速度センサ、車輪速度センサ、カメラ、ジャイロスコープ、光学センサ、レーザセンサ、レーダセンサ、音響センサ、又は交通ネットワーク208の一部若しくは状態を決定若しくは識別することが可能な任意の他のセンサ若しくはデバイス又はこれらの組み合わせを含む図1に示されたセンサ126等の1つ以上の車載センサ204を含んでもよい。
車両202は、交通ネットワーク208を表す情報、1つ以上の車載センサ204、又はこれらの組み合わせ等の電子通信ネットワーク212を介して伝達される情報を使用して、交通ネットワーク208の1つ以上の部分を横断してもよい。外部物体206は、車両202に関して先に記載された通信及びアクションの全て又は一部の能力を有してもよい。
簡潔のため、図2は、ホスト車両としての車両202、外部物体206、交通ネットワーク208、電子通信ネットワーク212、及びオペレーションセンタ230を示している。しかしながら、任意の数の車両、ネットワーク又はコンピュータ装置が使用されてもよい。いくつかの実施形態では、車両交通及び通信システム200は、図2に示されていない装置、ユニット又は要素を含む。
電子通信ネットワーク212を介してオペレーションセンタ230と通信する車両202が示されているが、車両202(及び外部物体206)は、任意の数の直接又は間接通信リンクを介してオペレーションセンタ230と通信してもよい。例えば、車両202又は外部物体206は、ブルートゥース(登録商標)通信リンク等の直接通信リンクを介してオペレーションセンタ230と通信してもよい。簡潔のため、図2は1つの交通ネットワーク208及び1つの電子通信ネットワーク212を示しているが、任意の数のネットワーク又は通信装置が使用されてもよい。
外部物体206は、図2に第2の遠隔車両として示されている。外部物体は、他の車両に限定されない。外部物体は、オペレーションセンタ230にデータを送信する能力を有する任意のインフラストラクチャ要素、例えば、フェンス、標識、建物等であってもよい。データは、例えば、インフラストラクチャ要素からのセンサデータであってもよい。
図3は、本開示の実装による予測可能な応答の状況300の図である。状況300は、自律走行車(AV)302の応答を予測し得る状況310~360、及び計画された軌道を含んでいる。
状況300は、予測可能な状況及び道路ユーザの応答の例を表している。これらの状況は、遅い時間スケールで発生する(例えば、起こる、生じる)。すなわち、AV302が高速(例えば、時速60マイル(MPH))で進んでいる場合であっても、状況310~360は、AV302の計算能力(例えば、図1のプロセッサ120等のプロセッサ及び/又は図1のコントローラ114等のコントローラの演算能力)のために、経過時間のサブ秒以内で外部物体の応答を予測し、自律走行車の軌道を決定し得るので、遅いシナリオであると考えられる。
AV302は、少なくともいくつかの検出された外部物体を追跡することが可能な世界モデル化モジュールを含み得る。世界モデル化モジュールは、複数の追跡対象物体の少なくとも一部の追跡対象物体ごとに、1つ以上の可能性のある仮説(すなわち、軌道、経路等)を予測し得る。AV302は、軌道計画システム(又は、単に軌道プランナ)を含んでもよく、このシステムは、プロセッサによって実行されて、(初期状態、所望のアクション、及び予測された軌道を有する少なくともいくつかの追跡対象物体を考慮して)衝突回避、法令遵守、快適応答(例えば、軌道、経路等)を生成し得る。
状況310において、AV302は、道路の側方にある駐車車両(静的物体)304を(すなわち、追跡コンポーネントによって)検出する。AV302(すなわち、AV302の軌道プランナ)は、以下にさらに説明するが、軌道306によって示されるように、AV302を駐車車両304の周りにナビゲートする経路(すなわち、軌道)を計画し得る。
状況320は、AV302が他の静的物体を検出する別の状況である。検出された静的物体は、穴322である。AV302は、AV302のタイヤのいずれもがポットホール322内を走行しないように、ポットホール322上を走行するような軌道324を計画し得る。
状況330において、AV302は、対向車両332及び対向車両332と同じ道路側の駐車車両334を検出する。対向車両332は移動している。したがって、対向車両332は動的物体である。対向車両332は、AV302と同じ(又は少なくとも実質的に同じである)前後方向に移動している。したがって、対向車両332は、以下にさらに説明するように、縦方向制約として分類し得る。対向車両332は、AV302とは逆方向に移動している。したがって、対向車両332は、対向縦方向制約として分類し得る。駐車車両334は、静的物体である。
AV302は、対向車両332が軌道336に追従して駐車車両334を回避(例えば、迂回)することを、(すなわち、予測コンポーネントによって)閾値を超えるある程度の確実性をもって予測し得る。軌道336は、道路の中心線337と重なる。対向車両332からの安全な距離を維持するために、AV302の軌道プランナは、位置339における曲率を含む軌道338を計画し得る。すなわち、AV302の計画軌道は、対向車両332の進路を予測してAV302を右方に移動させる。
状況340において、AV302の追跡コンポーネントは、駐車車両342(静的物体)及び移動中の自転車344(すなわち、縦方向制約である動的物体)を検出し得る。予測コンポーネントは、自転車344が軌道346に沿って駐車車両342の周りを移動することをある程度確実に決定し得る。そのため、AV302は、AV302が一定距離後に停止して、自転車344が駐車車両342を通過することを可能にするように軌道348を決定(すなわち、計画、計算、選択、生成、又は他のやり方で決定)する。別の例では、AV302は、複数の可能な軌道を決定し得る。例えば、AV302は、上述したような第1の軌道と、自転車344が駐車車両を通過する前にAV302が加速して自転車344を通過する第2の軌道と、自転車344が駐車車両342を通過しているときにAV302が自転車344の周りを通過する第3の軌道とを決定し得る。次に、軌道プランナは、決定された可能な軌道の1つを選択する。
状況350では、AV302の追跡コンポーネントが対向車両352、第1の駐車車両356、第2の駐車車両357を検出する。AV302の予測コンポーネントは、対向車両352が軌道354を辿っていると決定する。AV302は、AV302が第1の駐車車両356を通過し、第1の駐車車両356と第2の駐車車両357との間で対向車両352が通過するまで待機した後で、第2の駐車車両357を通過するように軌道358を選択する。
状況360では、AV302の予測コンポーネントは、大型トラック362が右折する可能性が最も高いと判断する。軌道プランナは、(例えば、大型トラックの運動モデルに基づいて)大型トラックは大きな旋回半径を必要とするので、大型トラック362は軌道364を辿る可能性が高いと判断する。軌道364がAV302の経路と干渉するので、AV302の軌道プランナは、大型トラック362が邪魔にならなくなるまでAV302を停止させるようにAV366の軌道302を決定する。
図4は、本開示の実装による自律走行車用システム400のコンポーネントの一例である。システム400は、図1の車両100等の自律走行車のソフトウェアパイプラインを表す。システム400は、世界モデルモジュール402と、経路計画モジュール404と、意思決定モジュール406と、軌道プランナ408と、反応軌道制御モジュール410とを含む。システム400の他の例は、より多くの、より少ない、又は他のモジュールを含み得る。いくつかの例では、モジュールを組み合わせてもよく、他の例では、モジュールを1つ以上の他のモジュールに分割し得る。
世界モデルモジュール402は、図1のセンサ126等からセンサデータを受信し、センサデータから物体を決定する(例えば、変換する、検出する)。すなわち、例えば、世界モデルモジュール402は、受信したセンサデータから道路ユーザを決定する。例えば、世界モデルモジュール402は、光検出測距(LiDAR)センサ(すなわち、センサ126のセンサ)から受信した点群を物体に変換し得る。複数のセンサからのセンサデータを融合して、物体を決定する(例えば、その正体を推測する)ことができる。物体の例としては、自転車、歩行者、車両等が含まれる。
世界モデルモジュール402は、検出された物体の少なくともいくつかについての追加情報を世界モデルモジュール402が計算及び維持することを可能にするセンサ情報を受信し得る。例えば、世界モデルモジュール402は、決定された物体の少なくともいくつかの状態を維持し得る。例えば、物体の状態には、ゼロ以上の速度、姿勢、ジオメトリ(幅、高さ、奥行き等)、分類(例えば、自転車、大型トラック、歩行者、道路標識等)、及び位置が含まれる。そのため、物体の状態は、離散状態情報(例えば、分類)及び連続状態情報(例えば、姿勢と速度)を含む。
世界モデルモジュール402は、センサ情報を融合し、物体を追跡し、動的物体のうちの少なくともいくつかについて仮説のリストを維持し(例えば、物体Aは直進、右折、又は左折しているかもしれない)、各仮説について予測軌道を作成及び維持し、各仮説の可能性推定を維持する(例えば、物体Aは、物体の姿勢/速度と軌道の姿勢/速度を考慮して、確率90%で直進している)。一例では、世界モデルモジュール402は、軌道プランナのインスタンスを使用して、動的物体の少なくともいくつかについての各物体仮説に対する予測軌道を生成する。例えば、軌道プランナのインスタンスを使用して、車両、自転車、及び歩行者の予測軌道を生成し得る。別の例では、軌道プランナのインスタンスを使用して、車両及び自転車の予測軌道を生成することができ、異なる方法を使用して、歩行者の予測軌道を生成し得る。
世界モデルモジュール402によって維持される物体は、図3に関して説明したように、静的物体及び/又は動的物体を含み得る。
経路計画モジュール404は、例えば、道路レベル計画412に関して図示される道路レベル計画を決定する。例えば、出発地と目的地を考慮して、経路計画モジュール404は、出発地から目的地までの経路を決定する。例えば、経路計画モジュール404は、AVが出発位置から目的位置までナビゲートするために従うべき道路のリスト(すなわち、道路レベル計画)を決定し得る。
経路計画モジュール404によって決定された道路レベル計画、及び世界モデルモジュール402によって維持される物体(及び対応する状態情報)は、意思決定モジュール406によって、道路レベル計画に沿った離散レベル決定を決定するために使用され得る。離散的決定414に関して、離散的決定に含まれる決定の例が示されている。離散レベル決定の例には、道路Aと道路Bの間の交差点で停止すること、ゆっくりと前進すること、ある速度制限まで加速すること、一番右の車線に合流すること等が含まれる。
軌道プランナ408は、離散レベル決定、世界モデルモジュール402によって維持される物体(及び対応する状態情報)、及び世界モデルモジュール402からの外部物体の予測軌道及び可能性を受信し得る。軌道プランナ408は、受信した情報の少なくとも一部を使用して、自律走行車に関する詳細な計画軌道を決定し得る。
例えば、詳細な計画軌道416に関して図示されるように、軌道プランナ408は、次の数秒の軌道を決定する。したがって、次の数秒が次の6秒(すなわち、6秒の先読み時間)である例では、軌道プランナ408は、次の6秒における自律走行車の軌道及び位置を決定する。例えば、軌道プランナ408は、いくつかの時間間隔(例えば、1/4秒ごと、又は他の時間間隔)で自律走行車の予測位置を決定(例えば、予測、計算等)し得る。軌道プランナ408は、例えば、図3に関して説明したように、他の道路ユーザの予測可能な応答に基づいて、詳細な計画軌道を決定し得る。
反応軌道制御モジュール410は、自律走行車が遭遇するかもしれないが、軌道プランナ408によって予測できない(例えば、処理できない)状況を処理し得る。このような状況には、軌道プランナ408の詳細な計画軌道が、物体の誤分類及び/又はまれに起こる予期しない状況に基づいていた場合の状況が含まれる。例えば、反応軌道制御モジュール410は、自律走行車の左側の静的物体が誤分類されていると決定することに応答して、詳細な計画軌道を修正し得る。例えば、物体が大型トラックとして分類されている場合があるが、新しい分類では静的道路バリア壁であると判断される。別の例では、反応軌道制御モジュール410は、自律走行車の突然のタイヤのパンクに応答して詳細な計画軌道を修正し得る。予期しない状況の他の例としては、他の車両が突然(例えば、タイヤのパンク又は高速道路のオフランプに到達するための決定が遅れたため)AVの車線から逸脱し、歩行者又は他の物体が後方の閉塞から突然現れることが含まれる。
図5は、本開示の実装による自律走行車の軌道プランナ500のレイヤの例である。軌道プランナ500は、図4の軌道プランナ408であり得るか、又はその一部であり得る。軌道プランナ500は、走行目標501を受信し得る。軌道プランナ500は、例えば、第1の位置を第2の位置に接続する一連の車線選択及び速度制限を表し得る一連の走行目標501を受信し得る。例えば、複数の走行目標501の中の1つの走行目標は、「位置xから開始し、制限速度yを遵守して、特定の識別子を有する車線(例えば、A123と等しい識別子を持つ車線)を走行する」であってもよい。軌道プランナ500は、走行目標501のシーケンスを達成する軌道を生成するために使用し得る。
軌道プランナ500は、走行線データレイヤ502と、基準軌道生成レイヤ504と、物体回避レイヤ506と、軌道最適化レイヤ508とを含む。軌道プランナ500は、最適化された軌道を生成する。軌道プランナ500の他の例は、より多くのレイヤ、より少ないレイヤ、又は他のレイヤを含み得る。いくつかの例では、複数のレイヤを結合し得る。他の例では、レイヤは1つ以上の他のレイヤに分割され得る。
走行線データレイヤ502は、軌道プランナ500によって使用され得る入力データを含む。(例えば、基準軌道生成レイヤ504によって)走行線データを使用して、第1の位置から第2の位置までの粗走行線を決定する(すなわち、生成する、計算する、選択する、又は他のやり方で決定する)ことできる。走行線は、AVが道路に沿って移動するときに、AVの縦軸が一致する道路の線と考え得る。したがって、走行線データは、走行線を決定するために使用され得るデータである。走行線は、この時点では粗いものであり、隣接する車線間の横方向への遷移に向けられたとき等の横方向の不連続性を含み得る。この時点での走行線も、以下にさらに説明するように、AVが遭遇する物体に対してはまだ調整されていない。
一例では、走行線データレイヤ502は、高精細(HD)地図データ510、遠隔操作地図データ512、記録経路データ514、先行車両データ516、駐車場データ518、及び知覚経路データ520のうちの1つ以上を含み得る。
HD地図データ510は、自律走行車が利用可能な高精細(高精度)地図からのデータである。HD地図データ510は、数センチメートル以内までの車両交通ネットワークに関する正確な情報を含み得る。例えば、HD地図データ510は、道路車線、道路分割線、交通信号、交通標識、速度制限等に関する詳細を含み得る。
遠隔操作地図データ512は、比較的短い走行線データを含み得る。例えば、遠隔操作地図データ512は、長さ100メートル~200メートルの走行線データとし得る。しかしながら、遠隔操作地図データ512は、必ずしもこれに限定されるものではない。遠隔操作地図データ512は、AVが自動的に処理することができない例外的な状況に応答して、又はそれを予期して、遠隔オペレータによって手動で生成し得る。
走行線はリアルタイムで作成し得る。次に、走行線をリアルタイムで作成する例を示す。遠隔オペレータは、AV生センサデータを遠隔で観測していてもよい。例えば、遠隔オペレータは、(例えば、AVのカメラによって捕捉される)工事区域のパイロンを(例えば、遠隔モニタ等で)見て、工事区域を通るAVの経路を描いてもよい。次に、遠隔オペレータは、フラグを持った人物がAVに前進許可を与えるのを見てもよく、その時点で、遠隔オペレータは、描かれた経路に沿ってAVを進行させ得る。
AVが以前に遭遇した例外的な状況に到達したときに経路を手動で描く処理時間を短縮するために、走行線データを遠隔に記憶し、必要に応じてAVに送信し得る。
記録された経路データ514は、自律走行車が以前に辿った経路に関するデータを含み得る。一例では、自律走行車のオペレータ(例えば、運転者又は遠隔オペレータ)は、道路から家庭のガレージまでの経路を記録してもよい。
先行車両データ516は、自律走行車と略同じ軌道に沿って自律走行車に先行する1つ以上の車両から受信したデータであり得る。一例では、自律走行車と先行車両は、図2に関して説明したように、無線通信リンクを介して通信し得る。したがって、自律走行車は、無線通信リンクを介して先行車両から軌道及び/又は他の情報を受信し得る。また、先行車両データ516は、明示的な通信リンクなしでも知覚(例えば、追従)され得る。例えば、AVは、先行車両を追跡することができ、追跡結果に基づいて先行車両の車両走行線を推定し得る。
駐車場データ518は、駐車場及び/又は駐車スペースの位置に関するデータを含む。一例では、駐車場データ518を使用して、他の車両の軌道を予測し得る。例えば、駐車場入口が他の車両に近接している場合、他の車両の予測された軌道の1つは、他の車両が駐車場に入ることであり得る。
状況によっては、地図(例えば、HD地図)情報が車両交通ネットワークの一部に対して利用できないことがある。したがって、知覚された経路データ520は、以前にマッピングされた情報がない走行線を表し得る。その代わりに、AVは、より少ない、より多い車線標示、縁石、及び道路制限又はそれ以外のものを使用して、リアルタイムで走行線を検出し得る。例えば、ある地表タイプ(例えば、舗装)から他の地表タイプ(例えば、砂利又は草)への遷移に基づいて、道路の制限を検出し得る。リアルタイムで走行線を検出するには、他の方法も使用し得る。
基準軌道生成レイヤ504は、走行線連結モジュール522、戦略的速度計画モジュール524、及び走行線合成モジュール526を含み得る。基準軌道生成レイヤ504は、粗走行線(すなわち、基準走行線)を離散時間速度計画モジュール528に提供する。図6は、基準軌道生成レイヤ504の動作の一例を示す。
経路計画モジュール404は、第1の位置から第2の位置へ移動するために使用される車線IDシーケンスを生成することができ、それによって走行目標501に対応する(例えば、提供する)。そのため、走行目標501は、車線の長さに応じて、例えば、数100メートル離れていてもよい。例えば、HD地図データ510の場合、基準軌道生成レイヤ504は、位置(例えば、GPSの位置、3Dデカルト座標等)と車線(例えば、車線の識別子)との組み合わせを走行目標501のシーケンスに用いて、AVの一連の姿勢として表される高解像度走行線を(例えば、HD地図510から)生成し得る。各姿勢は、既定の距離にあってもよい。例えば、姿勢は1~2メートル離れていてもよい。姿勢は、座標(x,y,z)、ロール角度、ピッチ角度、及び/又はヨー角度等、より多く、より少ない、又はその他の量で定義し得る。
上述したように、走行線データは、粗走行線を決定(例えば、生成、計算等)するために使用され得る。走行線連結モジュール522は、走行線データレイヤ502の入力データを連結(例えば、リンク、融合、合流、接続、統合、又はその他の連結)して、縦方向に沿って(例えば、自律走行車の経路に沿って)粗走行線を決定する。例えば、位置A(例えば、職場)から位置D(例えば、自宅)に移動するように、粗走行線を決定するために、走行線連結モジュール522は、駐車場データ518からの入力データを使用して、職場駐車場から幹線道路に出る出口の位置を決定し、HD地図データ510からのデータを使用して、幹線道路から自宅までの経路を決定し、記録された経路データ514からのデータを使用して、自宅のガレージにナビゲートし得る。
粗走行線には速度情報は含まれない。しかしながら、いくつかの例では、粗走行線は、HD地図データ510から使用(例えば、抽出)し得る速度制限情報を含み得る。戦略的速度計画モジュール524は、粗走行線の異なる部分に沿った(複数の)特定の速度を決定する。例えば、戦略的速度計画モジュール524は、粗走行線の第1の直線区間において、自律走行車の速度をその第1の直線区間の速度制限に設定してもよく、その後の粗走行線の第2のカーブ区間では、自律走行車の速度をより遅い速度に設定することを決定し得る。そのため、戦略的速度計画モジュール524は、AVの現在の状態(例えば、速度及び加速度)を考慮しているが、他の道路ユーザ又は静的物体は考慮せずに、粗走行線についての法令遵守(例えば、速度制限及び停止線の遵守)、快適性(例えば、肉体的及び精神的)、及び物理的に実現可能な速度プロファイル(例えば、走行線に沿った速度対距離)を計算する。
戦略的速度計画が戦略的速度計画モジュール524によって決定されると、走行線合成モジュール526は、粗走行線を横方向に調整し得る。戦略的な速度プロファイルと、横方向に不連続な粗走行線とを考慮して、走行線合成モジュール526は、車線変更の開始位置と終了位置を決定し、これらの位置を接続する走行線を合成する。車線変更の長さは、速度に依存し得る。
走行線合成モジュール526は、粗走行線における横方向に不連続な位置を連結する走行線を合成し得る。例えば、HD地図データ510は、道路の第1の車線上にある粗走行線の第1の区間と、同じ道路の第2の車線上にある粗走行線の第2の区間とを含むと仮定する。したがって、粗走行線には横方向の不連続性が存在する。走行線合成モジュール526は、まず、AVが第1の車線から第2の車線に遷移すべき遷移距離(言い換えれば、開始位置と終了位置)を決定する。すなわち、開始位置は、第1の車線から第2の車線への移動を開始するように自律走行車を制御する場合の道路位置である。終了位置は、自律走行車が車線変更を完了した場合の道路位置である。次に、横方向連続性モジュールは、第1の車線における開始位置と第2の車線における終了位置とを結合する新しい走行線データを生成する。
走行線合成モジュール526によって決定される遷移は、速度に依存し得る。例えば、AVがより高速で移動しているときよりも低速で移動している場合は、AVが第1の車線から第2の車線に遷移するために、より短い遷移距離が必要とされ得る。例えば、自律走行車がより遅い速度(例えば、15MPH)で走行している交通混雑状況では、遷移のために20ヤードが必要になることがある。しかしながら、自律走行車がより高速(例えば、65MPH)で走行している場合、遷移距離は100ヤードであってもよい。そのため、走行線合成モジュール526は、AVの速度に応じて遷移位置を決定し得る。
走行線合成モジュール526の出力は、物体回避レイヤ506に提供される。走行線合成モジュール526の出力は、粗走行線及び戦略的速度計画を含む。物体回避レイヤ506は、粗走行線において中期的な離散時間速度計画及び横方向制約を生成する。将来の離散的な時点について(言い換えれば、AVの経路に沿った離散位置において)、離散時間速度計画モジュール528は、AVのそれぞれの所望の速度を決定(すなわち、計算)する。
物体回避レイヤ506では、以下にさらに説明するように、粗走行線、近傍の静的物体、及び近傍の動的物体とそれらの予測軌道を使用して、物体回避レイヤ506は、AVを安全に操作し得る走行可能領域を決定(例えば、抽出)する。(後述する)各ビンの左右の境界が決定される。AVの現在の速度を考慮して、リアルタイム速度計画を生成し得る。リアルタイム速度計画は、AVの将来の位置を推定するために使用し得る。AVの将来の位置は、動的物体の将来の予想(例えば、予測)位置に対して評価し得る。AVの走行可能領域は、動的物体の(例えば、オーバーラップ)位置に対応する走行可能領域の中の領域を除去するように調整される。
物体回避レイヤ506では、粗走行線が物体に対して評価及び/又は調整される。物体は、AVの外部及び近位の物体であり得る。そのため、物体は、図4の世界モデルモジュール402に関して記載された物体であり得る。そのため、AVの現在の速度を考慮して、物体回避レイヤ506は、リアルタイム速度計画を生成する。リアルタイム速度計画を使用して、物体回避レイヤ506は、離散的な将来の時点におけるAVの将来の位置を推定し得る。将来の位置は、物体(すなわち、世界モデルの物体)の位置に対して評価され、AVの円滑な走行を提供(例えば、生成)し得る。円滑な走行(すなわち、円滑な軌道)を提供することは、以下にさらに説明するように、反復処理であり得る。
要約すると、最初に、粗走行線が生成され、次に、粗走行線から速度計画が生成され、そして、粗走行線及び速度計画を考慮して、AVの世界モデルにおいて維持される他の物体を考慮して軌道が最適化されて、最適化された所望の軌道を提供する。軌道は調整された走行可能領域で最適化される。非走行可能領域(すなわち、他の物体のためにAVを安全に走行することができない領域)は、調整された走行可能領域を提供するためにデフォルトの走行可能領域から除去される。
図6は、本開示の実装による粗走行線連結の例600を示す図である。例600は、図5の基準軌道生成レイヤ504の動作の一例である。
ビュー610では、AV611は、車線612~614を含む3車線道路の右端の車線614にある。ビュー610は、左側通行システム(すなわち、車線612~614内の交通は、図6の下から上に向かって移動する)の例であることに留意されたい。経路計画モジュール404等のルートプランナは、図5のHD地図データ510等のHD地図データに基づいて、AV611が1車線道路の車線615へ右折することを決定してもよい。HD地図は、各車線の中心線(図示せず)を提供してもよい。
場合によっては、AVの走行線は、車線又は道路の中心線と一致しないことがある。例えば、車線615は、車線615の左側に沿って駐車スペースを収容するために特別に広くてもよい。別の例では、ほとんどの運転者は中心線の少し左を運転することを好むことが分かっていてもよい。そのため、AV611の走行線は、車線615の中心線の左側に設定される。そのため、走行線連結モジュール522は、車線ジオメトリ(例えば、車線幅)を考慮して走行線を決定するために車線のジオメトリを決定する。例えば、粗走行線に旋回がある場合、走行線連結モジュール522は、車線の幅、旋回方向(例えば、右又は左)、旋回角度、及び/又は旋回速度に基づいて、走行線が(すなわち、車線の中心線から外れて)どこに移動されるかを決定する。すなわち、走行線連結モジュール522は、HD地図の中心線に基づいてAVの走行線を設定する。一例では、車線幅に基づいて走行線を設定し得る。
AVの走行線を設定するために、走行線連結モジュール522は、粗走行線に沿った車線のジオメトリを決定する。一例では、走行線連結モジュール522は、粗走行線に沿った特定の距離(例えば、100m、200m、300m等)のジオメトリを決定する。ジオメトリを決定するために、走行線連結モジュール522は、粗走行線に沿ったポリゴン616等のポリゴンを決定してもよく、これは車線境界を定義するために使用され得る。
ビュー620は、車線の幅621に基づいて走行線(すなわち、粗走行線)を決定することを示す。HD地図からは、AV611が走行している車線の右端624、左端622及び中心線626を取得し得る。走行線連結モジュール522は、幅621に基づいて走行線628(すなわち、粗走行線)を決定する。したがって、走行線628は中心線626からずれている。
ビュー630は、走行線を決定するために、例えば、図5の遠隔操作地図データ512に関して記載した遠隔操作データを使用して説明する。上述したように、HD地図データは静的データであるのに対し、遠隔操作データは、道路状況及び/又は例外的状況に基づいてリアルタイム走行線を提供し得る。例えば、AV611の走行線632に沿って工事区域が存在する。工事区域は、パイロン636等の障害物によって囲まれており、この障害物は、工事計画634を取り囲んでいる。そのため、走行線連結モジュール522は、以下にさらに説明するように、遠隔操作データによって提供されるリアルタイム走行線を使用して、走行線632を走行線638(すなわち、粗走行線)に調整する。
ビュー640は、速度に依存する車線変更を示す。速度依存車線変更は、上述したように、図5の走行線合成モジュール526によって実装し得る。一例では、図4の意思決定モジュール406によって、車線642に沿って走行するAV611は、例えば、車線642が終了するか、又はAV611が左折するために、次に車線644に入ることになる。そのため、AV611は、ある時点で車線642から車線644に移動することになる。HD地図が車線遷移情報を提供しない場合があるので、AV611の基準軌道生成レイヤ504は車線遷移時間を決定する。上述のように、遷移は速度に依存し得る。
一例では、(基準軌道生成レイヤ504がその中の1つのレイヤである)軌道プランナ500は、粗走行線に沿った点Xにおいて、(戦略的速度計画モジュール524によって決定されるように)AV611が速度Yで移動していることを決定し得る。AV611が低速(例えば、35mPH)で移動している場合、走行線合成モジュール526は、遷移が遅くなり得ると判断し得る。したがって、車線642から車線644に移動する経路は、経路646によって示されるようになり得る。一方、AV611が高速(例えば、65mPH)で走行している場合には、経路648に示すように、車線切り替えのための経路の距離は長くなる必要がある。
経路646及び648を辿るのに要する時間は同じであってもよい。しかしながら、距離は異なっている。AV611が第1の速度で走行しているときの車線遷移に必要な距離は、AV611が第1の速度よりも遅い第2の速度で走行しているときに必要な距離よりも長い。
速度に依存する車線変更を決定するために、車線変更率を使用し得る。すなわち、車線変更率は、車線642とビュー640の車線644等の2つの隣接する車線の間の接続を作成するために使用し得る。車線変更率は、「メートルごとに何メートルか」、すなわち、経路が縦1mで横に何m移動するかで定義され得る。上記のように、目標は、ターゲット時間量において車線変更を完了することを達成する車線変更率を特定することである。すなわち、AVが低速で走行している場合(例えば、ラッシュアワーの交通量が多いとき)、車線変更率は高く、短距離で(例えば、数十メートルのオーダーで)行われる。AVが高速で(例えば、高速道路の速度で)走行している場合、車線変更率は遅く、長距離(例えば、数百メートルのオーダーで)で行われる。
図7は、本開示の実装による戦略的速度計画を決定する例700である。例700は、図5の戦略的速度計画モジュール524が戦略的速度計画714を決定するために使用し得る入力の例を示す。いくつかの実装形態では、戦略的速度計画モジュール524は、戦略的速度計画を決定するために、より多くの入力、より少ない入力、又は他の入力を使用し得る。
例700では、速度制限入力及び加速度制限入力を使用し得る。速度制限は、道路速度制限702、曲率速度制限704、及びシームレスオートノマスモビリティ(SAM)データ706のうちの少なくとも1つを含み得る。加速制限は、車両加速制限710及び快適性限界712を含み得る。速度制限及び/又は加速度制限は、より多くの入力、より少ない入力、又は他の入力を含み得る。
道路速度制限702は、速度制限標識等に掲示されている道路速度制限(例えば、20mPH、65mPH等)とし得る。一例では、道路速度制限702は、HD地図から取得し得る。曲率速度制限704は、例えばAVの粗走行線に沿った旋回等の旋回の曲率に対する車速に関するデータであってもよい。あるいは、曲率速度制限704は、道路曲率情報(例えば、湾曲の回転半径)のみを提供してもよい。曲率速度制限704は、AVの横方向加速度に対する制限とし得る。そのため、速度計画は、AVが曲がるときに、曲率速度制限704と一致する減少したAV速度を含み得る。
SAMデータ706は、(自律的であるか否かにかかわらず)車両から(例えば、クラウドベースのシステムで)収集されたデータとし得る。このデータは、車両(AVを含む)が路上で安全かつ円滑に動作することを可能にする。一例では、SAMデータ706は、道路の一部に沿って車両から収集された振動データを含み得る。振動データは、道路の異なる部分における振動レベルと速度とを相関させ得る。一例では、振動データは、ある道路位置について、車両が所定の速度を超えて走行しているときに(例えば、道路の一部の速度バンプに起因する)許容できないレベルの振動を示し得る。したがって、振動の影響を最小限に抑えるために、道路の一部でAVの速度を(所定の速度以下に)落とすべきである。一例では、SAMデータ706は、オペレーションセンタ230、サーバコンピューティング装置234、又は他の何らかのネットワーク装置等の中央サーバからAVによって受信され得る。一例では、SAMデータ706は、その場所に到着する自律走行車の特定の期間(例えば、1分、10分、20分等)内に他の車両から蓄積されたデータであり得る。一例では、AVはSAMデータ706をプルしてもよい。別の例では、SAMデータ706は、AVがSAMデータ706を提供するサーバにその位置を報告することに基づいて、AVにプッシュし得る。
道路速度制限702、曲率速度制限704、及びSAMデータ706を組み合わせて、生速度制限708を提供し得る。一例では、粗走行線に沿った特定の位置の各位置について(例えば、5mごと、10mごと等)、その位置における道路速度制限702の最小速度、その位置における曲率速度制限704の速度、及びその位置におけるSAMデータ706の速度が、その位置における生速度制限708の速度として使用される。
車両加速度制限710は、AVのトルク及び出力に起因するAV加速度制限とし得る。快適性限界712は、AVの乗員がAVをどれだけ速く加速させたいか等の加速度に関する人間の快適性限界を含む。
基準軌道生成レイヤ504の戦略的速度計画モジュール524は、生速度制限708、車両加速制限710、及び快適性限界712を組み合わせて、円滑な速度計画である戦略的速度計画714を提供し得る。
上述したように、粗走行線に沿った位置では、道路速度制限702、曲率速度制限704、及びシームレスオートノマスモビリティSAMデータ706の最小値をAVの速度制限として用い得る。車両加速度制限710及び快適性限界712は、加速度と速度とを関係付ける。そのため、一例では、車両加速度制限710と快適性限界712とは、2つの最大曲線(快適性、速度)の最小値を求めることによって組み合わせ得る。したがって、低速では、快適性がAVの最大加速度を制限し得る。一方、高速では、AVの加速度制限(例えば、出力)がAVの加速度を制限し得る。速度プロファイルは、速度(走行線に沿った任意の位置における速度制限)と加速度(任意の速度における加速度制限)の制約を満たす粗走行線に沿った最速の速度プロファイルを解決することによって生成し得る。
また、上記以外の入力を用いて、戦略的スピード計画714を計算し得る。例えば、道路μ、最小巡航時間、近隣タイプ、又は他の入力のうちの1つ以上を使用し得る。道路μは、氷、雨、斜面等による道路の滑り易さに関連する。
最小巡航時間は、AVの速度を一定速度に設定し得る最小時間長に関連する。例えば、道路の区間長が500mであり、その区間の制限速度が45mPHである仮定する。さらに、AVの運動モデルを考慮して、AVが停止位置から45mPHの制限速度に達するためには250mを要し、45mPHの現在の速度を考慮して、AVが停止するためには250mが必要であると仮定する。AVが道路区間の始点で停止位置にあり、道路区間の終点でAVを再び停止する場合、AVが制限速度45mPHに達すると、AVは直ちに減速を開始しなければならない。このような速度プロファイルは、AVの乗員にとって望ましくないかつ/又は自然なものでない場合がある。そのため、例えば、最小巡航時間は、AVが減速(又は加速)を開始する前に、最小巡航時間(例えば、3秒)の間速度を維持しなければならないことを示し得る。したがって、より自然な速度プロファイルを提供し得る。
近隣タイプは、通常の人間の運転行動をモデル化するために使用することができ、これは、AVが通過している近隣のタイプに依存し得る。例えば、人間の運転者は、たとえ両方の近隣地域が同じ掲示制限速度を有していても、住宅地(例えば、子供たちが通りで遊んでいることを観測し得る場所)においては掲示制限速度を下回る速度で運転してもよく、工業地域においては少なくとも掲示制限速度で運転し得る。
図8は、本開示の実装による走行可能領域及び離散時間速度計画を決定するための処理800のフローチャートである。処理800の一部又は全ての態様は、図1に示す車両100及び図2に示す車両202を含む車両、又は図2に示すコントローラ装置232を含むコンピュータ装置で実装し得る。1つの実装では、処理800のいくつかの又は全ての態様は、本開示に記載される特徴のいくつか又は全てを組み合わせたシステムで実施し得る。例えば、処理800は、図5の物体回避レイヤ506によって利用され得る。
図9を参照して処理800を説明する。図9は、本開示の実装による走行可能領域及び離散時間速度計画を決定する図である。図9は、走行可能領域(横方向制約)及び制限された速度プロファイルの生成を示しており、これは離散時間で表され得る。走行可能領域は、例えば、自律走行車が走行可能な車両交通ネットワークの領域であり得る。最初に(例えば、処理800の開始時に)、走行可能領域は、AVが安全に走行すると予測できない領域を含んでもよい。処理800は、AVが安全に走行すると予測できない領域の走行可能領域を調整する(例えば、切り取る)。処理800は、調整された走行可能領域をもたらす。
動作810では、処理800は、AVに対して近傍の物体を識別する。一例では、近傍の物体は、世界モデルモジュール402によって維持される外部物体の少なくとも一部であってもよい。一例では、近傍の物体は、世界モデルモジュール402によって維持される全ての物体であり得る。別の例では、近傍の物体は、世界モデルモジュール402によって維持される物体のサブセットであり得る。例えば、近傍の物体は、AVから所定の距離内の物体、AVの予測到着時間内の物体、又は物体のサブセットを識別するための他の基準を満たす物体であり得る。例えば、図9のビュー910を参照すると、AV912に対して、静止車両920、静止車両914、動的対向車両918、及び動的車両916が識別される。1つの実装では、動作810は、図10~図12に関して説明したように、物体を表すドット(すなわち、境界点)及び/又はドットのグループを識別する。
動作820において、処理800は、走行可能領域を抽出する。走行可能領域は、AV912が(例えば、法的及び/又は物理的に)走行可能な領域であってもよい。一例では、走行可能領域を粗走行線から抽出し得る。例えば、走行可能領域は、粗走行線に沿って(例えば、縦方向に)AVから所定の距離であり得る。図9のビュー930における走行可能領域932は、走行可能領域の一例である。一例では、走行可能領域932は、中央分離帯934と路肩936とによって(すなわち、横方向に)囲まれた領域であり得る。一例では、AV912の現在位置に基づいてHD地図から走行可能領域を抽出し得る。走行可能領域は、AV912が配置されている車線(又は道路、又はその他の地域)の左右境界によって囲まれ得る。例えば、走行可能領域は道路の中心線をまたいでもよい。すなわち、逆方向の車線を走行可能領域に含め得る。そのため、ビュー930では、中央分離帯934が存在しない場合、走行可能領域は、走行可能領域938であってもよい。
処理800は、次に、AVが(例えば、安全に)走行できない部分を走行可能領域から除去する。「調整された走行可能領域」という用語は、本明細書に記載された静的及び/又は動的物体を考慮して領域が走行可能領域から除去された後の走行可能領域を指すために本明細書で使用される。静的及び/又は動的物体がAVの軌道に干渉しない場合、調整された走行可能領域は、走行可能領域と同じである。
動作830において、処理800は、静的物体に対して走行可能領域を調整する。すなわち、処理800は、静的物体が位置する走行可能領域の部分を走行可能領域から除去する(例えば、切り取る)。これは、AVが静的物体の周囲をナビゲート(例えば、走行)するように制御されるためである。図9のビュー940は、走行可能領域の一部を切り取ることを示す。静止車両914を回避するために、処理800は、走行可能領域932のカットアウト942を切り取る。カットアウト領域のサイズは、静的物体のサイズの推定値に基づいて決定し得る。カットアウト領域のサイズは、AVが静的物体に近づきすぎないようにクリアランス領域を含み得る。
図10~図12を参照して、静的物体の走行可能領域を調整する例をさらに説明する。以下、図13を参照して、静的物体の走行可能領域の調整処理の一例を説明する。
動作840において、処理800は、静的物体に関して離散時間速度計画を調整する。例えば、障害物又は他の道路ユーザがいない場合、離散時間速度計画は戦略的速度プロファイルに従う。例えば、調整された走行可能領域が静的物体を考慮した狭い経路を含む場合、戦略的プロファイルに逐語的に(すなわち、戦略的プロファイルに設定された通りに)従う(その速度を使用する)代わりに、処理800は、AVの速度を快適な速度まで減少させるように離散時間速度計画を調整する。例えば、静的物体を考慮して調整された走行可能領域が静的閉塞を含む場合、処理800は、AVが静的閉塞の前に所定の距離で停止するように離散時間速度計画を調整する。
動作850において、処理800は、近くにある動的物体のそれぞれについて、それぞれの経路を識別する(例えば、予測する、計算する、生成する、受信する、又は他のやり方で識別する)。一例では、少なくともいくつかの動的物体のそれぞれの経路(すなわち、軌道)の予測は、図4の世界モデルモジュール402等の世界モデルで維持し得る。したがって、処理800は、世界モデルからそれぞれの経路を受信してもよい(例えば、要求する、読み取る、又は他のやり方で受信する)。
例えば、処理800は、動的対向車両918が静的車両920を迂回するように経路922を辿ること、及び動的車両916が静的車両914を通過した後で経路924を辿ることを予測する(例えば、予測を受信する、又は他のやり方で予測する)。1つの実装では、動作820は、処理800のインスタンス(すなわち、実行)を使用して、動的物体の経路を識別する。一例では、処理800は、動的物体の経路を予測するときに、AVを動的物体の近傍の物体のリストから除外する。
一例では、動的物体の経路を予測することは、他の動的物体のそれぞれの速度及び動的物体間の進路権の推定に基づいてもよい。進路権の推定の一例では、第2の車両が車線内で第1の車両に追従している(すなわち、その後ろにある)場合、第2の車両の存在下で第1の車両がシミュレートされる(すなわち、第1の車両について経路が予測される)が、第2の車両は第1の車両が存在しない状態でシミュレートされる。
そのため、軌道プランナ500のインスタンスは、軌道プランナ500を含む自律走行車専用とすることができ、軌道プランナ500の1つ以上の他のインスタンスは、自律走行車によって使用されて、自律走行車に対して可視である動的物体(例えば、世界モデルモジュール402によって維持される動的物体)の軌道を予測し得る。
動作860において、処理800は、動的物体のための走行可能領域を調整する。すなわち、処理800は、各動的物体のそれぞれの予測軌道に基づいて、走行可能領域の一部を切り取る。処理800は、各動的物体の位置に関するタイミング情報を使用して、走行可能領域の追加部分を切り取る。動的物体のための走行可能領域内のカットアウトは、動的物体に対する予測のタイミングと、(動作840に関して説明したように)今度は静的物体を考慮している離散時間速度計画によって生成されるタイミングとを比較することによって生成される。すなわち、処理800は、動的物体について、及び動的物体の予測された軌道に基づいて、動的物体が、同じ離散的時点におけるAVの位置に対して異なる離散的時点に位置する場所を予測し得る。図14~図16を参照して、動的物体の走行可能領域を調整する例を以下にさらに説明する。図18を参照して、動的物体の走行可能領域を調整する処理の一例を以下に説明する。
動的物体の位置は、AVの予測された位置と一致させて、カットアウト部分を決定する。上述のように、AVの予測位置は、動作840で調整された(すなわち、静的物体を考慮した)離散時間速度計画に基づく。カットアウトは、動的物体の現在の位置に対応しない場合があり得る。むしろ、カットアウトは、AV及び動的物体が出会うと予測される位置に基づいてもよい。動的物体の予測軌道が走行可能領域と干渉しない場合、動的物体に対して走行可能領域のいかなる部分も切り取られない。動的物体の予測された軌道が走行可能領域と干渉する場合、動的物体との潜在的な衝突を回避するために、走行可能領域の1つ以上の部分が切り取られる。
図9のビュー950は、動的物体に対して走行可能領域を調整する(すなわち、動作860の)例を示す。処理800は、動的対向車両918が静的車両920を迂回する(例えば、避ける)ために経路922を辿ることを(動作850等によって)予測する。処理800はさらに、AV912がその現在の軌道に沿って進み続ける場合、AV912と動的対向車両918とが位置954の周囲で出会うことを予測する。そのため、処理800は、走行可能領域932からカットアウト956を切り取る。
動作870において、処理800は、動的物体に対して離散時間速度計画を調整する。(この時点において静的物体と動的物体の両方を考慮して)調整された走行可能領域がAVと同じ方向に走行する動的物体を含む場合、動的物体は縦方向制約としてラベル付けされ、AVが快適な速度及び距離でブロックしている物体に従うように離散時間速度計画が調整される。
図9のビュー960は、動的物体に対する離散時間速度計画を調整する例(すなわち、動作870)を示す。処理800は、動的車両916がAV912の調整された走行可能領域内にあり、AV912が動的車両916を通過することは、例えば、動的車両916の縁部と調整された走行可能領域の境界との間に安全なギャップが存在しないため、安全でないと判断する。このようにして、AV912は、動的車両916の後方を追従する。動的車両916が戦略的速度計画よりも遅く移動している場合、AVが快適な速度及び距離で動的車両916に従うように離散時間速度計画が調整される。また、ビュー960は、AV912のための軌道962が、例えば、カットアウト956に基づいていることを示す。
別の例では、動的車両916自体が縦方向制約を有すると決定されると仮定する。例えば、第2の車両(図示せず)が動的車両916の前方にあってもよい。そのため、第2の車両自体も、AV912に対する別の縦方向制約とみなし得る。そのため、第1の離散時間速度計画(例えば、第1の減速計画)は、動的車両916に基づいてAV912について決定してもよく、第2の離散時間速度計画(例えば、第2の減速計画)は、AV912について決定し得る。AVの離散時間速度計画としては、第1の離散時間速度計画と減速度の大きい第2の離散時間速度計画のいずれかを選択し得る。より一般的には、AVの制約に関して制約であると決定された物体自体をAVの制約として扱ってもよい。
調整された走行可能領域964は、処理800の動作から生じる調整された走行可能領域を示す。
図10~図12は、本開示の実装による静的物体のための走行可能領域を調整する例1000、1100、及び1200である。例1000、1100、及び1200は、走行可能領域の静的境界を決定することを示す。すなわち、図10~図12は、図8の動作830に関して説明した静的物体の走行可能領域の調整例である。すなわち、例1000、1100及び1200は、AVの粗走行線に沿って、AVが静的物体を参照して走行し得る場所を決定することを示す。
図10の例1000では、AV1002の粗走行線は、粗走行線1004によって表される。粗走行線1004は、本明細書では、粗走行線とも呼ばれる。粗走行線1004は、図5の基準軌道生成レイヤ504に関して説明したように決定(例えば、計算、生成等)し得る。例1000は、AV1002の走行可能領域の横方向境界を決定するための動作830の一例を示す。すなわち、例1000は、静的物体を考慮して、例えば、AV1002の走行可能領域の左右境界を決定することを示す。
このようにして、走行可能領域(すなわち、図9の走行可能領域932等の非調整の非カットアウト走行可能領域)が決定される。例えば、走行可能な領域はデフォルトの幅を有してもよい。デフォルトの幅は、AVの現在の車線又は現在の道路に基づいてもよい。デフォルトの幅は、既定の幅(例えば、8メートル)によって定義され得る。したがって、走行可能領域は道路の中心線を横断し得る。なお、デフォルトの走行可能領域は、中央分離帯にあり得るバリア(例えば、コンクリートバリア)によって制限され得ることに留意されたい。そのようなバリアは静的物体であり、走行可能領域を制限する。
AV1002の走行可能領域は、複数のビンに分割される。各ビンは、中心点1006等の中心点を有する。中心点は等間隔に配置され得る。例えば、中心点は約2メートル離れていてもよい。各ビンの左右の境界は、粗走行線1004のヘディングに関連させ得る。右境界1018及び左境界1020はビン1022の境界を示す。
境界点1008等の境界点は、静的物体から発生する。例えば、境界点は、LiDARセンサ、レーザポインタ、レーダ、又は図1のセンサ126等の任意の他のセンサからのデータから導出され得る。境界点は、占有されているか、そうでなければAVが侵入できない(x,y)座標を表し得る。静的物体に対応する各境界点は、境界点を含むビンに割り当てられる。例えば、境界点1008は、ビン1022に割り当てられる。(例えば、ビン内で、又はビンの境界を越えて)隣接する境界点は、1つ以上の静的物体に対応し得る。
各ビンの左右の境界は、ビンに割り当てられた境界点に基づいて定義(すなわち、設定)し得る。例えば、ビン1024が境界点を含まないので、ビン1024の右境界1016及び左境界1010は、(調整されていない)走行可能領域と整合する。一方、ビン1026の左境界1012は、カットアウト1028が走行可能領域から除外されているため、走行可能領域と整合しておらず、ビン1026の右側境界1014も、カットアウト1030が走行可能領域から除外されているため、走行可能領域と整合していない。
調整された走行可能領域の境界は、調整された走行可能領域の左境界を形成する分割線1032と、調整された走行可能領域の右境界を形成する分割線1034とによって表される。図を明確にするために、分割線1032、1034は、実際の境界からオフセットして示されている。すなわち、例えば、分割線1032は境界1010及び境界1012と重なっているが、明確にするために、分割線1032は境界1010及び境界1012から僅かにオフセットされて示されている。分割線1032は、調整された走行可能領域の計算された左境界である。分割線1034は、調整された走行可能領域の計算された右境界である。
計算された左右の境界は、AV1002が粗走行線1004に沿って継続し得るかどうかを決定するために使用される。AV1002を各ビンの中央まで(物理的にではなく、仮想的に又は計算上)前進させて、(コンピュータの境界を考慮した)ビンの幅は、AV1002がビンを何とか安全に通り抜け得るようなものであるかどうかを決定し得る。例えば、ビン1022に関して、AV1002は、ビンの左境界(すなわち、左側の計算された境界)を安全にクリアすることができない。したがって、以下にさらに説明するように、AV1002の軌道は変更される。例えば、AV1002を停止させ得る必要があるので、AV1002の軌道は調整する必要がない場合があり、又はAV1002の軌道を他のやり方で変更し得る。
図11は、静的境界を決定し、本開示の実装に従って離散時間速度計画を調整する際に考慮される閉塞を識別する例1100を示す。例1100では、粗走行線1103は、AV1102の粗走行線である。AV1102のデフォルトの走行可能領域は、左境界1104と右境界1106によって定義される。例1100では、AV1102を含む車線の左車線境界1108及び右車線境界1110が示されている。例1100では、走行可能領域はAV1102の車線(すなわち、左車線境界1108及び右車線境界1110によって囲まれた車線)に限定されている。そのため、車線の左右の境界は静的物体用に調整される。
左境界1104及び右境界1106は、最大可能走行可能領域(すなわち、最大境界)を定義し得る。しかしながら、AV1102を車線内に維持することが好ましい場合があるので、左車線境界1108及び右車線境界1110は、走行可能領域の境界を定義する。一例では、AV1102が自身の車線内で(例えば、左車線境界1108と右車線境界1110との間で)安全に走行できない場合、AV1102が車線境界の外であるが最大境界の中で走行し得るかどうかを評価し得る。走行可能領域を拡張することは、「拡張走行可能領域検査」と呼ばれてもよい。
右車線境界1110は、部分1112を含む。この部分1112は、後述するように、走行可能領域のこの部分が調整されるため、破線として示されている。
図10に関して説明したように、AV1102の走行可能領域は複数のビンに分割されており、ビン1116、1118等の各ビンには静的物体に対応する境界点が割り当てられている。ビン1116、1118の境界点は、大きな長方形の物体に対応しているように見えるので、その物体は(例えば、図4の世界モデルモジュール402によって)「トラック」として分類し得る。
物体(静的又は動的物体)に対応する(すなわち、それに基づいて定義される)境界は、ハード境界と呼ばれてもよい。ハード境界とは、例えば、計画した軌道がハード境界と交差する場合に、別の物体と衝突する可能性があるものである。一方、車線及び/又は道路標示は、ソフト境界と呼ばれ、合法的又は論理的な境界を表し得る。ソフト境界とは、例えば、計画された軌道がハード境界でもないソフト境界を横断する場合に、AVの動きが違法であり、かつ/又は社会的に受け入れられないが、AVは安全であり得るものである。例えば、図11に示すように、左境界1104(すなわち、左側の走行可能領域の境界)は左ハード境界を定義し、左車線境界1108は左ソフト境界を定義する。右側のハード境界は、右側の境界1106(すなわち、右側の走行可能領域の境界)と境界1114で構成され、右側のソフト境界は、右側車線境界1110及び境界1114によって定義される。
ビンの左右のハード境界間の距離を考慮して、経路が存在するかどうかを決定するために詳細検査が行われ得る。境界1114と左車線境界1108との間の距離1120は、AV1102がその中を走行する(すなわち、通過する)には狭すぎると判断される。したがって、ビン1116に対応する位置1122は、静的閉塞としてマークされる。このため、AV1102は、ビン1116,1118の境界点で表される(複数の)物体を通過することができない。したがって、AV1102は、位置1122に対応する静的閉塞の前で停止することになる。したがって、モジュール530は、AVが静的閉塞の前で停止するように離散時間速度計画を調整し得る。
別の例では、静的閉塞のために停止する代わりに、軌道プランナは、少なくともビン1116及び1118に対して、左車線境界1108を横切って、走行可能領域が延びるようにギャップ1124を通る軌道を決定する。例えば、左車線境界1108が道路の中心である場合、軌道プランナは、対向する動的物体が存在しないので、車線境界を横断しても安全であると判断し得る。
別の例では、静的閉塞の前でAVが停止するのに十分な距離がない場合、離散時間速度計画は、AVを減速させることしかできないので、AVが右ハード境界を横断して静的物体に衝突することを回避するために左ソフト境界を横断し得るように軌道を決定し得る。そのため、ハード境界とソフト境界の両方の認識を維持することにより、軌道プランナは、緊急状況下における物体回避操作へのシームレスな遷移を伴うほとんどの状況下で合法的かつ社会的に許容可能な走行である軌道を生成し得る。
一例では、ビンの境界は、ビン内の物体(例えば、境界点のグループ)の状態に基づいて調整され得る。例えば、ビン内の境界点を経時的に追跡し得る。ビン内の境界点のグループがわずかに(すなわち、移動の閾値レベル未満)移動していると判断される場合には、より高いレベルのクリアランスが要求され得る。すなわち、AV1102は、境界点が移動している場合には、境界点からさらに離れて走行し得る。一方、境界点が安定している(すなわち、移動していない)場合には、AV1102を境界点により近づけて走行し得る。そのため、ビンの境界(例えば、境界1114)は、ビン内の境界点の移動のレベルに応じて、経時的に調整し得る。
一例では、時間tにおいて境界点の移動が検出された場合、境界点の移動が継続しているか否かにかかわらず、境界点はその後(すなわち、後の時間t+xにおいて)移動しているとみなされる。
ビン内の境界点の移動に基づいてビンの境界を経時的に調整することは、フィルタされた横方向の限界と呼んでもよい。このコンテキストにおける「フィルタされる」とは、経時的に横方向の限界(例えば、ビン境界)が変更され得ることを意味する。
図12は別の例であり、本開示の実装に従って静的境界を決定する例1200である。例1200では、粗走行線1203は、AV1202の粗走行線である。AV1202のデフォルトの走行可能領域は、左車線境界1204及び右車線境界1206によって定義される。走行可能領域からカットアウト1208とカットアウト1210が切り取られる。この例では、カットアウト1210は、走行可能領域の中央にある。
カットアウト領域の境界をデフォルトの走行可能領域の境界まで延長するかどうかは、カットアウト領域とデフォルトの走行可能領域の境界との間の距離に依存し得る。例えば、カットアウト1210の右端と右車線境界1206との間のギャップ1216に対応する距離が閾値距離未満である場合、カットアウト1210は、カットアウト1210の左境界1217から右車線境界1206に延びる領域によって定義し得る。一例では、閾値距離はAV1202の幅に関連し得る。例えば、閾値距離は、AV1202の幅の1.5、2.0倍等とし得る。同様に、ビンの境界点のクラスタ(例えば、クラスタ1209)と車線境界(例えば、右車線境界1206)との間のギャップ(例えば、ギャップ1207)も決定される。ギャップ1207の場合、(AV1202がギャップを通過することができないように)ギャップ1207は閾値距離よりも小さくなるように決定されるため、カットアウト1208は右車線境界1206まで延長される。
AV1202の軌道プランナは、距離1212が、AV1202が距離1212に対応するギャップを通過し得るようなものであると決定してもよい。カットアウト1210が粗走行線1203に重なると、AV1202の軌道プランナは詳細検査を実行して、AV1202がそのギャップを通過し得るようにカットアウト1210の左又は右のギャップを決定する(例えば、見つける)。詳細検査の結果、ギャップが見つからない場合、AV1202はブロックされていると見なされ、停止しなければならない。
例1200では、ギャップ1214及びギャップ1216は共に、AV1202がいずれかのギャップ1214、1216を通過し得るようになっている。一例では、ギャップ1214、1216のうちの1つがランダムに選択される。別の例では、軌道プランナは、カットアウト1208を通過するために左方向を既に選択しているため、ギャップ1214(すなわち、カットアウト1210の左側のギャップ)を選択する。
第2の物体に関して可能な2つの経路(例えば、物体の周りの左経路と右経路)を考慮し、かつ第1の物体に関する(例えば、右又は左に)第1の経路を考慮して、「多仮説追跡」は、第2の物体に関する第2の経路(例えば、軌道)を決定することを意味する。
図13は、本開示による静的境界を決定するための処理1300のフローチャートである。処理1300の動作の一部又は全部は、処理800の動作830で実行され得る。
動作1310では、処理1300は、粗走行線に沿って境界点をビン内に編成する。境界点は、図10~図12に関して説明したように、粗走行線に沿ってビンに編成される。
動作1320において、処理1300は、粗走行線に照らしてビンの境界を検査する。ビンの境界は、粗走行線に照らして検査され、AVが少なくとも1つのギャップを通過し得るようなギャップが存在するかどうかが決定される。一例では、動作1320は、動作1320_2~1320_12によって実行され得る。動作1320は、例えば、図10のビン1026の左境界1012及び右境界1014に関して説明したようなビン境界点に基づいて、走行可能領域のビンの左右の境界を調整する。
動作1320_2では、処理1300は実際の走行線を推定する。例えば、カットアウト1208に関して説明したように、処理1300は、カットアウト1208の左側にある実際の走行線を決定する。
動作1320_4において、処理1300は、通過可能なギャップを識別する。すなわち、処理1300は、通過可能なギャップの数を識別する。例えば、図11のビン1116の左右の境界を考慮して、処理1300は、AV1102が距離1120によって定義されるギャップを通過し得るかどうかを決定する。その場合、一方のギャップが識別される。同様に、処理1300は、AV1202が図12の距離1212によって定義されるギャップを通過し得るかどうかを決定する。
動作1320_6において、単一の(すなわち、一方の)ギャップが識別された場合、処理1300は1320_12で終了する。すなわち、軌道はギャップを通過することを許可される。動作1320_4で複数のギャップが識別された場合、処理1300は動作1320_8に進む。例えば、AV1202及びカットアウト1210に関して、処理1300は、2つのギャップ、すなわち、カットアウト1210の右側のギャップ及び左側のギャップを識別する。
動作1320_8において、処理1300は、図12のギャップ1214、1216に関して説明したように、他のギャップが利用可能であるかどうかを決定するために詳細検査を実行する。例えば、ギャップ1214が小さすぎてAV1202がカットアウト1210の左側を通過できないと判断された場合、処理1300は、AV1202がギャップ1216を通過し得るかどうかをテストし得る。動作1320_8において、処理1300は、左又は右のいずれかを選択し、どちらも可能でない場合、処理1300は、静的閉塞が存在すると決定する。
動作1320_10において、先読み距離が完全に検査されると、処理1300は、動作1320_12で終了する。そうでない場合、処理1300は動作1320_2に戻り、追加の障害物を検査する。
先読み距離は、AVの速度によって変化する可能性があり得る。例えば、AVの速度に応じて先読み距離を変化させることで、計算時間を短縮することが可能であり、その一方で、前方に障害物又は横方向制約が検出された場合に、AVを停止させるか又は快適に(例えば、安全に)操縦するのに十分な時間を確保し得る。例えば、先読み時間の4秒が必要とされる場合、AVが12メートル/秒で移動しているとすると、適切な先読み距離は48メートルになり得る。AVが30メートル/秒で移動している場合(例えば、高速道路を走行しているとき)、適切な距離は120メートルであろう。
再び図5を参照すると、離散時間速度計画モジュール528は、基準軌道生成レイヤ504によって(より詳細には、戦略的速度計画モジュール524によって)決定された戦略的速度計画から目標速度及び加速度を生成し得る。離散時間速度計画モジュール528は、縦方向制約から(例えば、それに基づいて)目標速度及び加速度を生成し得る。一例では、縦方向制約は、(後述する)停止線、(後述する)仮想停止線、静的障害物(すなわち、静的物体)、及び/又は動的障害物(すなわち、動的物体)を含み得る。離散時間速度計画モジュール528は、目標速度及び加速度を反復計算する。目標速度及び加速度は、先読み時間(すなわち、将来の計画対象期間)について計算される。一例では、先読み時間は6秒であり得る。
停止線は、AVが進行する前に停止することが法律で義務付けられている線を表す。一例では、停止線は、道路上で塗料によってマーキングされ得る。別の例では、交差点構造及び停止標識位置に基づいて停止線を推定し得る。仮想停止線は、AVによって、法律で義務付けられていないが、停止して交差情報を検査することが期待される重要な位置を表すために使用され得る。例えば、左折時に、AVを停止させ、交差するトラフィックに譲らせるために、交差点の中央で仮想停止線が使用されてもよい。
離散時間速度計画モジュール528は、縦方向制約(すなわち、AVの縦方向にある静的又は動的物体)に対するそれぞれの目標速度及び/又は縦方向制約に対するそれぞれの目標距離を計算する。
離散時間速度計画モジュール528は、静的及び/又は動的物体の少なくともいくつかに対して追跡モードを設定(すなわち、選択、決定、又は他のやり方の設定)し得る。例えば、追跡モードは、「ギャップ閉鎖」、「ギャップ維持」、「ギャップ開放」、「ブレーキ」、「追従」のいずれかであり得る。例えば、図9の動的車両916に関して、離散時間速度計画モジュール528は、「ギャップ閉鎖」の追跡モードを決定し得る。例えば、図11のビン1116の物体に関しては、追跡モードを「ブレーキ」と決定し得る。利用可能な追跡モードには、より少ない、より多い、又はその他の追跡モードが含まれ得る。追跡モードは、離散時間速度計画モジュール528によって使用される調整パラメータのセットを選択するために使用し得る。調整パラメータは、目標加速度、ヒステリシスパラメータ、及び他の調整パラメータを含み得る。
次に、離散時間速度計画モジュール528の動作を説明するための例を示す。縦方向制約が見つからない場合、離散時間速度計画モジュール528は、(基準軌道生成レイヤ504によって決定されるように)AVが戦略的速度計画に基づいて動作可能であると判断し得る。一方、追跡モードが「ブレーキ」であると決定された縦方向制約が(例えば、図11のビン1116の物体に関して)検出された場合、離散時間速度計画モジュール528は、AVを停止させるための速度プロファイルを計算する。すなわち、AVを停止させるための減速速度プロファイルを計算する。
一例では、速度プロファイルは、AVの現在の速度と縦方向制約への距離とを使用して、縦方向制約の前でAVを停止させる減速速度プロファイルを計算する。
図14~図16は、本開示の実装に従って動的境界を決定する例1400、1500、及び1600である。すなわち、図14~図16は、図8の動作850に関して説明した動的物体の走行可能領域を調整する例である。すなわち、例1400、1500及び1600は、AVの粗走行線に沿って、AVが動的物体を参照して走行され得る場所を決定することを示す。
各動的物体は、利用可能な複数のクラスのうちの少なくとも1つに分類し得る。例として、使用可能なクラスには、「横方向制約」、「縦方向制約」、「対向の横方向制約」、及び「対向の縦方向制約」が含まれる。他のクラスも利用可能である。
「横方向制約」として分類される動的物体は、AVの速度ではなく経路に影響を与える。例えば、動的物体は、AVのそれと略直交する方向に移動していてもよい。すなわち、動的物体は、AVの経路を妨げる(すなわち閉塞)ことなく、AVの左側又は右側のいずれかから移動していてもよい。したがって、図5の軌道プランナ500等の軌道プランナは、動的物体を回避するためにAVの軌道を調整する必要があり得る。すなわち、AVは動的物体との衝突を避けるために(左又は右に)移動する必要があり得る。
「縦方向制約」として分類される動的物体は、AVの経路ではなく速度に影響を与える。例えば、動的物体は、AVと略同じ方向に移動し、AVの経路内にある場合があり得る。すなわち、縦方向制約物体は、AVの現在の速度でAVの経路を妨げる(すなわち、遮る)ことになる。したがって、AVの軌道プランナは、AVの軌道を調整する必要はないが、動的物体との衝突を回避するためにAVの速度を(例えば、軌道プランナの離散時間速度計画モジュール528によって)調整する必要があり得る。縦方向制約の一例は、図9の動的車両916である。すなわち、縦方向制約物体は、AVの前方にあり、かつAVよりも低速で移動している車両であり得る。そのため、動的物体との追突を回避するためにAVを減速させる必要があり得る。
対向する横方向制約物体は、横方向制約物体と同様であるが、対向する横方向制約物体がAVとは逆方向に移動する点が異なる。図9の動的対向車両918は、対向する横方向制約物体の一例である。このような場合、AVは、(例えば、図9の軌道962に関して説明したように)減速することなく移動され得る。
対向する縦方向制約物体は、縦方向制約物体と同様であるが、対向する縦方向制約物体がAVとは逆方向に移動する点が異なる。この場合、図16を参照してさらに説明するように、AVは停止する。
そのため、図5の物体回避レイヤ506のモジュール532は、動的物体の分類に基づいてAVの離散速度計画を制約する(すなわち、制約を適用する)。例えば、AVの軌道をブロックする対向する動的物体は、車線内(すなわち、AVと同じ車線内の)静的物体として処理し得る。例えば、先行の動的物体(すなわち、AVの前方にあり、AVと同じ方向に移動している動的物体)は、離散時間速度計画では縦方向制約として処理され得る。例えば、AVの計画された走行線の近くにある動的物体は、横方向制約として処理され得る。
図14の例1400では、AV1402が粗走行線1403に沿って移動している。静的物体は見あたらない。したがって、図10~図12で説明したように、静的物体に合わせて算出された走行可能領域の境界である左境界1417及び右境界1418は、走行可能領域の境界と一致する。
車両1404が、道路の右路肩から(又は、AV1402を含む車線の右側の車線から)経路1420に沿ってAVの経路に移動していると予測される。そのため、車両1404は、最初に、横方向制約として分類される。車両1404の予測経路は経路1420であり、これは粗走行線1403の近くにある(例えば、隣接している)。したがって、モジュール532は、車両1404を横方向制約として分類し続ける。
モジュール532は、異なる離散的時点におけるAV1402の位置を決定(例えば、予測)し得る。すなわち、モジュール532は、異なる時点で、粗走行線1403に沿って到着する位置を決定する。例えば、時間tにおいて(例えば、1秒で)、AV1402は位置1406にあると予測され、時間t+1において(例えば、2秒で)、AV1402は位置1408にあると予測され、時間t+2 において(例えば、3秒で)、AV1402は位置1410にあると予測される。
例1400、1500、及び1600に関して将来の3秒後の位置(すなわち、3秒の時間ウインドウ)が示されているが、事前定義された時間ウィンドウを考慮して、より多くの又はより少ない位置が決定(例えば、予測、計算等)され得る。例えば、時間ウィンドウは6秒である。予測位置の頻度も変化し得る。一例では、時間ウィンドウは6秒であり、位置が半秒ごとに決定され得る。そのため、12箇所が予測される。
上述のように、軌道プランナの第2のインスタンスは、車両1404を追跡(例えば、その軌道を予測)してもよい。そのため、第2の軌道プランナのモジュール532は、車両1404の位置を決定(例えば、予測)し得る。例えば、時間tにおいて(例えば、1秒で)、車両1404は位置1412にあると決定され、時間t+1において(例えば、2秒で)、車両1404は位置1414にあると決定され、時間t+2において(例えば、3秒で)、車両1404は位置1416にあると決定される。例として、AVのインスタンス化された全ての軌道プランナについて、同じ時間ウィンドウと予測の頻度を同じにすることができまる。しかしながら、必ずしもその必要はない。時間ウィンドウと頻度は、動的物体のタイプ(例えば、自転車、歩行者、スポーツカー、セダン、大型トラック等)によって異なり得る。AV1402の走行可能領域は、車両1404の位置に対応する領域を除去するように調整される。
図14の例1400では、車両1404とAV1402とが略同時に同じ位置にあると決定される。そのため、例えば、経路1422に対応するビンの(この例では右側の)境界を設定することによって、経路1422に対応する部分がAV1402の走行可能領域から切り取られる。図12の距離1212に関して説明したように、距離1424が、AV1402が距離1424によって定義されるギャップを何とか通り抜け得るようなものである場合、AV1402の走行線は、ギャップを通って調整される(すなわち、AV1402は左に押される)。
図15の例1500では、AV1502が粗走行線1503に沿って移動している。静的物体は見あたらない。したがって、走行可能領域の左境界1517及び右境界1518は、静的物体に対して調整されない。しかしながら、車両1504が、道路の右路肩から(又は、AV1502を含む車線の右側の車線から)経路1520に沿ってAV1502の経路内へと移動していると予測される。
最初に、例えば、車両1504が最初に検出されたときに、それは横方向制約として分類し得る。したがって、図14の車両1404に関して説明したように、車両1504に関して横方向制約を適用し得る。
図15に関して説明したように、時間t、t+1、及びt+2におけるAV1502の位置は、それぞれ位置1506、1508、及び1510であると予測され、時間t、t+1、t+2における車両1504の位置はそれぞれ1512、1514、1516と予測される。そのため、車両1504の軌道(すなわち、経路1520)は、AV1502の粗走行線1503に重なると予測される。したがって、車両1504は縦方向制約として分類される。これにより、車両1504の分類が「横方向制約」から「縦方向制約」に変更される。したがって、軌道プランナは、(図14に関して上述したように)AV1502が左に移動するように、AV1502の軌道を変更する必要はない。むしろ、離散時間速度計画モジュール528は、AV1502の粗走行線1503に縦方向制約を適用し得る。すなわち、離散時間速度計画モジュール528は、車両1504を先行車両として離散時間速度計画を計算する。「追従」の追跡モードは、離散時間速度計画モジュール528によって、AV1502が車両1504の後方に追従するように設定し得る。離散時間速度計画モジュール528はまた、例えば、AV1502が車両1504より前に位置1506に到着しないようにAV1502を減速させる離散時間速度計画を決定し得る。
図16の例1600では、AV1602が粗走行ライン1603に沿って東方向に移動しており、車両1604が西方向に移動している。車両1604は、駐車車両1606を回避するために経路1609を辿ることが予測される。粗走行線1603に沿った時間t、t+1、及びt+2におけるAV1602の位置は、それぞれ位置1610、1612、及び1614であると予測される。時間t、t+1、及びt+2における経路1609に沿った車両1604の位置は、それぞれ1616、1618、及び1620であると予測される。
軌道プランナは、AV1602と車両1604とが略同じ位置(すなわち、位置1612、1618に対応する交差位置)に同時に(すなわち、時間t+2において)存在すると予測されることを決定する。そのため、AV1602が粗走行線1603に沿って進み続けると、車両1604と衝突する可能性が非常に高い。
図16には示されていないが、例1600の走行可能領域は、図9のビュー956のカットアウト950に関して説明したように調整(すなわち、切り取り)される。すなわち、AV1602の走行可能領域は、例えば、経路1609に対応する(重なる)ビンの(この例では、左側の)境界を設定することによって、車両1604の位置に対応する領域を除去するように調整される。
交差位置(すなわち、位置1612、1618)で、軌道プランナは、交差点と走行可能領域の端との間の走行可能領域の幅を評価し得る。すなわち、軌道プランナは、距離1622を評価して、距離1622によって定義されるギャップが、AV1602が通過し得るほど十分に大きいかどうかを決定する。上述したように、距離1622は、交差点を含むビン1608の計算された境界間の距離である。
距離1622が十分に大きくない(すなわち、ギャップが小さすぎる)と判断された場合、軌道プランナは、AV1602が車両1604をクリアし得る位置を判断する。一例では、AV1602の予測された位置の少なくともいくつかについて、交差点(例えば、Xが正の整数である場合の時間t+X における位置)から開始し、時間的に後退し(例えば、時間t+X-1、t+X-2、...、t-1、tにおける位置の少なくともいくつか)、軌道プランナは、その位置において、AV1602が車両1604をクリアし得るかどうかを決定する。例1600では、軌道プランナは、AV1602が位置1610で車両1604をクリアし得ると判断し得る。
別の例では、車両1604の予測された位置の少なくともいくつかについて、交差点(例えば、Xが正の整数である場合の時間t+Xにおける位置)から開始し、時間的に前進し(例えば、時間t+X+1、t+X+2、...、t+X+nにおける位置の少なくともいくつか)、軌道プランナは、その位置において、AV1602が車両1604をクリアし得るかどうかを決定する。
軌道プランナは、車両1604が位置1620にあるときにAV1602が車両1604をクリアし得ると判断する。したがって、軌道プランナ(より詳細には、モジュール530)は、位置1624において静的閉塞を設定する。次に、軌道プランナ(より詳細には、離散時間速度計画モジュール528)は、速度及び/又は減速プロファイルを決定して、AV1602を位置1624で停止させる。このようにして、AV1602は、車両1604が位置1624に到着するまで、位置1624で停止させられ、その時点でAV1602は、粗走行線1603に沿って進んでもよい。
距離1622が十分に大きいと決定された場合、軌道プランナは、図9のビュー962の軌道960に関して示されたように、AV1602が交差点位置で車両1604を避けるように左に移動するように粗走行線1603を調整し得る。
そのため、一例では、物体回避レイヤ506は、物体を系統的に処理する。物体が制約でない場合、それは物体回避レイヤ506によって無視され得る。
物体が静的物体であり、調整された走行可能領域が通過可能である場合(例えば、場合によっては、AVが走行可能領域又は調整された走行可能領域内の1つ以上のギャップを通過し得る場合)、モジュール530は、静的制約(例えば、横方向制約)を適用して、例えば、図12の距離1212に関して説明したように、調整された走行可能領域を決定し得る。
物体が静的物体であり、走行可能領域(又は調整された走行可能領域)が通過不能である場合、離散時間速度計画モジュール528は、例えば、図11の位置1122に関して説明したように、離散時間速度プロファイルを調整し得る。
物体が動的物体であり、かつ物体が横方向制約である場合、モジュール532は、例えば、図15に関して説明したように、走行可能領域(又は調整された走行可能領域)を調整し得る。
物体が動的物体であり、かつ物体が縦方向制約である場合、離散時間速度計画モジュール528は、例えば、図16に関して説明したように、離散時間速度プロファイルを調整し得る。離散時間速度計画モジュール528は、制約を考慮して、将来のウインドウ(例えば、次の6秒間の速度計画)のための離散時間速度計画を生成し得る。
図5に戻ると、軌道最適化レイヤ508は、制約に基づいてAVのための最適軌道を決定するために、制約された動作等の(複数の)最適化動作を実行する。軌道最適化レイヤ508は、(すなわち、最適化動作への入力として)AVの動作モデル(例えば、運動学的動作モデル)、粗走行線(例えば、図10の粗走行線1004、図11の粗走行線1103、図14の粗走行線1403等)、及び/又は、粗走行線に沿ったビンの中心点(例えば、中心点1006)、離散時間速度計画、及び調整された走行可能領域(例えば、調整された走行可能領域の左右の境界)を使用して、AVのための最適軌道を計算(例えば、決定、生成等)し得る。そのため、最適軌道は、粗走行線に沿って、静的及び動的物体を考慮して、粗走行線及び左側と右側の境界が考慮される。
図17は、本開示の実装による軌道計画のさらなる例1700を示す。以下の例の各々において、図5の軌道プランナ500等の1つ以上の軌道プランナが、自律走行車内で実行され得る。軌道プランナの第1のインスタンスは、自律走行車自体の軌道を決定する。第2の軌道プランナインスタンスは、少なくとも1つの外部動的物体の軌道を予測する。いくつかの例では、第1のインスタンスが、自律走行車自体の軌道を決定することができ、外部動的物体の軌道を予測し得る。説明を簡単にするために、本明細書では、「軌道プランナ」は、第1のインスタンス及び/又は第2のインスタンスを参照するために使用される。
第1の例では、AV1702の軌道プランナは、対向車両1704が静的物体1705を回避するために軌道1706を辿ることを予測する。軌道プランナはさらに、図16に関して説明したように、AV1702が対向車両1704の軌道と走行可能領域の右境界との間のギャップを通過できないことを決定する。そのため、軌道プランナは、対向車両1704が静的閉塞1708を通過するまでAV1702を静的閉塞1708で停止させる速度計画を決定する。
第2の例では、AV1710は(すなわち、AVの軌道プランナによって)動的物体1712が経路1714を辿ることを決定する。軌道プランナは、AV1710が、(図9の走行可能領域932に関して説明したように)走行可能領域の左ハード境界であり得る道路の中心線を横断せずに、動的物体1712を通過することができないと判断する。したがって、AV1710の軌道プランナは、AV1710を静的閉塞1716で停止させる速度計画を決定する。
第3の例では、AV1720は、対向する動的物体1722が軌道1724に従うことを決定する。AV1720はさらに、AV1720が軌道1730に沿って、第1の静的物体1726と第2の静的物体1728との間にナビゲートされ、そこでAV1720は、静的閉塞1732で計算された秒数の間待機し、その後で進行するように、AV1720の軌道1730を決定する。計算された秒数は、図16の位置1624に関して説明したように、対向する動的物体1722が静的閉塞1732の位置を通過するのに十分な時間である。
第4の例では、AV1734は、大型の動的物体1736が右折中であると決定する。AV1734の軌道プランナは、大型の動的物体1736の運動モデルを使用して、大型の動的物体1736が大きな回転半径を必要とし、したがって、大型の動的物体1736が軌道1738を辿ることを決定する。したがって、AV1734の経路が大きな動的物体1736からクリアされるまで静的閉塞1740においてAV1734が停止するように、AV1734に対する速度計画が決定(例えば、計算、生成等)される。
要約すると、本開示による軌道プランナ(例えば、軌道プランナの走行線データレイヤ)は、基準となる(すなわち、粗い)走行線を決定(例えば、生成、計算、選択等)し得る。軌道プランナは、粗走行線を決定するためにいくつかの入力データを融合し得る。したがって、粗走行線は、(すなわち、複数のタイプの入力データからの)マルチソースされることを意味し得る。入力データは、HD地図データ、遠隔操作データ、記録経路データ、先行車データ、駐車場データ、局所知覚データを含み得る。軌道プランナは、より少ない入力、より多い入力、又は他の入力を使用し得る。
軌道プランナ(例えば、軌道プランナの粗走行線連結レイヤ)は、粗走行線に沿った特定の速度値を含む戦略的速度計画を生成(例えば、決定、計算等)し得る。軌道プランナは、戦略的速度計画を生成するために、道路曲率、道路μ、車両速度及び/又は加速度制限、最小巡航時間、近隣タイプの少なくとも1つ、ならびにより多く、より少なく、又は他の入力を使用し得る。
軌道プランナ(例えば、軌道プランナの粗走行線連結レイヤ)は、ハード境界(静的及び/又は動的物体に基づいて設定される)、ソフト境界(例えば、車線マーク)、フィルタされた横方向限界、多重仮説追跡、拡張可能な走行可能領域検査、及び動的物体分類(例えば、物体を対向車両、先行車、又は横方向制約として分類する)の少なくとも1つ以上に基づいて、AVのための調整された走行可能領域を決定する。
軌道プランナ(例えば、軌道プランナの離散時間速度計画モジュール)は、例えば、自然加速度プロファイル(例えば、AVの運動モデル)、先行車両加速度プロファイル、及び縦方向制約の限界の決定を用いて、離散時間速度計画を決定(例えば、計算)する。
軌道プランナ(例えば、軌道プランナの最適化された所望の軌道レイヤ)は、例えば、制約された最適化動作を使用して、AVの最適化軌道を生成(例えば、計算、決定等)する。一例では、最適化動作は、二次ペナルティ関数に基づいてもよく、又はこれを含み得る。一例では、最適化動作は、対数バリア関数に基づいてもよく、又はこれを含み得る。例えば、二次ペナルティ関数はソフト制約とともに使用し得る。例えば、対数バリア関数は、ハード制約と共に使用し得る。
図18は、本開示による物体回避のための処理1800のフローチャート図である。処理1800は、図5の軌道プランナ500等の軌道プランナによって実行し得る。
動作1810では、処理1800は、AVの走行可能領域の粗走行線に沿って第1の物体を検出する。一例では、第1の物体を検出することは、物体に対応する図10の境界点1008等の境界点を検出すること意味し得る。一例では、物体を検出することは、例えば、図4の世界モデルモジュール402に関して説明したように、世界モデルから物体を(例えば、問い合わせることによって)受信することを意味し得る。粗走行線は、例えば、図10の粗走行線1004、図11の粗走行線1103、図12の粗走行線1203等に関して説明したものであってもよい。走行可能領域は、図9の走行可能領域932に関して説明したものであってもよい。
動作1820において、処理1800は、第1の物体の予測経路を受信する。一例では、処理1800は、第1の物体の分類及び第1の物体の運動モデルに基づいて、第1の物体の予測経路を決定する。別の例では、処理1800は、第1の物体の経路を予測する軌道プランナから第1の物体の予測経路を受信する。予測される経路は、図3の軌道336、軌道346、軌道354、及び軌道364に関して説明したもの、すなわち、図14の経路142014、図15の経路1520、及び図16の経路1609であってもよい。
動作1830において、処理1800は、第1の物体の予測経路に基づいて、調整された走行可能領域を決定する。一例では、上述したように、走行可能領域から一部を切り取ることにより、調整された走行可能領域を生成し得る。別の例では、例えば、第1の対象物体が横制約でも縦方向制約でもない場合、上述したように、調整された走行可能領域は走行可能領域と同じであってもよい。
動作1840において、処理1800は、調整された走行可能領域を通るAVの軌道を決定する。軌道は、図5の軌道最適化レイヤ508に関して説明したように決定し得る。
一例では、第1の物体の予測経路に基づいて、調整された走行可能領域を決定することは、粗走行線の少なくとも一部を複数のビンに分割すること、第1の物体を複数のビンの1つのビンに割り当てること、及び1つのビンに基づいて調整された走行可能領域を決定することを含み得る。ビンは、例えば、図10に関して説明したものであってもよい。1つのビンに基づいて調整された走行可能領域を決定することは、上述したように、少なくとも1つのビンに対する境界を決定(例えば、計算)することを含み得る。
一例では、第1の物体の予測経路に基づいて調整された走行可能領域を決定することは、離散時間間隔で第1の物体の各物体位置を決定すること、離散時間間隔でAVの各AV位置を決定すること、及び各物体位置と各AV位置とに基づいて調整された走行可能領域を決定することを含み得る。第1の物体の各物体位置、AV位置、及び調整された走行可能領域の決定は、図14~図16を参照して説明したものであってもよい。
一例では、処理1800は、第1の物体を分類することを含み得る。別の例では、処理1800は、世界モデルモジュール402等から第1の物体の分類を受信し得る。第1の物体が対向する縦方向制約として分類される場合、調整された走行可能領域を通るAVの軌道を決定することは、図16に関して説明したように、第1の物体の物体位置がAVのAV位置と出会う第1の時間に続く第2の時間までAVを停止することを含み得る。
第1の物体が縦方向制約として分類される場合、調整された走行可能領域を通るAVの軌道を決定することは、図15に関して説明したように、第1の物体の後方を走行するようにAVを減速させることを含み得る。
一例では、処理1800は、第1の物体を、横方向制約、縦方向制約、対向する横方向制約、又は対向する縦方向制約として分類することも含み得る。
一例では、調整された走行可能領域を通るAVの軌道を決定することは、図16に関して説明したように、第1の物体が静的閉塞であることを決定して、AVを停止させることを含み得る。
本明細書で使用される場合、「運転者」又は「オペレータ」という用語は、同じ意味で使用されてもよい。本明細書で使用される場合、「ブレーキ」又は「減速」という用語は、同じ意味で使用されてもよい。本明細書で使用される場合、「コンピュータ」又は「コンピュータ装置」という用語は、本明細書で開示の任意の方法を実行し得る任意のユニット又はユニットの組み合わせ、又はその任意の部分若しくは複数の部分を含む。
本明細書で使用される場合、「命令」という用語は、本明細書に開示の任意の方法を実行するための指示若しくは表現、又はその任意の部分若しくは複数の部分を含んでもよく、ハードウェア、ソフトウェア又はこれらの任意の組み合わせで実現されてもよい。例えば、命令は、本明細書に記載の各方法、アルゴリズム、態様又はこれらの組み合わせのいずれかを行うためにプロセッサによって実行され得るメモリに記憶されたコンピュータプログラム等の情報として実装されてもよい。いくつかの実装形態では、命令又はその一部は、本明細書に記載の任意の方法、アルゴリズム、態様又はその組み合わせを行うための専用ハードウェアを含み得る専用プロセッサ又は回路として実装されてもよい。いくつかの実装形態では、命令の部分は、直接的に又はローカルエリアネットワーク、ワイドエリアネットワーク、インターネット又はこれらの組み合わせ等のネットワークを介して通信し得る複数の装置又は単一の装置上の複数のプロセッサに分散されてもよい。
本明細書で使用される場合、「例示」、「実施形態」、「実装」、「態様」、「特徴」又は「要素」という用語は、用例、例示又は実例としての役割を果たすことを示している。特に明示されない限り、任意の例示、実施形態、実装、態様、特徴又は要素が、互いの例示、実施形態、実装、態様、特徴又は要素から独立しており、任意の他の例示、実施形態、実装、態様、特徴又は要素と組み合わせて使用されてもよい。
本明細書で使用される場合、「決定」及び「識別」又はこれらの任意の変形の用語は、図示の及び本明細書に記載の1つ以上の装置を使用するいかなるやり方で選択、確認、計算、検索、受信、決定、確立、取得、又は他のやり方で識別又は決定することを含んでいる。
本明細書で使用される場合、「又は」という用語は、排他的な「又は」ではなく包含的な「又は」を意味することが意図されている。すなわち、他に特に定めがない限り、又は特に文脈によって明示されない限り、「XがA又はBを含む」は、任意の当然の包含的なそれの並べ替えを示すことが意図されている。XがAを含む、XがBを含む、又はXがA及びBの両方を含む場合、「XがA又はBを含む」は、上記の例示のいずれかによって満たされる。さらに、本願及び添付の請求項の中で使用される“a”及び“an”という冠詞は、一般に、単数形を指していることが文脈から明確であるか又は他に特段の定めがない限り、「1つ以上の」を意味すると解釈されるべきである。
さらに、説明の簡潔のため、本明細書の図面及び説明は一連の動作又は段階又はシーケンスを含み得るが、本明細書に開示の方法の要素は、様々な順番で又は同時に起こってもよい。さらに、本明細書に開示の方法の要素は、本明細書に明示的に提示及び開示されていない他の要素と共に起こってもよい。さらに、本明細書に記載の方法の全ての要素が、本開示による方法を実装することを要求されるとは限らない。態様、特徴及び要素は特定の組み合わせで本明細書に記載されているが、各態様、特徴又は要素は、他の態様、特徴及び/又は要素と共に又はそれらなしで独立して又は様々な組み合わせで使用されてもよい。
本開示の技術は、特定の実施形態に関連して説明されてきたが、本開示の技術は、開示された実施形態に限定されるものではなく、逆に、添付の特許請求の範囲に含まれる様々な変更及び同等の構成を包含することを意図しており、その範囲は、全てのそのような変更及び同等の構成を包含するように、法律の下で許容される最も広い解釈に一致されるものである。

Claims (20)

  1. 自律走行車(AV)による物体回避のための方法であって、
    前記AVのプロセッサによって、前記AVの近傍の物体を識別するステップと、
    前記プロセッサによって、前記AVの走行可能領域を抽出するステップと、
    前記プロセッサによって、前記走行可能領域のカットアウト部を切り取って、第1の調整された走行可能領域を取得するステップであって、前記カットアウト部は静的物体として分類される近傍の物体に対応するステップと、
    前記プロセッサによって、前記AVの前記第1の調整された走行可能領域の粗走行線に沿って第1の物体を識別するステップであって、前記第1の物体は動的物体として分類される近傍の物体であるステップと、
    前記プロセッサによって、前記第1の物体の予測経路を受信するステップと、
    前記プロセッサによって、前記第1の物体の前記予測経路に基づいて、調整された走行可能領域を決定するステップであって、前記第1の物体の前記予測経路に基づいて及び前記第1の物体の予測される将来の位置及び前記AVの計算される将来の位置に関するタイミング情報を使用して、前記第1の調整された走行可能領域の追加部分を切り取って、前記調整された走行可能領域を取得することにより行われるステップと、
    前記プロセッサによって、前記調整された走行可能領域を通る前記AVの軌道を決定するステップと
    を含む、方法。
  2. 前記第1の物体の前記予測経路に基づいて、前記調整された走行可能領域を決定するステップは、
    前記粗走行線の少なくとも一部を複数のビンに分割すること、
    前記複数のビンの中の1つのビンに前記第1の物体を割り当てること、
    前記第1の物体が前記1つのビンに割り当てられることに基づいて、前記1つのビンの右側の横方向境界又は左側の横方向境界の少なくとも1つを設定すること、及び
    前記1つのビンに基づいて前記調整された走行可能領域を決定すること
    を含む、請求項1に記載の方法。
  3. 前記第1の物体の前記予測経路に基づいて、前記調整された走行可能領域を決定するステップは、
    離散時間間隔で前記第1の物体の各物体位置を決定すること、
    前記離散時間間隔で前記AVの各AV位置を決定すること、及び前記各物体位置と前記各AV位置とに基づいて前記調整された走行可能領域を決定すること
    を含む、請求項1に記載の方法。
  4. 前記第1の物体は、対向する縦方向制約であると決定され、
    前記調整された走行可能領域を通る前記AVの軌道を決定するステップは、
    前記第1の物体の物体位置が前記AVのAV位置と一致する第1の時間に続く第2の時間まで前記AVを停止すること
    を含む、請求項3に記載の方法。
  5. 前記第1の物体は、縦方向制約であると決定され、
    前記調整された走行可能領域を通る前記AVの軌道を決定するステップは、
    前記第1の物体の後方を走行するように前記AVを減速させること
    を含む、請求項3に記載の方法。
  6. 前記プロセッサによって、前記第1の物体を、横方向制約、縦方向制約、対向する横方向制約、又は対向する縦方向制約として分類するステップ
    をさらに含む、請求項2に記載の方法。
  7. 前記調整された走行可能領域を通る前記AVの軌道を決定するステップは、
    前記第1の物体が静的閉塞であることを決定すること、及び
    前記AVを停止させること
    を含む、請求項1に記載の方法。
  8. 前記プロセッサによって、第2の物体を検出するステップ
    をさらに含み、
    前記調整された走行可能領域を通る前記AVの軌道を決定するステップは、
    前記第1の物体が第1の側を通過可能であることを決定すること、
    前記第2の物体が前記第1の側及び第2の側を通過可能であることを決定すること、及び
    前記第1の側において前記第1の物体を通過し、かつ前記第1の側において前記第2の物体を通過するように前記AVを制御すること
    を含む、請求項1に記載の方法。
  9. 自律走行車(AV)による物体回避のためのシステムであって、
    前記AVの近傍の物体を識別すること、
    前記AVの走行可能領域を抽出すること、
    前記走行可能領域のカットアウト部を切り取って、第1の調整された走行可能領域を取得することであって、前記カットアウト部は静的物体として分類される近傍の物体に対応すること、
    前記AVの前記第1の調整された走行可能領域の粗走行線に沿って第1の物体を識別することであって、前記第1の物体は動的物体として分類される近傍の物体であること、
    前記第1の物体の予測経路を受信すること、
    前記第1の物体の前記予測経路に基づいて、調整された走行可能領域を決定することであって、前記第1の物体の予測される将来の位置及び前記AVの計算される将来の位置に関するタイミング情報を使用して、前記第1の調整された走行可能領域の追加部分を切り取って、前記調整された走行可能領域を取得することにより行われること、及び
    前記調整された走行可能領域を通る前記AVの軌道を決定すること
    を行うように構成される軌道プランナを備える、システム。
  10. 前記第1の物体の前記予測経路に基づいて、前記調整された走行可能領域を決定することは、
    前記粗走行線の少なくとも一部を複数のビンに分割すること、
    前記複数のビンの中の1つのビンに前記第1の物体を割り当てること、
    前記第1の物体が前記1つのビンに割り当てられることに基づいて、前記1つのビンの右側の横方向境界又は左側の横方向境界の少なくとも1つを設定すること、及び
    前記1つのビンに基づいて前記調整された走行可能領域を決定すること
    を含む、請求項9に記載のシステム。
  11. 前記第1の物体の前記予測経路に基づいて、前記調整された走行可能領域を決定することは、
    離散時間間隔で前記第1の物体の各物体位置を決定すること、
    前記離散時間間隔で前記AVの各AV位置を決定すること、及び前記各物体位置と前記各AV位置とに基づいて前記調整された走行可能領域を決定すること
    を含む、請求項10に記載のシステム。
  12. 前記第1の物体は、対向する縦方向制約であると決定され、
    前記調整された走行可能領域を通る前記AVの軌道を決定することは、
    前記第1の物体の物体位置が前記AVのAV位置と一致する第1の時間に続く第2の時間まで前記AVを停止すること
    を含む、請求項11に記載のシステム。
  13. 前記第1の物体は、縦方向制約であると決定され、
    前記調整された走行可能領域を通る前記AVの軌道を決定することは、
    前記第1の物体の後方を走行するように前記AVを減速させること
    を含む、請求項11に記載のシステム。
  14. 前記軌道プランナは、
    前記第1の物体を、横方向制約、縦方向制約、対向する横方向制約、又は対向する縦方向制約として分類すること
    を行うようにさらに構成される、請求項10に記載のシステム。
  15. 前記調整された走行可能領域を通る前記AVの軌道を決定することは、
    前記第1の物体が静的閉塞であることを決定すること、及び
    前記AVを停止させること
    を含む、請求項9に記載のシステム。
  16. 前記軌道プランナは、第2の物体を検出するようにさらに構成され、
    前記調整された走行可能領域を通る前記AVの軌道を決定することは、
    前記第1の物体が第1の側を通過可能であることを決定すること、
    前記第2の物体が前記第1の側及び第2の側を通過可能であることを決定すること、及び
    前記第1の側において前記第1の物体を通過し、かつ前記第1の側において前記第2の物体を通過するように前記AVを制御すること
    を含む、請求項9に記載のシステム。
  17. 自律走行車(AV)による物体回避のための方法であって、
    前記AVのプロセッサによって、前記AVの近傍の物体を識別するステップと、
    前記プロセッサによって、調整された走行可能領域を決定するステップであって、
    前記AVの走行可能領域を抽出すること、
    前記走行可能領域のカットアウト部を切り取って、第1の調整された走行可能領域を取得することであって、前記カットアウト部は静的物体として分類される近傍の物体に対応すること、
    前記AVの前記第1の調整された走行可能領域の粗走行線に沿って第1の物体を識別することであって、前記第1の物体は動的物体として分類される近傍の物体であること、
    前記粗走行線の少なくとも一部を複数のビンに分割すること、
    前記複数のビンの中の1つのビンに前記第1の物体を割り当てること、
    前記第1の物体が前記1つのビンに割り当てられることに基づいて、前記1つのビンの右側の横方向境界又は左側の横方向境界の少なくとも1つを設定すること、及び
    前記1つのビン及び前記第1の調整された走行可能領域に基づいて前記調整された走行可能領域を決定すること
    を行うステップと、
    前記プロセッサによって、前記調整された走行可能領域を通る前記AVの軌道を決定するステップと
    を含む、方法。
  18. 前記調整された走行可能領域を通る前記AVの軌道を決定するステップは、
    前記1つのビンの境界によって定義されるギャップは、前記AVが前記ギャップを通り抜け得るものであるかどうかを決定すること
    を含む、請求項17に記載の方法。
  19. 前記AVが前記ギャップを通り抜けられない場合、
    前記プロセッサによって、前記1つのビンに静的閉塞を設定するステップと、
    前記プロセッサによって、前記1つのビンの前で前記AVを停止させるステップと
    をさらに含む、請求項18に記載の方法。
  20. 前記プロセッサによって、前記粗走行線に沿って第2の物体の検出するステップと、
    前記プロセッサによって、前記第2の物体を対向する縦方向制約として分類するステップと、
    前記プロセッサによって、第1の時間に続く第2の時間まで前記AVを停止させるステップであって、前記AVの第1の位置と前記第2の物体の第2の位置とが前記第1の時間で一致するステップと
    をさらに含む、請求項17に記載の方法。
JP2020566219A 2018-05-31 2018-05-31 軌道計画 Active JP7194755B2 (ja)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/US2018/035441 WO2019231455A1 (en) 2018-05-31 2018-05-31 Trajectory planning

Publications (2)

Publication Number Publication Date
JP2021526474A JP2021526474A (ja) 2021-10-07
JP7194755B2 true JP7194755B2 (ja) 2022-12-22

Family

ID=68697323

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020566219A Active JP7194755B2 (ja) 2018-05-31 2018-05-31 軌道計画

Country Status (6)

Country Link
US (1) US12043284B2 (ja)
EP (1) EP3802254B1 (ja)
JP (1) JP7194755B2 (ja)
CN (1) CN112203918B (ja)
RU (1) RU2751382C1 (ja)
WO (1) WO2019231455A1 (ja)

Families Citing this family (55)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7103000B2 (ja) * 2018-07-12 2022-07-20 株式会社デンソー 車両制御装置
US11392127B2 (en) * 2018-10-15 2022-07-19 Zoox, Inc. Trajectory initialization
DE102018217840A1 (de) * 2018-10-18 2020-04-23 Volkswagen Aktiengesellschaft Verfahren und System zum Bestimmen eines Umfeldmodells für ein Fahrzeug
KR102668309B1 (ko) * 2018-12-18 2024-05-29 현대자동차주식회사 자율 주행 차량 및 그를 이용한 차량의 주행 제어 방법
CN109712421B (zh) * 2019-02-22 2021-06-04 百度在线网络技术(北京)有限公司 自动驾驶车辆的速度规划方法、装置和存储介质
FR3093305B1 (fr) * 2019-02-28 2021-01-29 Psa Automobiles Sa Régulation de la vitesse d’un véhicule lors d’un dépassement en virage
JP2020164045A (ja) * 2019-03-29 2020-10-08 マツダ株式会社 車両走行制御装置
US11731615B2 (en) * 2019-04-28 2023-08-22 Ottopia Technologies Ltd. System and method for remote operator assisted driving through collision avoidance
US11462111B2 (en) * 2019-04-29 2022-10-04 Qualcomm Incorporated Method and apparatus for vehicle maneuver planning and messaging
US11772638B2 (en) 2019-05-07 2023-10-03 Motional Ad Llc Systems and methods for planning and updating a vehicle's trajectory
KR102061750B1 (ko) * 2019-05-15 2020-01-03 주식회사 라이드플럭스 사전 정보를 이용하여 차량의 주행을 제어하는 방법 및 장치
DE102020206659A1 (de) * 2019-05-30 2020-12-03 Robert Bosch Gesellschaft mit beschränkter Haftung Multi-hypothesen-objektverfologung für automatisierte fahrsysteme
JP7325251B2 (ja) * 2019-07-10 2023-08-14 日立Astemo株式会社 電子制御装置
CN110619666B (zh) * 2019-09-20 2022-05-27 阿波罗智能技术(北京)有限公司 用于标定相机的方法及装置
JP7215391B2 (ja) * 2019-10-15 2023-01-31 トヨタ自動車株式会社 自動運転車両の車両制御システム及び車両制御装置
US20210191387A1 (en) * 2019-12-23 2021-06-24 Autonomous Solutions, Inc. System and method for assisted teleoperations of vehicles
CN111123933B (zh) * 2019-12-24 2021-10-01 华为技术有限公司 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车
EP4071441A4 (en) * 2020-01-02 2022-12-28 Huawei Technologies Co., Ltd. METHOD AND DEVICE FOR PROCESSING PREDICTED TRAJECTORY OF TRAJECTORY, AND METHOD AND DEVICE FOR DISPLAYING RESTRICTION BARRIER
WO2021147071A1 (en) * 2020-01-23 2021-07-29 Baidu.Com Times Technology (Beijing) Co., Ltd. Cross-platform control profiling for autonomous vehicle control
CN111252069B (zh) * 2020-02-05 2021-08-31 北京百度网讯科技有限公司 车辆变道的方法及装置
CN113247016A (zh) * 2020-02-07 2021-08-13 阿里巴巴集团控股有限公司 一种数据处理方法、行驶引导方法、装置及相关设备
EP3866074B1 (en) * 2020-02-14 2022-11-30 Robert Bosch GmbH Method and device for controlling a robot
GB2592197A (en) * 2020-02-18 2021-08-25 Daimler Ag Autonomous vehicle and system thereof
CN112534483B (zh) * 2020-03-04 2021-12-14 华为技术有限公司 预测车辆驶出口的方法和装置
US11520342B2 (en) * 2020-03-12 2022-12-06 Pony Ai Inc. System and method for determining realistic trajectories
CN111062372B (zh) * 2020-03-13 2020-07-03 北京三快在线科技有限公司 一种预测障碍物轨迹的方法及装置
EP4122787B1 (en) * 2020-03-19 2024-04-24 NISSAN MOTOR Co., Ltd. Vehicle travel assistance method and vehicle travel assistance device
JP7369077B2 (ja) * 2020-03-31 2023-10-25 本田技研工業株式会社 車両制御装置、車両制御方法、及びプログラム
US11556127B2 (en) * 2020-04-03 2023-01-17 Baidu Usa Llc Static obstacle map based perception system
CN111452786B (zh) * 2020-04-14 2021-03-19 北京理工大学 一种无人车辆避障方法及系统
US11904890B2 (en) * 2020-06-17 2024-02-20 Baidu Usa Llc Lane change system for lanes with different speed limits
US12071160B2 (en) * 2020-07-20 2024-08-27 Aurora Operations, Inc. Systems and methods for generating vehicle corridors to improve path planning efficiency
US11945472B2 (en) * 2020-08-28 2024-04-02 Motional Ad Llc Trajectory planning of vehicles using route information
US12067881B1 (en) * 2020-09-29 2024-08-20 United Services Automobile Association (Usaa) Motor vehicle safety systems and methods for protecting bicyclists
DE102020126689A1 (de) * 2020-10-12 2022-04-14 Volocopter Gmbh Fluggerät sowie Verfahren und rechnergestütztes System zur Steuerung eines Fluggeräts
US20220163966A1 (en) * 2020-11-25 2022-05-26 Zoox, Inc. Object uncertainty models to assist with drivable area determinations
US12116007B2 (en) 2020-12-09 2024-10-15 Waymo Llc Trajectory limiting for autonomous vehicles
US20220198107A1 (en) * 2020-12-23 2022-06-23 Waymo Llc Simulations for evaluating driving behaviors of autonomous vehicles
JP7400754B2 (ja) * 2021-02-24 2023-12-19 トヨタ自動車株式会社 遠隔支援システム及び遠隔支援方法
US11945441B2 (en) 2021-03-31 2024-04-02 Nissan North America, Inc. Explainability and interface design for lane-level route planner
US12024204B2 (en) * 2021-04-09 2024-07-02 Direct Cursus Technology L.L.C Method of and system for predicting a maneuver of an object
CN113022593B (zh) * 2021-04-09 2022-10-14 长沙智能驾驶研究院有限公司 障碍物处理方法、装置和行驶设备
US12060083B2 (en) * 2021-04-23 2024-08-13 Motional Ad Llc Planning with dynamic state a trajectory of an autonomous vehicle
US20220371613A1 (en) * 2021-05-21 2022-11-24 Zoox, Inc. Vehicle trajectory determination
CN113415274B (zh) * 2021-07-14 2022-07-05 重庆长安汽车股份有限公司 自动驾驶的跟车轨迹规划系统、方法、车辆及存储介质
US20230029093A1 (en) 2021-07-20 2023-01-26 Nissan North America, Inc. Computing Framework for Vehicle Decision Making and Traffic Management
US20230162597A1 (en) * 2021-11-19 2023-05-25 Qualcomm Incorporated Managing Vehicle Behavior Based On Predicted Behavior Of Other Vehicles
US11938929B2 (en) * 2021-12-15 2024-03-26 Ford Global Technologies, Llc Obstacle avoidance for vehicle with trailer
US20230192075A1 (en) * 2021-12-22 2023-06-22 Joseph Burtch Automated driving obstacle avoidance along a path
US20230373471A1 (en) * 2022-05-17 2023-11-23 Ford Global Technologies, Llc Obstacle avoidance for vehicle
CN114964292B (zh) * 2022-05-30 2023-10-20 国汽智控(北京)科技有限公司 全局路径规划方法、装置、电子设备及存储介质
CN115103161B (zh) * 2022-06-22 2024-08-16 重庆紫光华山智安科技有限公司 基于视频推进的巡防方法、系统、设备及介质
GB2625577A (en) * 2022-12-21 2024-06-26 Oxa Autonomy Ltd Generating a trajectory for an autonomous vehicle
CN118683519A (zh) * 2023-03-23 2024-09-24 华为技术有限公司 一种避让控制方法、智能设备及车辆
CN118254787A (zh) * 2024-03-08 2024-06-28 阿维塔科技(重庆)有限公司 车辆控制方法、装置、设备及存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008102690A (ja) 2006-10-18 2008-05-01 Aisin Aw Co Ltd 運転支援方法及び運転支援装置
JP2015532747A (ja) 2012-08-24 2015-11-12 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツングRobert Bosch Gmbh ドライバーアシストシステム及びドライバーアシストシステムの作動方法
WO2016031036A1 (ja) 2014-08-29 2016-03-03 日産自動車株式会社 走行制御装置および走行制御方法

Family Cites Families (68)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5646843A (en) 1990-02-05 1997-07-08 Caterpillar Inc. Apparatus and method for surface based vehicle control system
US5684845A (en) 1996-08-30 1997-11-04 Framatome Technologies, Inc. Multi-axis spacer grid keying fixture
DE19749306A1 (de) * 1996-12-20 1998-06-25 Mannesmann Vdo Ag Verfahren und Anordnung zur vorausschauenden Bestimmung eines Fahrkorridors eines Kraftfahrzeuges
ATE269983T1 (de) * 1999-12-21 2004-07-15 Lockheed Corp Verfahren und vorrichtung zur räumlichen kollisionsvermeidung
JP2005316759A (ja) 2004-04-28 2005-11-10 Mitsubishi Heavy Ind Ltd 移動体の障害物回避方法及び該移動体
EP1879149B1 (en) 2006-07-10 2016-03-16 Fondazione Bruno Kessler method and apparatus for tracking a number of objects or object parts in image sequences
US7912596B2 (en) 2007-05-30 2011-03-22 Honeywell International Inc. Vehicle trajectory visualization system
US8229163B2 (en) 2007-08-22 2012-07-24 American Gnc Corporation 4D GIS based virtual reality for moving target prediction
US8374388B2 (en) 2007-12-28 2013-02-12 Rustam Stolkin Real-time tracking of non-rigid objects in image sequences for which the background may be changing
EP2345998B1 (en) 2009-12-01 2019-11-20 Honda Research Institute Europe GmbH Multi-object tracking with a knowledge-based, autonomous adaptation of the tracking modeling level
US8423336B2 (en) 2009-12-16 2013-04-16 The United States Of America As Represented By The Secretary Of The Navy Aerodynamic simulation system and method for objects dispensed from an aircraft
US8509982B2 (en) 2010-10-05 2013-08-13 Google Inc. Zone driving
FR2976355B1 (fr) 2011-06-09 2013-06-21 Jean Luc Desbordes Dispositif de mesure de vitesse et de position d'un vehicule se deplacant le long d'une voie de guidage, procede et produit programme d'ordinateur correspondant.
RU2479015C1 (ru) * 2012-01-11 2013-04-10 Федеральное государственное бюджетное образовательное учреждение высшего профессионального образования "Санкт-Петербургский государственный электротехнический университет "ЛЭТИ" им. В.И. Ульянова (Ленина)" Способ определения траектории движения автономного транспортного средства в динамической среде
EP2615598B1 (en) 2012-01-11 2017-12-06 Honda Research Institute Europe GmbH Vehicle with computing means for monitoring and predicting traffic participant objects
JP5527382B2 (ja) 2012-10-12 2014-06-18 トヨタ自動車株式会社 走行支援システム及び制御装置
US8473144B1 (en) 2012-10-30 2013-06-25 Google Inc. Controlling vehicle lateral lane positioning
JP5835243B2 (ja) 2013-02-07 2015-12-24 株式会社デンソー 物標認識装置
US9280899B2 (en) 2013-08-06 2016-03-08 GM Global Technology Operations LLC Dynamic safety shields for situation assessment and decision making in collision avoidance tasks
DE102013013867A1 (de) * 2013-08-20 2015-03-12 Audi Ag Kraftfahrzeug und Verfahren zur Steuerung eines Kraftfahrzeugs
US9199668B2 (en) * 2013-10-28 2015-12-01 GM Global Technology Operations LLC Path planning for evasive steering maneuver employing a virtual potential field technique
US9090260B2 (en) 2013-12-04 2015-07-28 Mobileye Vision Technologies Ltd. Image-based velocity control for a turning vehicle
US9650051B2 (en) 2013-12-22 2017-05-16 Lytx, Inc. Autonomous driving comparison and evaluation
US9457807B2 (en) * 2014-06-05 2016-10-04 GM Global Technology Operations LLC Unified motion planning algorithm for autonomous driving vehicle in obstacle avoidance maneuver
US9428187B2 (en) 2014-06-05 2016-08-30 GM Global Technology Operations LLC Lane change path planning algorithm for autonomous driving vehicle
KR20150144125A (ko) * 2014-06-16 2015-12-24 현대모비스 주식회사 안전 운전 유도 시스템 및 이의 방법
WO2015198426A1 (ja) * 2014-06-25 2015-12-30 日産自動車株式会社 車両制御装置
US9229453B1 (en) * 2014-08-29 2016-01-05 GM Global Technology Operations LLC Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle
EP3001272B1 (en) 2014-09-26 2017-04-12 Volvo Car Corporation Method of trajectory planning for yielding manoeuvres
US10368035B2 (en) 2015-03-20 2019-07-30 Nec Corporation Monitoring system, monitoring method, and monitoring program
US9786177B2 (en) 2015-04-10 2017-10-10 Honda Motor Co., Ltd. Pedestrian path predictions
JP2016206879A (ja) 2015-04-21 2016-12-08 本田技研工業株式会社 パラメータ分類装置並びにパラメータ分類装置を用いた移動体模擬運動生成装置及び移動体運動生成装置
US9868443B2 (en) 2015-04-27 2018-01-16 GM Global Technology Operations LLC Reactive path planning for autonomous driving
US10234859B2 (en) * 2015-08-20 2019-03-19 Harman International Industries, Incorporated Systems and methods for driver assistance
US9940625B2 (en) 2015-09-02 2018-04-10 Ford Global Technologies, Llc Autonomous driving certification generalizer
US10126810B2 (en) 2015-09-29 2018-11-13 Emerson Process Management Power & Water Solutions, Inc. Method for controlling power generation unit to desired output as specified by load demand signal by using modified control signal
KR102498091B1 (ko) 2015-09-30 2023-02-09 소니그룹주식회사 운전 제어 장치 및 운전 제어 방법, 그리고 프로그램
US10229363B2 (en) 2015-10-19 2019-03-12 Ford Global Technologies, Llc Probabilistic inference using weighted-integrals-and-sums-by-hashing for object tracking
US10496766B2 (en) 2015-11-05 2019-12-03 Zoox, Inc. Simulation system and methods for autonomous vehicles
JP6798779B2 (ja) 2015-11-04 2020-12-09 トヨタ自動車株式会社 地図更新判定システム
US9910441B2 (en) 2015-11-04 2018-03-06 Zoox, Inc. Adaptive autonomous vehicle planner logic
WO2017079349A1 (en) * 2015-11-04 2017-05-11 Zoox, Inc. System for implementing an active safety system in an autonomous vehicle
US9958864B2 (en) 2015-11-04 2018-05-01 Zoox, Inc. Coordination of dispatching and maintaining fleet of autonomous vehicles
US10152882B2 (en) 2015-11-30 2018-12-11 Nissan North America, Inc. Host vehicle operation using remote vehicle intention prediction
KR101714273B1 (ko) * 2015-12-11 2017-03-08 현대자동차주식회사 자율 주행 시스템의 경로 제어 방법 및 그 장치
DE102016212292A1 (de) 2016-01-28 2017-08-03 Volkswagen Aktiengesellschaft Verfahren und Vorrichtung zum Bereitstellen einer Plantrajektorie für ein Kraftfahrzeug
DE102016203086B4 (de) * 2016-02-26 2018-06-28 Robert Bosch Gmbh Verfahren und Vorrichtung zur Fahrerassistenz
US9857795B2 (en) 2016-03-24 2018-01-02 Honda Motor Co., Ltd. System and method for trajectory planning for unexpected pedestrians
JP6589713B2 (ja) 2016-03-24 2019-10-16 トヨタ自動車株式会社 自動運転車両を用いたタクシーサービスシステム
US20170329332A1 (en) 2016-05-10 2017-11-16 Uber Technologies, Inc. Control system to adjust operation of an autonomous vehicle based on a probability of interference by a dynamic object
US10331138B2 (en) * 2016-07-05 2019-06-25 Baidu Usa Llc Standard scene-based planning control methods for operating autonomous vehicles
US10162354B2 (en) 2016-07-21 2018-12-25 Baidu Usa Llc Controlling error corrected planning methods for operating autonomous vehicles
US10882408B2 (en) 2016-08-24 2021-01-05 Keyssa Systems, Inc. Mechanical connectors for contactless communication units
US10345815B2 (en) 2016-09-14 2019-07-09 Qualcomm Incorporated Motion planning and intention prediction for autonomous driving in highway scenarios via graphical model-based factorization
WO2018057978A1 (en) 2016-09-23 2018-03-29 Apple Inc. Decision making for autonomous vehicle motion control
US10227075B2 (en) 2016-09-28 2019-03-12 Baidu Usa Llc System delay estimation method for autonomous vehicle control
US10115305B2 (en) 2016-09-30 2018-10-30 Nissan North America, Inc. Optimizing autonomous car's driving time and user experience using traffic signal information
US10146223B1 (en) 2016-10-21 2018-12-04 Waymo Llc Handling sensor occlusions for autonomous vehicles
JP6704062B2 (ja) * 2016-10-25 2020-06-03 本田技研工業株式会社 車両制御装置
JP6547735B2 (ja) 2016-12-22 2019-07-24 トヨタ自動車株式会社 衝突回避支援装置
JP2018136240A (ja) 2017-02-23 2018-08-30 三菱電機株式会社 推定装置、推定方法、推定装置を備えた追尾装置、および推定方法を備えた追尾方法
JP6799150B2 (ja) * 2017-05-25 2020-12-09 本田技研工業株式会社 車両制御装置
US10671079B2 (en) 2017-10-24 2020-06-02 Waymo Llc Speed-dependent required lateral clearance for autonomous vehicle path planning
US10401863B2 (en) * 2017-11-22 2019-09-03 GM Global Technology Operations LLC Road corridor
US10706563B2 (en) 2018-05-15 2020-07-07 Qualcomm Incorporated State and position prediction of observed vehicles using optical tracking of wheel rotation
US10754032B2 (en) 2018-06-21 2020-08-25 Intel Corporation Perception device
US10829114B2 (en) 2019-02-06 2020-11-10 Ford Global Technologies, Llc Vehicle target tracking
US11927502B2 (en) 2019-04-29 2024-03-12 Nvidia Corporation Simulating realistic test data from transformed real-world sensor data for autonomous machine applications

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008102690A (ja) 2006-10-18 2008-05-01 Aisin Aw Co Ltd 運転支援方法及び運転支援装置
JP2015532747A (ja) 2012-08-24 2015-11-12 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツングRobert Bosch Gmbh ドライバーアシストシステム及びドライバーアシストシステムの作動方法
WO2016031036A1 (ja) 2014-08-29 2016-03-03 日産自動車株式会社 走行制御装置および走行制御方法

Also Published As

Publication number Publication date
WO2019231455A1 (en) 2019-12-05
CN112203918B (zh) 2023-11-21
JP2021526474A (ja) 2021-10-07
EP3802254B1 (en) 2024-07-10
EP3802254A4 (en) 2022-01-19
EP3802254A1 (en) 2021-04-14
RU2751382C1 (ru) 2021-07-13
US20210237769A1 (en) 2021-08-05
CN112203918A (zh) 2021-01-08
US12043284B2 (en) 2024-07-23

Similar Documents

Publication Publication Date Title
JP7194755B2 (ja) 軌道計画
JP7401650B2 (ja) 偶発事象対応計画及び安全保障
JP7140849B2 (ja) 確率的オブジェクト追跡及び予測フレームワーク
US10569773B2 (en) Predicting behaviors of oncoming vehicles
US10745011B2 (en) Predicting yield behaviors
JP6972392B2 (ja) 自律走行シミュレーションのための時間伸縮法
US20210035442A1 (en) Autonomous Vehicles and a Mobility Manager as a Traffic Monitor
US12071127B2 (en) Proactive risk mitigation
US20220379923A1 (en) Road User Categorization Through Monitoring

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210127

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201222

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A711

Effective date: 20210604

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20210608

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220201

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220405

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220906

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221024

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221212

R150 Certificate of patent or registration of utility model

Ref document number: 7194755

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