JP2020185968A - 車両制御装置、車両制御方法、およびプログラム - Google Patents
車両制御装置、車両制御方法、およびプログラム Download PDFInfo
- Publication number
- JP2020185968A JP2020185968A JP2019093696A JP2019093696A JP2020185968A JP 2020185968 A JP2020185968 A JP 2020185968A JP 2019093696 A JP2019093696 A JP 2019093696A JP 2019093696 A JP2019093696 A JP 2019093696A JP 2020185968 A JP2020185968 A JP 2020185968A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- track
- obstacle
- traveling
- reference position
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims description 15
- 230000009471 action Effects 0.000 description 36
- 101100224347 Arabidopsis thaliana DOF3.4 gene Proteins 0.000 description 15
- 101100224349 Arabidopsis thaliana DOF3.6 gene Proteins 0.000 description 15
- 101100241976 Schizosaccharomyces pombe (strain 972 / ATCC 24843) obp1 gene Proteins 0.000 description 15
- 230000004048 modification Effects 0.000 description 14
- 238000012986 modification Methods 0.000 description 14
- 238000004891 communication Methods 0.000 description 13
- 238000010586 diagram Methods 0.000 description 13
- 230000001133 acceleration Effects 0.000 description 10
- 230000015654 memory Effects 0.000 description 10
- 101100010139 Arabidopsis thaliana DOF1.1 gene Proteins 0.000 description 9
- 238000012545 processing Methods 0.000 description 9
- 230000006870 function Effects 0.000 description 8
- 230000008859 change Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 238000005070 sampling Methods 0.000 description 6
- 239000013598 vector Substances 0.000 description 6
- 238000001514 detection method Methods 0.000 description 4
- 230000006399 behavior Effects 0.000 description 3
- 230000033228 biological regulation Effects 0.000 description 3
- 238000002485 combustion reaction Methods 0.000 description 3
- 238000010276 construction Methods 0.000 description 3
- 238000013473 artificial intelligence Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000001052 transient effect Effects 0.000 description 2
- 230000003542 behavioural effect Effects 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000036461 convulsion Effects 0.000 description 1
- 238000013135 deep learning Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000007499 fusion processing Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 229910044991 metal oxide Inorganic materials 0.000 description 1
- 150000004706 metal oxides Chemical class 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000003936 working memory Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0015—Planning or execution of driving tasks specially adapted for safety
- B60W60/0016—Planning or execution of driving tasks specially adapted for safety of the vehicle or its occupants
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0027—Planning or execution of driving tasks using trajectory prediction for other traffic participants
- B60W60/00272—Planning or execution of driving tasks using trajectory prediction for other traffic participants relying on extrapolation of current movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes 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/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes 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/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes 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/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0953—Predicting travel path or likelihood of collision the prediction being responsive to vehicle dynamic parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0015—Planning or execution of driving tasks specially adapted for safety
- B60W60/0017—Planning or execution of driving tasks specially adapted for safety of other traffic participants
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0027—Planning or execution of driving tasks using trajectory prediction for other traffic participants
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0027—Planning or execution of driving tasks using trajectory prediction for other traffic participants
- B60W60/00274—Planning or execution of driving tasks using trajectory prediction for other traffic participants considering possible movement changes
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/04—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
- B60W10/06—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units including control of combustion engines
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/04—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
- B60W10/08—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units including control of electric propulsion units, e.g. motors or generators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/10—Conjoint control of vehicle sub-units of different type or different function including control of change-speed gearings
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Input parameters relating to objects
- B60W2554/20—Static objects
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/166—Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
【課題】走行路上に障害物が存在する場合における対向車両の走行軌道を、より精度よく予測すること。【解決手段】車両制御装置は、自車両の周辺環境を認識する認識部と、認識結果に基づいて、前記自車両が走行する第1軌道を生成する第1軌道生成部と、認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成する第2軌道生成部と、前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行う運転制御部と、を備え、前記第2軌道生成部は、走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる。【選択図】図1
Description
本発明は、車両制御装置、車両制御方法、およびプログラムに関する。
近年、車両を自動的に制御することについて研究が進められている。これに関連して、対向車両とすれ違うことができない幅員狭小路で対向車両に遭遇した場合に、道路情報および自車両の位置情報に基づき、対向車両とすれ違うことができる第2地点まで自車両を自動運転で後退させ、かつ対向車両とすれ違った後に自車両を自動運転で前進させる運転支援装置が知られている(例えば、特許文献1参照)。
しかしながら、走行路に障害物が存在する場合、対向車両が将来走行すると予測される走行軌道は、走行路の形状等を基準として生成された走行軌道から大きくずれるため、対向車両の予測軌道の精度が低下する場合があった。
本発明は、このような事情を考慮してなされたものであり、走行路上に障害物が存在する場合における対向車両の走行軌道を、より精度よく予測することができる車両制御装置、車両制御方法、およびプログラムを提供することを目的の一つとする。
この発明に係る車両制御装置、車両制御方法、およびプログラムは、以下の構成を採用した。
(1):この発明の一態様に係る車両制御装置は、自車両の周辺環境を認識する認識部と、前記認識部の認識結果に基づいて、前記自車両が走行する第1軌道を生成する第1軌道生成部と、前記認識部の認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成する第2軌道生成部と、前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行う運転制御部と、を備え、前記第2軌道生成部は、前記認識部により走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、車両制御装置である。
(1):この発明の一態様に係る車両制御装置は、自車両の周辺環境を認識する認識部と、前記認識部の認識結果に基づいて、前記自車両が走行する第1軌道を生成する第1軌道生成部と、前記認識部の認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成する第2軌道生成部と、前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行う運転制御部と、を備え、前記第2軌道生成部は、前記認識部により走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、車両制御装置である。
(2):上記(1)の態様において、前記第2軌道は、前記走行路の長手方向に関して所定間隔に設けられた複数の第2軌道点で構成され、前記第2軌道生成部は、前記基準位置の付近にある第2軌道点の位置と、前記基準位置との前記走行路の長手方向に関する距離に基づいて、前記第2軌道点を前記幅方向に移動させる量を決定するものである。
(3):上記(2)の態様において、前記第2軌道生成部は、前記基準位置の付近にある第2軌道点の位置と、前記基準位置との前記走行路の長手方向に関する距離が大きくなるほど、前記第2軌道点を前記幅方向に移動させる量を、前記基準位置と前記境界部との距離に比して小さくするものである。
(4):上記(1)〜(3)のうち何れか一つの態様において、前記運転制御部は、前記対向車両が前記障害物を通過する前に、前記第1軌道と前記第2軌道との干渉があると予測される場合に、前記対向車両が前記障害物を通過するまで前記自車両を停止させるものである。
(5):上記(1)〜(3)のうち何れか一つの態様において、前記運転制御部は、前記対向車両が前記自車両よりも先に前記走行路上の所定位置に到達すると予測される場合には前記自車両を停止させ、前記自車両が前記対向車両よりも先に前記所定位置に到達すると予測される場合には、前記第1軌道に沿って前記自車両を走行させるものである。
(6):上記(1)〜(3)のうち何れか一つの態様において、前記第1軌道生成部は、前記認識部により前記走行路上の障害物が認識されている場合、前記基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第1軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させ、前記運転制御部は、前記自車両を前記第1軌道に沿って前記境界部から離れる方向に移動させる第1のタイミングが、前記対向車両が前記第2軌道に沿って前記境界部から離れる方向に移動する第2のタイミングと同一または前記第2のタイミングよりも遅い場合には前記自車両を停止させ、前記第2のタイミングよりも早い場合には前記第1軌道に沿って前記自車両を走行させるものである。
(7):上記(4)または(5)の態様において、前記運転制御部は、前記対向車両が前記障害物を通過した後、前記第2軌道が前記走行路の幅方向に関して前記境界部から離れる方向に移動させる前の軌道上に戻ると予測される位置よりも所定距離手前の位置で前記自車両を停止させるものである。
(8):上記(1)〜(7)のうち何れか一つの態様において、前記第2軌道生成部は、前記認識部による走行路の認識可能範囲の境界付近に障害物が認識された場合であって、且つ、前記認識部により対向車両が認識されていない場合に、前記自車両から見て前記障害物よりも遠方であって、前記障害物または前記認識可能範囲から所定距離の位置に仮想の対向車両が存在するものと仮定して、前記第2軌道を生成するものである。
(9):この発明の一態様に係る車両制御方法は、コンピュータが、自車両の周辺環境を認識し、認識した結果に基づいて、前記自車両が走行する第1軌道を生成し、前記認識した認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成し、前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行い、走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、車両制御方法である。
(10):この発明の一態様に係るプログラムは、コンピュータに、自車両の周辺環境を認識させ、認識した結果に基づいて、前記自車両が走行する第1軌道を生成させ、前記認識した認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成させ、前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行わせ、走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、プログラムである。
上記(1)〜(10)の態様によれば、走行路上に障害物が存在する場合における対向車両の走行軌道を、より精度よく予測することができる。
以下、図面を参照し、本発明の車両制御装置、車両制御方法、およびプログラムの実施形態について説明する。以下では、自動運転車両である実施形態について説明する。自動運転とは、例えば、自動的に車両の操舵または加減速のうち、一方または双方を制御して運転制御を実行することである。また、自動運転車両は、ユーザの手動操作により運転制御が実行されてもよい。以下では、左側通行の法規が適用される場合について説明するが、右側通行の法規が適用される場合には、左右を逆に読み替えればよい。
[全体構成]
図1は、実施形態に係る車両制御装置を利用した車両システム1の構成図である。車両システム1が搭載される車両は、例えば、二輪や三輪、四輪等の車両であり、その駆動源は、ディーゼルエンジンやガソリンエンジン等の内燃機関、電動機、或いはこれらの組み合わせである。電動機は、内燃機関に連結された発電機による発電電力、或いは二次電池や燃料電池の放電電力を使用して動作する。
図1は、実施形態に係る車両制御装置を利用した車両システム1の構成図である。車両システム1が搭載される車両は、例えば、二輪や三輪、四輪等の車両であり、その駆動源は、ディーゼルエンジンやガソリンエンジン等の内燃機関、電動機、或いはこれらの組み合わせである。電動機は、内燃機関に連結された発電機による発電電力、或いは二次電池や燃料電池の放電電力を使用して動作する。
車両システム1は、例えば、カメラ10と、レーダ装置12と、ファインダ14と、物体認識装置16と、通信装置20と、HMI(Human Machine Interface)30と、車両センサ40と、ナビゲーション装置50と、MPU(Map Positioning Unit)60と、運転操作子80と、自動運転制御装置100と、走行駆動力出力装置200と、ブレーキ装置210と、ステアリング装置220とを備える。これらの装置や機器は、CAN(Controller Area Network)通信線等の多重通信線やシリアル通信線、無線通信網等によって互いに接続される。なお、図1に示す構成はあくまで一例であり、構成の一部が省略されてもよいし、更に別の構成が追加されてもよい。自動運転制御装置100は、「運転制御装置」の一例である。
カメラ10は、例えば、CCD(Charge Coupled Device)やCMOS(Complementary Metal Oxide Semiconductor)等の固体撮像素子を利用したデジタルカメラである。カメラ10は、車両システム1が搭載される車両(以下、自車両Mを称する)の任意の箇所に取り付けられる。前方を撮像する場合、カメラ10は、フロントウインドシールド上部やルームミラー裏面等に取り付けられる。カメラ10は、例えば、周期的に繰り返し自車両Mの周辺を撮像する。カメラ10は、ステレオカメラであってもよい。
レーダ装置12は、自車両Mの周辺にミリ波等の電波を放射すると共に、物体によって反射された電波(反射波)を検出して少なくとも物体の位置(距離および方位)を検出する。レーダ装置12は、自車両Mの任意の箇所に取り付けられる。レーダ装置12は、FM−CW(Frequency Modulated Continuous Wave)方式によって物体の位置および速度を検出してもよい。
ファインダ14は、LIDAR(Light Detection and Ranging)である。ファインダ14は、自車両Mの周辺に光を照射し、散乱光を測定する。ファインダ14は、発光から受光までの時間に基づいて、対象までの距離を検出する。照射される光は、例えば、パルス状のレーザー光である。ファインダ14は、自車両Mの任意の箇所に取り付けられる。
物体認識装置16は、カメラ10、レーダ装置12、およびファインダ14のうち一部または全部による検出結果に対してセンサフュージョン処理を行って、物体の位置、種類、速度等を認識する。物体認識装置16は、認識結果を自動運転制御装置100に出力する。物体認識装置16は、カメラ10、レーダ装置12、およびファインダ14の検出結果をそのまま自動運転制御装置100に出力してよい。車両システム1から物体認識装置16が省略されてもよい。
通信装置20は、例えば、セルラー網やWi−Fi網、Bluetooth(登録商標)、DSRC(Dedicated Short Range Communication)等を利用して、自車両Mの周辺に存在する他車両と通信し、或いは無線基地局を介して各種サーバ装置と通信する。
HMI30は、自車両Mの乗員に対して各種情報を提示すると共に、乗員による入力操作を受け付ける。HMI30は、各種表示装置、スピーカ、ブザー、タッチパネル、スイッチ、キー等を含む。
車両センサ40は、自車両Mの速度を検出する車速センサ、加速度を検出する加速度センサ、鉛直軸回りの角速度を検出するヨーレートセンサ、自車両Mの向きを検出する方位センサ等を含む。
ナビゲーション装置50は、例えば、GNSS(Global Navigation Satellite System)受信機51と、ナビHMI52と、経路決定部53とを備える。ナビゲーション装置50は、HDD(Hard Disk Drive)やフラッシュメモリ等の記憶装置に第1地図情報54を保持している。GNSS受信機51は、GNSS衛星から受信した信号に基づいて、自車両Mの位置を特定する。自車両Mの位置は、車両センサ40の出力を利用したINS(Inertial Navigation System)によって特定または補完されてもよい。ナビHMI52は、表示装置、スピーカ、タッチパネル、キー等を含む。ナビHMI52は、前述したHMI30と一部または全部が共通化されてもよい。経路決定部53は、例えば、GNSS受信機51により特定された自車両Mの位置(或いは入力された任意の位置)から、ナビHMI52を用いて乗員により入力された目的地までの経路(以下、地図上経路)を、第1地図情報54を参照して決定する。第1地図情報54は、例えば、道路を示すリンクと、リンクによって接続されたノードとによって道路形状が表現された情報である。第1地図情報54は、道路の曲率やPOI(Point Of Interest)情報等を含んでもよい。地図上経路は、MPU60に出力される。ナビゲーション装置50は、地図上経路に基づいて、ナビHMI52を用いた経路案内を行ってもよい。ナビゲーション装置50は、例えば、乗員の保有するスマートフォンやタブレット端末等の端末装置の機能によって実現されてもよい。ナビゲーション装置50は、通信装置20を介してナビゲーションサーバに現在位置と目的地を送信し、ナビゲーションサーバから地図上経路と同等の経路を取得してもよい。
MPU60は、例えば、推奨車線決定部61を含み、HDDやフラッシュメモリ等の記憶装置に第2地図情報62を保持している。推奨車線決定部61は、ナビゲーション装置50から提供された地図上経路を複数のブロックに分割し(例えば、車両進行方向に関して100[m]毎に分割し)、第2地図情報62を参照してブロックごとに推奨車線を決定する。推奨車線決定部61は、左から何番目の車線を走行するといった決定を行う。推奨車線決定部61は、地図上経路に分岐箇所が存在する場合、自車両Mが、分岐先に進行するための合理的な経路を走行できるように、推奨車線を決定する。
第2地図情報62は、第1地図情報54よりも高精度な地図情報である。第2地図情報62は、例えば、車線の中央の情報あるいは車線の境界の情報等を含んでいる。また、第2地図情報62には、道路情報、交通規制情報、住所情報(住所・郵便番号)、施設情報、電話番号情報等が含まれてよい。第2地図情報62は、通信装置20が他装置と通信することにより、随時、アップデートされてよい。
運転操作子80は、例えば、アクセルペダル、ブレーキペダル、シフトレバー、ステアリングホイール、異形ステア、ジョイスティックその他の操作子を含む。運転操作子80には、操作量あるいは操作の有無を検出するセンサが取り付けられており、その検出結果は、自動運転制御装置100、もしくは、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220のうち一部または全部に出力される。
自動運転制御装置100は、例えば、第1制御部120と、第2制御部160と、記憶部180とを備える。第1制御部120と第2制御部160は、それぞれ、例えば、CPU(Central Processing Unit)等のハードウェアプロセッサがプログラム(ソフトウェア)を実行することにより実現される。また、これらの構成要素のうち一部または全部は、LSI(Large Scale Integration)やASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)、GPU(Graphics Processing Unit)等のハードウェア(回路部;circuitryを含む)によって実現されてもよいし、ソフトウェアとハードウェアの協働によって実現されてもよい。プログラムは、予め自動運転制御装置100のHDDやフラッシュメモリ等の記憶装置(非一過性の記憶媒体を備える記憶装置)に格納されていてもよいし、DVDやCD−ROM等の着脱可能な記憶媒体に格納されており、記憶媒体(非一過性の記憶媒体)がドライブ装置に装着されることで自動運転制御装置100のHDDやフラッシュメモリにインストールされてもよい。記憶部180は、前述した記憶装置により実現される。
図2は、第1制御部120および第2制御部160の機能構成図である。第1制御部120は、例えば、認識部130と、行動計画生成部140とを備える。行動計画生成部140と、第2制御部160とを合わせたものが、「運転制御部」の一例である。第1制御部120は、例えば、AI(Artificial Intelligence;人工知能)による機能と、予め与えられたモデルによる機能とを並行して実現する。例えば、「交差点を認識する」機能は、ディープラーニング等による交差点の認識と、予め与えられた条件(パターンマッチング可能な信号、道路標示等がある)に基づく認識とが並行して実行され、双方に対してスコア付けして総合的に評価することで実現されてよい。これによって、自動運転の信頼性が担保される。
認識部130は、カメラ10、レーダ装置12、およびファインダ14から物体認識装置16を介して入力された情報に基づいて、自車両Mの周辺環境を認識する。例えば、認識部130は、物体認識装置16の認識結果に基づいて、自車両Mの周辺にある物体の位置、および速度、加速度等の状態を認識する。物体の位置は、例えば、自車両Mの代表点(重心や駆動軸中心等)を原点とした絶対座標上の位置として認識され、制御に使用される。物体の位置は、その物体の重心やコーナー等の代表点で表されてもよいし、表現された領域で表されてもよい。物体の「状態」とは、物体の加速度やジャーク、あるいは「行動状態」(例えば車線変更をしている、またはしようとしているか否か)を含んでもよい。
また、認識部130は、例えば、自車両Mが走行している車線(走行車線)を認識する。例えば、認識部130は、第2地図情報62から得られる道路区画線のパターン(例えば実線と破線の配列)と、カメラ10によって撮像された画像から認識される自車両Mの周辺の道路区画線のパターンとを比較することで、走行車線を認識する。なお、認識部130は、道路区画線に限らず、道路区画線や路肩、縁石、中央分離帯、ガードレール等を含む走路境界(道路境界)を認識することで、走行車線を認識してもよい。この認識において、ナビゲーション装置50から取得される自車両Mの位置やINSによる処理結果が加味されてもよい。また、認識部130は、一時停止線、赤信号、料金所、その他の道路事象を認識する。
認識部130は、走行車線を認識する際に、走行車線に対する自車両Mの位置や姿勢を認識する。認識部130は、例えば、自車両Mの基準点の車線中央からの乖離、および自車両Mの進行方向の車線中央を連ねた線に対してなす角度を、走行車線に対する自車両Mの相対位置および姿勢として認識してもよい。これに代えて、認識部130は、走行車線のいずれかの側端部(道路区画線または道路境界)に対する自車両Mの基準点の位置等を、走行車線に対する自車両Mの相対位置として認識してもよい。認識部130は、例えば、対向車両認識部132と、障害物認識部134とを備える。対向車両認識部132および障害物認識部134の機能の詳細については後述する。
行動計画生成部140は、原則的には推奨車線決定部61により決定された推奨車線を走行し、更に、自車両Mの周辺環境に対応できるように、自車両Mが自動的に(運転者の操作に依らずに)将来走行する走行軌道(以下、第1軌道を称する)を生成し、生成した第1軌道に基づいて、自車両Mの自動運転を実行する行動計画を生成する。
行動計画生成部140は、走行軌道を生成するにあたり、自動運転のイベントに基づく行動計画を生成してよい。自動運転のイベントには、定速走行イベント、低速追従走行イベント、車線変更イベント、分岐イベント、合流イベント、テイクオーバーイベント等がある。行動計画生成部140は、起動させたイベントに応じた第1軌道を生成する。
また、行動計画生成部140は、例えば、第1軌道生成部142と、第2軌道生成部144と、干渉判定部146とを備える。第1軌道生成部142と、第2軌道生成部144と、干渉判定部146の機能の詳細については、後述する。
第2制御部160は、行動計画生成部140によって生成された第1軌道を、予定の時刻通りに自車両Mが通過するように、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220を制御する。
第2制御部160は、例えば、取得部162と、速度制御部164と、操舵制御部166とを備える。取得部162は、行動計画生成部140により生成された第1軌道の情報を取得し、メモリ(不図示)に記憶させる。速度制御部164は、メモリに記憶された第1軌道に付随する速度要素に基づいて、走行駆動力出力装置200またはブレーキ装置210を制御する。操舵制御部166は、メモリに記憶された走行の曲がり具合に応じて、ステアリング装置220を制御する。速度制御部164および操舵制御部166の処理は、例えば、フィードフォワード制御とフィードバック制御との組み合わせにより実現される。一例として、操舵制御部166は、自車両Mの前方の道路の曲率に応じたフィードフォワード制御と、第1軌道からの乖離に基づくフィードバック制御とを組み合わせて実行する。
走行駆動力出力装置200は、自車両Mが走行するための走行駆動力(トルク)を駆動輪に出力する。走行駆動力出力装置200は、例えば、内燃機関、電動機、および変速機等の組み合わせと、これらを制御するECU(Electronic Control Unit)とを備える。ECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って、上記の構成を制御する。
ブレーキ装置210は、例えば、ブレーキキャリパーと、ブレーキキャリパーに油圧を伝達するシリンダと、シリンダに油圧を発生させる電動モータと、ブレーキECUとを備える。ブレーキECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って電動モータを制御し、制動操作に応じたブレーキトルクが各車輪に出力されるようにする。ブレーキ装置210は、運転操作子80に含まれるブレーキペダルの操作によって発生させた油圧を、マスターシリンダを介してシリンダに伝達する機構をバックアップとして備えてよい。なお、ブレーキ装置210は、上記説明した構成に限らず、第2制御部160から入力される情報に従ってアクチュエータを制御して、マスターシリンダの油圧をシリンダに伝達する電子制御式油圧ブレーキ装置であってもよい。
ステアリング装置220は、例えば、ステアリングECUと、電動モータとを備える。電動モータは、例えば、ラックアンドピニオン機構に力を作用させて転舵輪の向きを変更する。ステアリングECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って、電動モータを駆動し、転舵輪の向きを変更させる。
[対向車両とのすれ違う場合における運転制御]
以下、走行路で自車両Mが対向車線とすれ違う場合における運転制御について図を用いて説明する。
以下、走行路で自車両Mが対向車線とすれ違う場合における運転制御について図を用いて説明する。
[走行路上に障害物が存在しない場合]
まず、走行路上に障害物が存在する場合について説明する。図3は、走行路上に障害物が存在しない場面において対象車両とすれ違う場面の一例を示す図である。図3の例では、走行路として第1車線L1および第2車線L2が示されている。車線L1およびL2は、隣接車線である。車線L1は、道路区画線LLおよびCLによって区画され、図3に示す+X方向に進行する車両が走行する車線である。また、車線L2は、道路区画線CLおよびRLによって区画される車線であり、車線L1の対向車線(つまり、−X方向に進行する車両が走行する車線)である。図3の例において、自車両Mは速度VMで車線L1を走行し、自車両Mに対向する向きで走行してくる対向車両m1は、速度Vm1車線L2を走行しているものとする。道路区画線LL、CL、およびRLは、「境界部」の一例である。
まず、走行路上に障害物が存在する場合について説明する。図3は、走行路上に障害物が存在しない場面において対象車両とすれ違う場面の一例を示す図である。図3の例では、走行路として第1車線L1および第2車線L2が示されている。車線L1およびL2は、隣接車線である。車線L1は、道路区画線LLおよびCLによって区画され、図3に示す+X方向に進行する車両が走行する車線である。また、車線L2は、道路区画線CLおよびRLによって区画される車線であり、車線L1の対向車線(つまり、−X方向に進行する車両が走行する車線)である。図3の例において、自車両Mは速度VMで車線L1を走行し、自車両Mに対向する向きで走行してくる対向車両m1は、速度Vm1車線L2を走行しているものとする。道路区画線LL、CL、およびRLは、「境界部」の一例である。
[対向車両認識部]
対向車両認識部132は、物体認識装置16により物体の形状や色等の特徴情報等を用いたパターンマッチングにより第2車線L2を走行する対向車両m1を認識する。また、対向車両認識部132は、対向車両m1の相対速度と自車両Mの速度VMと、自車両Mおよび対向車両m1のそれぞれの進行方向とに基づいて対向車両Mの速度Vm1を導出する。
対向車両認識部132は、物体認識装置16により物体の形状や色等の特徴情報等を用いたパターンマッチングにより第2車線L2を走行する対向車両m1を認識する。また、対向車両認識部132は、対向車両m1の相対速度と自車両Mの速度VMと、自車両Mおよび対向車両m1のそれぞれの進行方向とに基づいて対向車両Mの速度Vm1を導出する。
[第1軌道生成部]
第1軌道生成部142は、認識部130により認識された自車両Mの周辺環境に基づいて、自車両Mが走行する第1軌道を生成する。例えば、第1軌道生成部142は、自車両Mが走行する車線L1の横方向(車線幅方向)の中央部(以下、第1中央部と称する)CE1を基準として、自車両Mの基準位置(例えば、中心CM)が第1中央部CE1を通過するように、車線L1の長手方向に関して所定間隔で、自車両Mが将来に到達する目標とする複数の第1軌道点P1を生成する。例えば、第1軌道は、自車両Mの到達すべき地点(第1軌道点P1)を順に並べたものとして表現される。第1軌道点P1は、例えば、車線L1の長手方向に関して所定間隔に設けられる。第1軌道点P1は、道なり距離で所定の走行距離(例えば数[m]程度)ごとの自車両Mの到達すべき地点であり、それとは別に、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとの目標速度および目標加速度が、第1軌道の一部として生成される。また、第1軌道は、速度要素を含んでいてもよい。また、第1軌道点P1は、所定のサンプリング時間ごとの、そのサンプリング時刻における自車両Mの到達すべき位置であってもよい。この場合、目標速度や目標加速度の情報は第1軌道点の間隔で表現される。図3の例では、時間経過に伴う第1軌道点P1(t1)〜P1(t6)と、各軌道点を通過する第1軌道K1が示されている(t1〜t6は時刻を示す。以下も同様とする)。
第1軌道生成部142は、認識部130により認識された自車両Mの周辺環境に基づいて、自車両Mが走行する第1軌道を生成する。例えば、第1軌道生成部142は、自車両Mが走行する車線L1の横方向(車線幅方向)の中央部(以下、第1中央部と称する)CE1を基準として、自車両Mの基準位置(例えば、中心CM)が第1中央部CE1を通過するように、車線L1の長手方向に関して所定間隔で、自車両Mが将来に到達する目標とする複数の第1軌道点P1を生成する。例えば、第1軌道は、自車両Mの到達すべき地点(第1軌道点P1)を順に並べたものとして表現される。第1軌道点P1は、例えば、車線L1の長手方向に関して所定間隔に設けられる。第1軌道点P1は、道なり距離で所定の走行距離(例えば数[m]程度)ごとの自車両Mの到達すべき地点であり、それとは別に、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとの目標速度および目標加速度が、第1軌道の一部として生成される。また、第1軌道は、速度要素を含んでいてもよい。また、第1軌道点P1は、所定のサンプリング時間ごとの、そのサンプリング時刻における自車両Mの到達すべき位置であってもよい。この場合、目標速度や目標加速度の情報は第1軌道点の間隔で表現される。図3の例では、時間経過に伴う第1軌道点P1(t1)〜P1(t6)と、各軌道点を通過する第1軌道K1が示されている(t1〜t6は時刻を示す。以下も同様とする)。
[第2軌道生成部]
第2軌道生成部144は、対向車両認識部132による認識結果に基づいて、対向車両m1が将来走行すると予測される走行軌道(以下、第2軌道と称する)を生成する。例えば、第2軌道生成部144は、対向車両m1が走行する車線L2の横方向の中央部(以下、第2中央部と称する)CE2を基準として、対向車両m1の基準位置(例えば、中心Cm1)が第2中央部CE2を通過するように、車線L2の長手方向に関して所定間隔で、対向車両m2が将来に到達する目標とする複数の第2軌道点P2を生成する。例えば、第2軌道は、対向車両m1が到達すると予測される地点(第2軌道点P2)を順に並べたものとして表現される。第2軌道点P2は、例えば、車線L2の長手方向に関して所定間隔に設けられる。第2軌道点P2は、道なり距離で所定の走行距離(例えば数[m]程度)ごとの対向車両m1の到達すべき地点であり、それとは別に、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとの目標速度および目標加速度が、第2軌道の一部として生成されてもよい。また、第2軌道は、速度要素を含んでいてもよい。また、第2軌道点P2は、所定のサンプリング時間ごとの、そのサンプリング時刻における対向車両m1が到達すると予測される位置であってもよい。この場合、目標速度や目標加速度の情報は第2軌道点の間隔で表現される。図3の例では、時間経過に伴う第2軌道点P2(t1)〜P2(t6)と、各軌道点を通過する第2軌道K2が示されている。
第2軌道生成部144は、対向車両認識部132による認識結果に基づいて、対向車両m1が将来走行すると予測される走行軌道(以下、第2軌道と称する)を生成する。例えば、第2軌道生成部144は、対向車両m1が走行する車線L2の横方向の中央部(以下、第2中央部と称する)CE2を基準として、対向車両m1の基準位置(例えば、中心Cm1)が第2中央部CE2を通過するように、車線L2の長手方向に関して所定間隔で、対向車両m2が将来に到達する目標とする複数の第2軌道点P2を生成する。例えば、第2軌道は、対向車両m1が到達すると予測される地点(第2軌道点P2)を順に並べたものとして表現される。第2軌道点P2は、例えば、車線L2の長手方向に関して所定間隔に設けられる。第2軌道点P2は、道なり距離で所定の走行距離(例えば数[m]程度)ごとの対向車両m1の到達すべき地点であり、それとは別に、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとの目標速度および目標加速度が、第2軌道の一部として生成されてもよい。また、第2軌道は、速度要素を含んでいてもよい。また、第2軌道点P2は、所定のサンプリング時間ごとの、そのサンプリング時刻における対向車両m1が到達すると予測される位置であってもよい。この場合、目標速度や目標加速度の情報は第2軌道点の間隔で表現される。図3の例では、時間経過に伴う第2軌道点P2(t1)〜P2(t6)と、各軌道点を通過する第2軌道K2が示されている。
[干渉判定部]
干渉判定部146は、第1軌道生成部142により生成された第1軌道K1と、第2軌道生成部144により生成された第2軌道K2とが干渉するか否かを判定する。具体的には、干渉判定部146は、対向車両m1が将来において速度や操舵量が変化した場合を想定したときの挙動のずれをリスク領域RAとして設定し、設定したリスク領域RAと第1軌道K1を走行したときの自車両Mの基準位置が通過する軌道とが干渉するか否かを判定する。図3の例では、第2軌道点P2(t1)〜P2(t6)を基準としたリスク領域RA(t1)〜RA(t6)が生成されている。リスク領域RA(t1)〜RA(t6)は、時間経過ごとに大きくなっている。また、自車両Mの基準位置とは、自車両Mの対向車線側の端部(図3の例では、自車両Mの左端部)の位置であり、自車両Mの基準位置が通過する軌道とは、第1軌道K1から自車両Mの中心CMから左端部までの距離D1だけ対向車線側(図中右側)にオフセット(移動)させたオフセット軌道K1#である。
干渉判定部146は、第1軌道生成部142により生成された第1軌道K1と、第2軌道生成部144により生成された第2軌道K2とが干渉するか否かを判定する。具体的には、干渉判定部146は、対向車両m1が将来において速度や操舵量が変化した場合を想定したときの挙動のずれをリスク領域RAとして設定し、設定したリスク領域RAと第1軌道K1を走行したときの自車両Mの基準位置が通過する軌道とが干渉するか否かを判定する。図3の例では、第2軌道点P2(t1)〜P2(t6)を基準としたリスク領域RA(t1)〜RA(t6)が生成されている。リスク領域RA(t1)〜RA(t6)は、時間経過ごとに大きくなっている。また、自車両Mの基準位置とは、自車両Mの対向車線側の端部(図3の例では、自車両Mの左端部)の位置であり、自車両Mの基準位置が通過する軌道とは、第1軌道K1から自車両Mの中心CMから左端部までの距離D1だけ対向車線側(図中右側)にオフセット(移動)させたオフセット軌道K1#である。
干渉判定部146は、各時刻t1から時刻t6における自車両Mのオフセット軌道K1#と、リスク領域RA(t1)〜RA(t6)とを比較し、交わる部分が存在しない場合には、第1軌道K1と第2軌道K2とが干渉しない(言い換えると、自車両Mと対向車両m1とが将来において接触しない)と判定する。また、干渉判定部146は、交わる部分が存在する場合には、第1軌道K1と第2軌道K2とが干渉しない(言い換えると、自車両Mと対向車両m1とが将来において接触する可能性がある)と判定する。図3の例において、干渉判定部146は、オフセット軌道K1#と、リスク領域RA(t1)〜RA(t6)とが交わらないため、自車両Mと対向車両m1とは将来において接触しないと判定する。したがって、第2制御部160は、第1軌道K1に沿って自車両Mを走行させる。
[走行路上に障害物が存在する場合]
次に、走行路上に障害物が存在する場合について説明する。なお、以下では、走行路上に障害物が存在することで、障害物が存在する区間において、自車両Mと対向車両m1とがすれ違うことができない程度に走行路の道幅が狭くなっている場面について説明する。図4は、走行路に障害物が存在する場面において対向車両とすれ違う場面の一例を示す図である。図4の例では、図4の例では、上述した図3の場面と比較して、車線L2の一部に工事領域等の通行禁止領域が存在すると共に、工事領域を区分けして車両が進入しないように、その周辺に障害物OB1〜OB3が車線L2上に置かれている場面を示している。障害物とは、例えば、ロードコーン(保安器具の一例)等である。なお、本実施形態における障害物には、ロードコーンの他、前走車両(例えば、トラック)等からの落下物や、走行路に倒れた木々、駐車車両、歩行者等の各種の物体や、工事現場、道路の破損や陥没によって生じた自車両Mが通過することができない穴等が含まれてよい。
次に、走行路上に障害物が存在する場合について説明する。なお、以下では、走行路上に障害物が存在することで、障害物が存在する区間において、自車両Mと対向車両m1とがすれ違うことができない程度に走行路の道幅が狭くなっている場面について説明する。図4は、走行路に障害物が存在する場面において対向車両とすれ違う場面の一例を示す図である。図4の例では、図4の例では、上述した図3の場面と比較して、車線L2の一部に工事領域等の通行禁止領域が存在すると共に、工事領域を区分けして車両が進入しないように、その周辺に障害物OB1〜OB3が車線L2上に置かれている場面を示している。障害物とは、例えば、ロードコーン(保安器具の一例)等である。なお、本実施形態における障害物には、ロードコーンの他、前走車両(例えば、トラック)等からの落下物や、走行路に倒れた木々、駐車車両、歩行者等の各種の物体や、工事現場、道路の破損や陥没によって生じた自車両Mが通過することができない穴等が含まれてよい。
[障害物認識部]
障害物認識部134は、物体認識装置16の認識結果に基づいて、走行路(車線L1およびL2)に存在する障害物OB1〜OB3を認識する。また、障害物認識部134は、障害物の走行路上の位置や形状、大きさ等を認識する。なお、障害物認識部134は、障害物が歩行者等の移動可能な物体である場合に、移動方向や移動速度等を認識してもよい。
障害物認識部134は、物体認識装置16の認識結果に基づいて、走行路(車線L1およびL2)に存在する障害物OB1〜OB3を認識する。また、障害物認識部134は、障害物の走行路上の位置や形状、大きさ等を認識する。なお、障害物認識部134は、障害物が歩行者等の移動可能な物体である場合に、移動方向や移動速度等を認識してもよい。
第2軌道生成部144は、認識部130により走行路上の障害物が認識されている場合、上述した障害物が存在していない場面で生成される第2軌道K2の一部を移動させる。例えば、第2軌道生成部144は、障害物OB1〜OB3のそれぞれの基準位置を設定する。障害物の基準位置とは、例えば、道路区画線RLから最も遠い位置(Y軸座標の最大値)でもよく、対向車両m1から最も近い位置であってもよく、障害物の中心から所定のマージンを付加した位置でもよい。また、基準位置は、1つの障害物に対して複数設定されてもよい。図4の例では、障害物OB1〜OB3のそれぞれに対応付けられた基準点OBP1〜OBP3が設定されている。基準位置OBP1〜OBP3は、それぞれの障害物OB1〜OB3の中心から車線L2の横方向(道路区画線CL側、+Y方向)に移動させたときの障害物の端部の位置である。第2軌道生成部144は、基準位置OBP1〜OBP3と車線RLとの距離に応じて、第2軌道K2の一部を車線L2の幅方向に関して車線RLから離れる方向に移動させる。車線RLは、障害物OB1〜OB3の中心部から見て、車線L2の幅方向に基準位置OBP1〜OBP3とは反対側にある境界部である。
図5は、第2軌道K2の一部を移動させることについて説明するための図である。図5の例では、車線L2における第2軌道点P2(t1)〜P2(t6)と、障害物OB1〜OB3のそれぞれの基準位置OBP1〜OBP3が示されている。また、図5の例では、第2軌道点P2(t1)〜P2(t6)を車線L2の横方向(図中+Y方向)に移動させて道路区画線CLと交わる点PCL(t1)〜PCL(t6)と、第2軌道点P2(t1)〜P2(t6)を車線L2の横方向(図中−Y方向)に移動させて道路区画線RLと交わる点PRL(t1)〜PRL(t6)とが示されている。
第2軌道生成部144は、例えば、点PCL(t1)〜PCL(t6)から点PRL(t1)〜PRL(t6)までの距離と、点PCL(t1)〜PCL(t6)から基準位置OBP1〜OBP3までの距離とに基づいて、第2軌道K2に含まれる第2軌道点P2(t1)〜P2(t6)のうち、移動させる軌道点と移動量(シフト量)を決定する。
例えば、第2軌道生成部144は、例えば、時刻t1における点PCL(t1)から点PRL(t1)までの点間距離BP1が車線L2の車線幅WL2と同じであり、且つ、車線幅WL2よりも短い距離に基準位置OBP1〜OBP3が存在しないため、第2軌道点P2(t1)の移動は行わない。なお、時刻t5およびt6においても、点PCL(t5)から点PRL(t5)までの点間距離BP5、および点PCL(t6)から点PRL(t6)までの点間距離BP6は、車線幅WL2と同じであり、車線幅WL2よりも短い距離に基準位置OBP1〜OBP3が存在しないため、第2軌道点P2(t5)、第2軌道点P2(t6)の移動は行わない。
また、第2軌道生成部144は、時刻t2において、点PCL(t2)から、基準位置OBP1〜OBP3のうち最も近い基準位置OBP1までの距離BP2は、車線幅WL2よりも短いため、第2軌道点P2(t2)の移動を行う。なお、時刻t2の場合、基準位置OBP1と、第2軌道点P2(t2)とは、車線L2の幅方向の軸(Y軸)と水平な位置に存在する(つまり、車線L2の長手方向(X軸方向)に関する距離がゼロ(0)である)。この場合、第2軌道生成部144は、点PRL(t2)から基準位置OBP1までの距離をシフト量Sh1として、第2基準点P2(t2)に関して、道路区画線RLから離れる方向にシフト量Sh1だけ移動させた位置を、移動後の第2軌道点P2#(t2)として決定する。
また、第2軌道生成部144は、時刻t3において、点PCL(t3)から、基準位置OBP1〜OBP3のうち最も近い基準位置OBP2までの距離BP3は、車線幅WL2よりも短いため、第2軌道点P2(t3)の移動を行う。なお、時刻t3の場合、基準位置OBP2と、第2軌道点P2(t3)とは、Y軸と水平な位置に存在しない。したがって、第2軌道生成部144は、車線L2の長手方向(X軸方向)に関する距離に基づいて、第2軌道点P2(t3)を車線L2の幅方向に移動させる量を決定する。
例えば、第2軌道生成部144は、基準位置OBP2の付近にある第2軌道点P2(t3)の位置と、基準位置OBP2との車線L2の長手方向に関する距離が大きくなるほど、第2軌道点P2(t3)を車線L2の幅方向に移動させる量を、基準位置OBP2と点PRL(t3)との距離に比して小さくする。例えば、第2軌道生成部144は、三角関数等を用いて、シフト量Sh2を算出してもよい。例えば、第2軌道生成部144は、以下の(1)式を用いてシフト量Sh2を算出する。
シフト量Sh2=車線幅WL2−距離BP3×cosθ1 ・・・(1)
ここで、角度θ1は、図中のY軸と、点PCL(t3)と基準位置OBP2とを結んだ直線とによってなす角度である。
ここで、角度θ1は、図中のY軸と、点PCL(t3)と基準位置OBP2とを結んだ直線とによってなす角度である。
また、第2軌道生成部144は、点PCL(t3)の位置座標(x1、y1)と、基準位置OBP2の位置座標(x2、y2)と、点PRL(t3)の位置座標(x3、y3)とを用いてシフト量を算出してもよい。この場合、まず、第2軌道生成部144は、点PCL(t3)から点OBP2を結ぶ第1ベクトルA=(a1、b1)と、点PCL(t3)から点PRL(t3)を結ぶ第2ベクトルB=(a2、b2)を設定する。なお、第1ベクトルAにおいて、成分a1=x2−x1、成分b1=y2−y1の関係が成り立つ。また、第2ベクトルBにおいて、成分a2=x3−x1、成分b2=y3−y1の関係が成り立つ。次に、第2軌道生成部144は、上述した二つのベクトルの成分を用いた内積の式により、以下の(2)式を用いてシフト量Sh2を算出する。
第2軌道生成部144は、取得したシフト量Sh2を第2基準点P2(t3)に関して、道路区画線RLから離れる方向に距離Sh2だけシフトした位置を、移動後の第2軌道点P2#(t3)として決定する。
また、第2軌道生成部144は、時刻t4において、点PCL(t4)から、基準位置OBP1〜OBP3のうち最も近い基準位置OBP3までの距離BP4は、車線幅WL2よりも短いため、第2軌道点P2(t4)の移動を行う。また、時刻t4の場合、基準位置OBP3と、第2軌道点P2(t4)とは、Y軸と水平な位置に存在しない。したがって、第2軌道生成部144は、上述した所定関数や、図中のY軸と点PCL(t4)および基準位置OBP3を結んだ直線とによってなす角度θ2等を用いて、車線L2の長手方向(X軸方向)に関する距離に基づいて、第2軌道点P2(t3)を移動させるシフト量Sh3を決定する。そして、第2軌道生成部144は、取得したシフト量Sh3を第2基準点P2(t4)に関して、道路区画線RLから離れる方向に距離Sh3だけシフトした位置を、移動後の第2軌道点P2#(t4)として決定する。
これにより、第2軌道生成部144は、障害物OB1〜OB3による自車両Mの挙動の変化に基づいて、第2軌道K2の一部を移動させた第2軌道点P2(t1)、P2#(t2)〜(t4)、P2(t5)、およびP2(t6)を通過するシフト済み第2軌道K2#を生成する。
干渉判定部146は、第1軌道K1と、シフト済み第2軌道K2#とが干渉するか否かを判定する。図6は、走行路に障害物が存在する場合の干渉判定部146の処理について説明するための図である。例えば、干渉判定部146は、干渉判定部146は、第2軌道生成部144により生成されたシフト済み第2軌道K2#に含まれる第2軌道点P2(t1)、P2#(t2)〜P2#(t4)、P2(t5)、およびP2(6)に対応するリスク領域RA(t1)、RA#(t2)〜RA#(t4)、RA(t5)、およびRA(t6)を生成する。そして、干渉判定部146は、リスク領域RA(t1)、RA#(t2)〜RA#(t4)、RA(t5)、およびRA(t6)と、自車両Mのオフセット軌道K1とが交わるか否かを判定する。ここで、図6の例では、時刻t3におけるリスク領域RA(t3)がオフセット軌道K1と交わっており、且つ、交わる部分を自車両Mが走行する時刻は、時刻t3を含む時刻である。したがって、干渉判定部146は、第1軌道K1と、シフト済み第2軌道K2#とが干渉する(言い換えると、自車両Mと対向車両m1とが将来において接触する可能性がある)と判定する。
行動計画生成部140は、干渉判定部146の判定結果に基づいて、自車両Mを走行させるか、停止させるかを決定し、決定した内容に基づく行動計画を生成し、生成した行動計画に基づいて、自車両Mの運転制御を行う。例えば、行動計画生成部140は、対向車両m1が障害物を通過する前に、干渉判定部146により第1軌道と第2軌道との干渉があると判定された場合に、対向車両m1が障害物を通過するまで自車両Mを所定の位置で停止させる行動計画を生成する。対向車両m1が障害物を通過するとは、対向車両m1が障害物を避けて走行することであり、例えば、車線L2の長手方向において、対向車両m1が障害物よりも遠くの位置から、障害物よりも近くの位置に移動することである。
図7は、自車両Mの停止位置について説明するための図である。図7の例では、走行路(車線L1およびL2)における第1軌道K1とシフト済み第2軌道K2#とが示されている。例えば、行動計画生成部140は、対向車両m2が障害物OB1〜OB3を通過した後、第2軌道K2#が車線L2の幅方向に関して道路区画線RLから離れる方向に移動させる前の軌道(すなわち、車線L2の第2中央部CE2)上に戻ると予測される位置よりも所定距離だけ手前の位置で自車両Mを停止させるように行動計画を生成する。
図7の例において、対向車両m1が障害物OB1〜OB3を通過した後に、再び第2中央部CE2に戻ると予測される位置は、第2軌道点P2(t5)である。したがって、行動計画生成部140は、第2軌道点P2(t5)から車線L2の長手方向に対して所定距離DPだけ手前の地点SPで自車両Mを停止させる。所定距離DPは、固定距離でもよく、自対向車両m1の速度Vm1等に基づいて可変に設定される距離でもよい。これにより、障害物を通過した対向車両m1との接触を抑制することができると共に、対向車両m1に障害物を避ける走行を円滑に行わせることができる。
また、行動計画生成部140は、対向車両m1が自車両Mと干渉することがない位置まで移動した場合に、第1軌道K1に沿って自車両Mを走行させる行動計画を生成する。
[処理フロー]
図8は、実施形態における自動運転制御装置100が実行する処理の流れの一例を示すフローチャートである。まず、認識部130は、自車両Mの周辺環境を認識する(ステップS100)。次に、第1軌道生成部142は、認識部130により認識された周辺環境に基づいて、第1軌道を生成する(ステップS102)。次に、対向車両認識部132は、対向車両m1を認識したか否かを判定する(ステップS104)。対象車両m1を認識したと判定された場合、第2軌道生成部144は、対向車両m1が走行すると予測される第2軌道を生成する(ステップS106)。
図8は、実施形態における自動運転制御装置100が実行する処理の流れの一例を示すフローチャートである。まず、認識部130は、自車両Mの周辺環境を認識する(ステップS100)。次に、第1軌道生成部142は、認識部130により認識された周辺環境に基づいて、第1軌道を生成する(ステップS102)。次に、対向車両認識部132は、対向車両m1を認識したか否かを判定する(ステップS104)。対象車両m1を認識したと判定された場合、第2軌道生成部144は、対向車両m1が走行すると予測される第2軌道を生成する(ステップS106)。
次に、障害物認識部134は、自車両Mの走行路上に障害物が存在するか否かを判定する(ステップS108)。障害物が存在すると判定された場合、第2軌道生成部144は、障害物の基準位置と、障害物から見て走行路の幅方向に基準位置とは反対側にある走行路の境界部との距離を導出し(ステップS110)、導出した距離に応じて第2軌道の一部を走行路の幅方向に関して境界部から離れる方向に移動させる(ステップS112)。
ステップS112の処理後、またはステップS108の処理において、走行路上に障害物が存在しないと判定された場合、干渉判定部146は、第1軌道と第2軌道とが干渉するか否かを判定する(ステップS114)。第1軌道と第2軌道とが干渉すると判定された場合、行動計画生成部140は、自車両Mを所定位置で停止させる行動計画を生成する(ステップS116)。次に、認識部130は、対向車両m1が障害物を通過したか否かを判定する(ステップS118)。対向車両m1が障害物を通過していないと判定された場合、行動計画生成部140は、対向車両m1が通過するまで待機する。
また、対向車両m1が障害物を通過した場合、ステップS104の処理において、対向車両m1を認識していないと判定された場合、または、ステップS108の処理において、走行路上に障害物が存在しない場合、行動計画生成部140は、第1軌道に基づいて自車両Mを走行させる(ステップS120)。これにより、本フローチャートの処理は、終了する。
また、上述の実施形態において、行動計画生成部140は、第1軌道と第2軌道とが干渉すると判定された自車両Mを所定位置に停止させたが、これに代えて、所定の時刻で対向車両m1と接触しないように、減速または加速する速度制御を行ってもよい。
<変形例>
以下、上述した実施形態の変形例について説明する。
[第1の変形例]
上述した実施形態において、干渉判定部146は、対向車両m1の速度や進行方向に基づいてリスク領域RAを生成したが、これに代えて、対向車両m1の外形を囲うバウンディングボックスBBに基づいてリスク領域を生成してもよい。
以下、上述した実施形態の変形例について説明する。
[第1の変形例]
上述した実施形態において、干渉判定部146は、対向車両m1の速度や進行方向に基づいてリスク領域RAを生成したが、これに代えて、対向車両m1の外形を囲うバウンディングボックスBBに基づいてリスク領域を生成してもよい。
図9は、リスク領域を生成する他の例について説明するための図である。図9の例では、説明の便宜上、上述した図6と同様の場面を示している。干渉判定部146は、対向車両認識部132により認識される対向車両m1の外形情報に基づいて、対向車両m1の外形を囲うバウンディングボックスBBを生成する。図9の例では、バウンディングボックスBBとして矩形の領域が生成されているが、他の多角形や円、楕円等の領域であってもよい。そして、干渉判定部146は、生成したバウンディングボックスBBを時間の経過に応じて拡大させて、各時刻t1〜t6におけるリスク領域を生成する。図9の例では、リスク領域RB(t1)、RB#(t2)〜RB#(t4)、RB(t5)、およびRB(t6)が設定されている。
このように、バウンディングボックスBBを用いてリスク領域を設定することで、対向車両Mの速度の変化を挙動の量を予測してリスク領域を設定するよりも処理負荷を削減できるため、例えば、速度の速い状態で対向車両とすれ違うような場合であっても短時間で干渉判定を行うことができる。
なお、干渉判定部146は、上述したリスク領域RAとリスク領域RBとを合わせて領域を設定し、設定した領域を用いて干渉判定を行ってもよい。これにより、より安全に干渉判定を行うことができる。
[第2の変形例]
次に、第2の変形例について説明する。上述の実施形態において、行動計画生成部140は、対向車両m1が障害物を通過する前に、干渉判定部146により第1軌道と第2軌道との干渉があると判定された場合に、対向車両m1が障害物を通過するまで自車両Mを所定の位置で停止させる行動計画を生成した。これに代えて(または加えて)、行動計画生成部140は、対向車両m1が自車両Mよりも先に走行路上の所定位置に到達するか否かによって、自車両Mを走行させるか、または停止させるかを判定してもよい。所定位置とは、例えば、自車両Mと対向車両m1とが干渉すると予測される地点である。図9の例において、所定位置は、車線L1と車線L2とを含む走行路の中央(道路区画線CL)に最も近い距離にある障害物OB2が存在する位置(例えば、走行路の長手方向において基準位置OBP2がある位置)である。また、所定位置は、自車両Mと対向車両m1とで異なる位置が設定されてもよい。この場合の所定位置は、例えば、走行路の長手方向において、各車両の現在位置から最も近い障害物がある位置(図9の例において、自車両Mの場合は障害物OB3の基準位置OBP3がある位置、対向車両m1の場合は障害物OB1の基準位置OBP1がある位置)である。
次に、第2の変形例について説明する。上述の実施形態において、行動計画生成部140は、対向車両m1が障害物を通過する前に、干渉判定部146により第1軌道と第2軌道との干渉があると判定された場合に、対向車両m1が障害物を通過するまで自車両Mを所定の位置で停止させる行動計画を生成した。これに代えて(または加えて)、行動計画生成部140は、対向車両m1が自車両Mよりも先に走行路上の所定位置に到達するか否かによって、自車両Mを走行させるか、または停止させるかを判定してもよい。所定位置とは、例えば、自車両Mと対向車両m1とが干渉すると予測される地点である。図9の例において、所定位置は、車線L1と車線L2とを含む走行路の中央(道路区画線CL)に最も近い距離にある障害物OB2が存在する位置(例えば、走行路の長手方向において基準位置OBP2がある位置)である。また、所定位置は、自車両Mと対向車両m1とで異なる位置が設定されてもよい。この場合の所定位置は、例えば、走行路の長手方向において、各車両の現在位置から最も近い障害物がある位置(図9の例において、自車両Mの場合は障害物OB3の基準位置OBP3がある位置、対向車両m1の場合は障害物OB1の基準位置OBP1がある位置)である。
行動計画生成部140は、例えば、第1軌道K1と第2軌道K2#に基づいて各時刻における各車両の予測位置を比較し、対向車両m1が自車両Mよりも先に所定位置に到達すると予測される場合には、自車両Mを停止させ、自車両Mが対向車両m1よりも先に所定位置に到達すると予測される場合には、第1軌道K1に沿って自車両Mを走行させる。これにより、干渉する可能性がある領域に先に到達することが予測される車両を優先して走行させることができるため、より円滑な交通を実現することができる。
[第3の変形例]
次に、第3の変形例について説明する。上述した実施形態では、対向車両m1が障害物によって対向車両m1の軌道(第2軌道)の一部を移動させることについて説明したが、これに代えて、または加えて、自車両Mが走行する軌道(第1軌道)の一部を移動させてもよい。図10は、第3の変形例において、第1軌道の一部を移動させることについて説明するための図である。図10の例では、上述した障害物OB1〜OB3に加えて、車線L1上に障害物OB4が存在する。この場合、障害物認識部134は、障害物OB1〜OB4の位置、形状、大きさ等を認識する。障害物OB1〜OB3は、車線L2上に存在するため、第2軌道生成部144は、上述したように車線L2を走行する対向車両m1の第2軌道K2の一部を移動させたシフト済み第2軌道K2を生成する。
次に、第3の変形例について説明する。上述した実施形態では、対向車両m1が障害物によって対向車両m1の軌道(第2軌道)の一部を移動させることについて説明したが、これに代えて、または加えて、自車両Mが走行する軌道(第1軌道)の一部を移動させてもよい。図10は、第3の変形例において、第1軌道の一部を移動させることについて説明するための図である。図10の例では、上述した障害物OB1〜OB3に加えて、車線L1上に障害物OB4が存在する。この場合、障害物認識部134は、障害物OB1〜OB4の位置、形状、大きさ等を認識する。障害物OB1〜OB3は、車線L2上に存在するため、第2軌道生成部144は、上述したように車線L2を走行する対向車両m1の第2軌道K2の一部を移動させたシフト済み第2軌道K2を生成する。
また、第3の変形例において、第1軌道生成部142は、車線L1上に障害物OB4が存在するため、障害物OB4に設定した基準位置OBP4a、OBP4bと、障害物OB4の中心部から見て走行路の幅方向に基準位置OBP4a、OBP4bとは反対側にある車線L1の境界部(例えば、道路区画線LL)との距離に応じて、第1軌道K1の一部を、車線L1の幅方向に関して道路区画線LLから離れる方向に移動させたシフト済み第1軌道K1##を生成する。
また、行動計画生成部140は、自車両Mをシフト済み第1軌道K1##に沿って道路区画線LLから離れる方向に移動させる第1のタイミングと、対向車両m1がシフト済み第2軌道K2#に沿って道路区画線RLから離れる方向に移動する第2のタイミングとを比較する。そして、行動計画生成部140は、第1のタイミングが第2のタイミングと同一または第2のタイミングよりも遅い場合には自車両Mを停止させ、第1のタイミングが第2のタイミングよりも早い場合にはシフト済み第1軌道K1##に沿って自車両Mを走行させる。図10の例において、第1のタイミングは時刻t4付近であり、第2のタイミングは時刻t2付近であるため、第2のタイミングの方が第1のタイミングよりも早い。したがって、行動計画生成部140は、対向車両m1が障害物OB1〜OB3を通過するまで、自車両M1を所定位置で停止させる。これにより、より適切な運転制御を実行することができる。
[第4の変形例]
次に、第4の変形例について説明する。第4の変形例では、認識部130における認識可能範囲の境界付近に障害物が認識されている場合に仮想の対向車両が存在するものと仮定して第2軌道を生成する。図11は、第4の変形例について説明するための図である。図11の例では、認識部130における認識可能範囲REAが示されている。
次に、第4の変形例について説明する。第4の変形例では、認識部130における認識可能範囲の境界付近に障害物が認識されている場合に仮想の対向車両が存在するものと仮定して第2軌道を生成する。図11は、第4の変形例について説明するための図である。図11の例では、認識部130における認識可能範囲REAが示されている。
図11の例において、障害物認識部134は、障害物OB2およびOB3を認識する。障害物OB2は、認識可能範囲REAの境界付近(例えば、境界から数[m]以内)に存在している。また、対向車両認識部132は、認識可能範囲REA内に対向車両を認識していない。この場合、第2軌道生成部144は、自車両Mから見て障害物OB2よりも遠方であって、障害物OB2または認識可能範囲REAから所定距離の位置に仮想の対向車両m2(Virtual)が存在するものと仮定する。図11の例では、認識可能範囲REAから距離DFだけ遠方の位置に仮想の対向車両m2(Virtual)が存在するものと仮定している。
第2軌道生成部144は、仮想の対向車両m2(Virtual)を用いて、上述したように、対向車両m2(Virtual)の基準位置(例えば、中心Cm2(Virtual))が車線L2の横方向の中央部を通過するように、第2軌道点P2や第2軌道K2を生成し、生成した第2軌道K2の少なくとも一部を、障害物OB2およびOB3との接触から回避する方向に移動させたシフト済み第2軌道を生成する。対向車両m2(Virtual)の車速Vm2(Virtual)は、例えば、車線L2の法定速度または自車両Mの速度VMを用いる。
上述した第4の変形例によれば、認識可能範囲の境界付近に障害物が存在する場合には、対向車両が認識できていない場合であっても、その先に存在する対向車両の存在を予測して行動計画を生成することで、より適切な運転制御を実行することができる。また、対向車両が高速で走行している場合であっても、仮想の対向車両によって走行軌道を予測することで、余裕を持った運転制御を実行することができる。
[第5の変形例]
次に、第5の変形例について説明する。上述した実施形態では、自車線(車線L1)と対向車線(車線L2)が存在する走行路について説明したが、例えば、一車線の狭路等において対向車両m1とすれ違う場合には、認識部130は、走行路の長手方向の中央に仮想の道路区画線CL(Virtual)を設定し、道路区画線CLで区分けされた二つ車線のうち自車両側の車線を自車線(車線L1)とし、対向車両側の車線を対向車線(車線L2)として認識してもよい。これにより、一車線の走行路で対向車両とすれ違う場合であっても、走行路上に障害物が存在する場合における対向車両の走行軌道を、より精度よく予測することができる。その結果、自車両Mのより適切な運転制御を行うことができる。
次に、第5の変形例について説明する。上述した実施形態では、自車線(車線L1)と対向車線(車線L2)が存在する走行路について説明したが、例えば、一車線の狭路等において対向車両m1とすれ違う場合には、認識部130は、走行路の長手方向の中央に仮想の道路区画線CL(Virtual)を設定し、道路区画線CLで区分けされた二つ車線のうち自車両側の車線を自車線(車線L1)とし、対向車両側の車線を対向車線(車線L2)として認識してもよい。これにより、一車線の走行路で対向車両とすれ違う場合であっても、走行路上に障害物が存在する場合における対向車両の走行軌道を、より精度よく予測することができる。その結果、自車両Mのより適切な運転制御を行うことができる。
上述した実施形態によれば、自動運転制御装置100において、自車両Mの周辺環境を認識する認識部130と、認識部130の認識結果に基づいて、自車両Mが走行する第1軌道を生成する第1軌道生成部142と、認識部130の認識結果に基づいて、自車両Mに対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成する第2軌道生成部144と、第1軌道と第2軌道との干渉の有無に基づいて、自車両Mの速度または操舵のうち、一方または双方の運転制御を行う運転制御部(行動計画生成部140、第2制御部160)と、を備え、第2軌道生成部144は、認識部130により走行路上の障害物が認識されている場合、障害物について設定された基準位置と、障害物の中心部から見て走行路の幅方向に基準位置とは反対側にある走行路の境界部との距離に応じて、第2軌道の一部を、走行路の幅方向に関して境界部から離れる方向に移動させることにより、走行路上に障害物が存在する場合における対向車両の走行軌道を、より精度よく予測することができる。
例えば、実施形態では、車両が車線に沿って走行する場合に、その車両の将来位置は車線中央上の軌道(ベースパス)にあることをベースとし、車線上に障害物が存在する場合に、その障害物を回避するために、ベースパスのシフト量を求め、求めたシフト量に対応付けて走行軌道を変更することにより、障害物回避時の対向車両の将来の走行軌道の予測を、より高精度に行うことができる。その結果、自車両Mは、より適切な運転制御を実行することができる。
[ハードウェア構成]
図12は、実施形態の自動運転制御装置100のハードウェア構成の一例を示す図である。図示するように、自動運転制御装置100は、通信コントローラ100−1、CPU100−2、ワーキングメモリとして使用されるRAM(Random Access Memory)100−3、ブートプログラム等を格納するROM(Read Only Memory)100−4、フラッシュメモリやHDD(Hard Disk Drive)等の記憶装置100−5、ドライブ装置100−6等が、内部バスあるいは専用通信線によって相互に接続された構成となっている。通信コントローラ100−1は、自動運転制御装置100以外の構成要素との通信を行う。記憶装置100−5には、CPU100−2が実行するプログラム100−5aが格納されている。このプログラムは、DMA(Direct Memory Access)コントローラ(不図示)等によってRAM100−3に展開されて、CPU100−2によって実行される。これによって、認識部130および行動計画生成部140のうち一部または全部が実現される。
図12は、実施形態の自動運転制御装置100のハードウェア構成の一例を示す図である。図示するように、自動運転制御装置100は、通信コントローラ100−1、CPU100−2、ワーキングメモリとして使用されるRAM(Random Access Memory)100−3、ブートプログラム等を格納するROM(Read Only Memory)100−4、フラッシュメモリやHDD(Hard Disk Drive)等の記憶装置100−5、ドライブ装置100−6等が、内部バスあるいは専用通信線によって相互に接続された構成となっている。通信コントローラ100−1は、自動運転制御装置100以外の構成要素との通信を行う。記憶装置100−5には、CPU100−2が実行するプログラム100−5aが格納されている。このプログラムは、DMA(Direct Memory Access)コントローラ(不図示)等によってRAM100−3に展開されて、CPU100−2によって実行される。これによって、認識部130および行動計画生成部140のうち一部または全部が実現される。
上記説明した実施形態は、以下のように表現することができる。
プログラムを記憶した記憶装置と、
ハードウェアプロセッサと、を備え、
前記ハードウェアプロセッサが前記記憶装置に記憶されたプログラムを実行することにより、
自車両の周辺環境を認識し、
認識した結果に基づいて、前記自車両が走行する第1軌道を生成し、
前記認識した認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成し、
前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行い、
走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、
ように構成されている、車両制御装置。
プログラムを記憶した記憶装置と、
ハードウェアプロセッサと、を備え、
前記ハードウェアプロセッサが前記記憶装置に記憶されたプログラムを実行することにより、
自車両の周辺環境を認識し、
認識した結果に基づいて、前記自車両が走行する第1軌道を生成し、
前記認識した認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成し、
前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行い、
走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、
ように構成されている、車両制御装置。
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形および置換を加えることができる。
1…車両システム、10…カメラ、12…レーダ装置、14…ファインダ、16…物体認識装置、20…通信装置、30…HMI、40…車両センサ、50…ナビゲーション装置、60…MPU、80…運転操作子、100…自動運転制御装置、120…第1制御部、130…認識部、132…対向車両認識部、134…障害物認識部、140…行動計画生成部、142…第1軌道生成部、144…第2軌道生成部、146…干渉判定部、160…第2制御部、162…取得部、164…速度制御部、166…操舵制御部、180…記憶部、200…走行駆動力出力装置、210…ブレーキ装置、220…ステアリング装置、M…自車両、m1、m2…対向車両
Claims (10)
- 自車両の周辺環境を認識する認識部と、
前記認識部の認識結果に基づいて、前記自車両が走行する第1軌道を生成する第1軌道生成部と、
前記認識部の認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成する第2軌道生成部と、
前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行う運転制御部と、を備え、
前記第2軌道生成部は、前記認識部により走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、
車両制御装置。 - 前記第2軌道は、前記走行路の長手方向に関して所定間隔に設けられた複数の第2軌道点で構成され、
前記第2軌道生成部は、前記基準位置の付近にある第2軌道点の位置と、前記基準位置との前記走行路の長手方向に関する距離に基づいて、前記第2軌道点を前記幅方向に移動させる量を決定する、
請求項1に記載の車両制御装置。 - 前記第2軌道生成部は、前記基準位置の付近にある第2軌道点の位置と、前記基準位置との前記走行路の長手方向に関する距離が大きくなるほど、前記第2軌道点を前記幅方向に移動させる量を、前記基準位置と前記境界部との距離に比して小さくする、
請求項2に記載の車両制御装置。 - 前記運転制御部は、前記対向車両が前記障害物を通過する前に、前記第1軌道と前記第2軌道との干渉があると予測される場合に、前記対向車両が前記障害物を通過するまで前記自車両を停止させる、
請求項1から3のうち何れか1項に記載の車両制御装置。 - 前記運転制御部は、前記対向車両が前記自車両よりも先に前記走行路上の所定位置に到達すると予測される場合には前記自車両を停止させ、前記自車両が前記対向車両よりも先に前記所定位置に到達すると予測される場合には、前記第1軌道に沿って前記自車両を走行させる、
請求項1から3のうち何れか1項に記載の車両制御装置。 - 前記第1軌道生成部は、前記認識部により前記走行路上の障害物が認識されている場合、前記基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第1軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させ、
前記運転制御部は、前記自車両を前記第1軌道に沿って前記境界部から離れる方向に移動させる第1のタイミングが、前記対向車両が前記第2軌道に沿って前記境界部から離れる方向に移動する第2のタイミングと同一または前記第2のタイミングよりも遅い場合には前記自車両を停止させ、前記第2のタイミングよりも早い場合には前記第1軌道に沿って前記自車両を走行させる、
請求項1から3のうち何れか1項に記載の車両制御装置。 - 前記運転制御部は、前記対向車両が前記障害物を通過した後、前記第2軌道が前記走行路の幅方向に関して前記境界部から離れる方向に移動させる前の軌道上に戻ると予測される位置よりも所定距離手前の位置で前記自車両を停止させる、
請求項4から5のうち何れか1項に記載の車両制御装置。 - 前記第2軌道生成部は、前記認識部による走行路の認識可能範囲の境界付近に障害物が認識された場合であって、且つ、前記認識部により対向車両が認識されていない場合に、前記自車両から見て前記障害物よりも遠方であって、前記障害物または前記認識可能範囲から所定距離の位置に仮想の対向車両が存在するものと仮定して、前記第2軌道を生成する、
請求項1から7のうち何れか1項に記載の車両制御装置。 - コンピュータが、
自車両の周辺環境を認識し、
認識した結果に基づいて、前記自車両が走行する第1軌道を生成し、
前記認識した認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成し、
前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行い、
走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、
車両制御方法。 - コンピュータに、
自車両の周辺環境を認識させ、
認識した結果に基づいて、前記自車両が走行する第1軌道を生成させ、
前記認識した認識結果に基づいて、前記自車両に対向する向きで走行してくる対向車両が走行すると予測される第2軌道を生成させ、
前記第1軌道と前記第2軌道との干渉の有無に基づいて、前記自車両の速度または操舵のうち、一方または双方の運転制御を行わせ、
走行路上の障害物が認識されている場合、前記障害物について設定された基準位置と、前記障害物の中心部から見て前記走行路の幅方向に前記基準位置とは反対側にある前記走行路の境界部との距離に応じて、前記第2軌道の一部を、前記走行路の幅方向に関して前記境界部から離れる方向に移動させる、
プログラム。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019093696A JP2020185968A (ja) | 2019-05-17 | 2019-05-17 | 車両制御装置、車両制御方法、およびプログラム |
CN202010376141.9A CN111942378A (zh) | 2019-05-17 | 2020-05-06 | 车辆控制装置、车辆控制方法及存储介质 |
US16/869,635 US20200385020A1 (en) | 2019-05-17 | 2020-05-08 | Vehicle control device, vehicle control method, and storage medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019093696A JP2020185968A (ja) | 2019-05-17 | 2019-05-17 | 車両制御装置、車両制御方法、およびプログラム |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2020185968A true JP2020185968A (ja) | 2020-11-19 |
Family
ID=73221311
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019093696A Pending JP2020185968A (ja) | 2019-05-17 | 2019-05-17 | 車両制御装置、車両制御方法、およびプログラム |
Country Status (3)
Country | Link |
---|---|
US (1) | US20200385020A1 (ja) |
JP (1) | JP2020185968A (ja) |
CN (1) | CN111942378A (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112498368A (zh) * | 2020-11-25 | 2021-03-16 | 重庆长安汽车股份有限公司 | 自动驾驶偏移的横向轨迹规划系统及方法 |
WO2022200826A1 (ja) * | 2021-03-26 | 2022-09-29 | 日産自動車株式会社 | 他車挙動予測方法、他車挙動予測装置及び運転支援方法 |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7049283B2 (ja) * | 2019-03-07 | 2022-04-06 | 本田技研工業株式会社 | 車両制御装置 |
US11587434B2 (en) | 2019-06-25 | 2023-02-21 | International Business Machines Corporation | Intelligent vehicle pass-by information sharing |
CA3092826C (en) * | 2020-01-23 | 2022-01-25 | Left Hand Robotics, Inc. | Nonholonomic robot field coverage method |
US11465619B2 (en) * | 2020-05-27 | 2022-10-11 | Zoox, Inc. | Vehicle collision avoidance based on perturbed object trajectories |
CN112622893A (zh) * | 2020-12-25 | 2021-04-09 | 北京理工大学前沿技术研究院 | 一种多传感器融合的靶车自动驾驶避障方法及系统 |
US20220026234A1 (en) * | 2021-02-25 | 2022-01-27 | Kabushiki Kaisha Toshiba | Drive control device, drive control method, and computer program product |
US11794737B2 (en) * | 2021-04-07 | 2023-10-24 | Ford Global Technologies, Llc | Vehicle operation |
CN114475651B (zh) * | 2021-12-11 | 2024-05-14 | 中国电信股份有限公司 | 基于车路协同的盲区障碍物紧急避让方法和装置 |
CN117115382B (zh) * | 2023-10-25 | 2024-02-09 | 腾讯科技(深圳)有限公司 | 地图道路绘制方法、装置、计算机设备和存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000067394A (ja) * | 1998-08-25 | 2000-03-03 | Honda Motor Co Ltd | 車両の走行安全装置 |
JP2006143052A (ja) * | 2004-11-22 | 2006-06-08 | Honda Motor Co Ltd | 車両の逸脱判定装置 |
JP2009250839A (ja) * | 2008-04-08 | 2009-10-29 | Honda Motor Co Ltd | 車両の物体検知装置 |
JP2011512283A (ja) * | 2008-01-25 | 2011-04-21 | ダイムラー・アクチェンゲゼルシャフト | 車線マークによって区切られている車線の維持に関する車両運転者支援システム及び方法 |
JP2014182632A (ja) * | 2013-03-19 | 2014-09-29 | Honda Motor Co Ltd | 車両周辺監視装置 |
WO2019008703A1 (ja) * | 2017-07-05 | 2019-01-10 | 三菱電機株式会社 | 表示システムおよび表示方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005326963A (ja) * | 2004-05-12 | 2005-11-24 | Fujitsu Ten Ltd | 運転支援装置 |
DE102012215093A1 (de) * | 2012-08-24 | 2014-02-27 | Robert Bosch Gmbh | Fahrerassistenzsystem und Verfahren zum Betreiben des Fahrerassistenzsystems |
US10266175B2 (en) * | 2016-05-31 | 2019-04-23 | Ford Global Technologies, Llc | Vehicle collision avoidance |
JP6376522B2 (ja) * | 2016-11-29 | 2018-08-22 | マツダ株式会社 | 車両制御装置 |
JP6627153B2 (ja) * | 2017-09-11 | 2020-01-08 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
-
2019
- 2019-05-17 JP JP2019093696A patent/JP2020185968A/ja active Pending
-
2020
- 2020-05-06 CN CN202010376141.9A patent/CN111942378A/zh active Pending
- 2020-05-08 US US16/869,635 patent/US20200385020A1/en not_active Abandoned
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000067394A (ja) * | 1998-08-25 | 2000-03-03 | Honda Motor Co Ltd | 車両の走行安全装置 |
JP2006143052A (ja) * | 2004-11-22 | 2006-06-08 | Honda Motor Co Ltd | 車両の逸脱判定装置 |
JP2011512283A (ja) * | 2008-01-25 | 2011-04-21 | ダイムラー・アクチェンゲゼルシャフト | 車線マークによって区切られている車線の維持に関する車両運転者支援システム及び方法 |
JP2009250839A (ja) * | 2008-04-08 | 2009-10-29 | Honda Motor Co Ltd | 車両の物体検知装置 |
JP2014182632A (ja) * | 2013-03-19 | 2014-09-29 | Honda Motor Co Ltd | 車両周辺監視装置 |
WO2019008703A1 (ja) * | 2017-07-05 | 2019-01-10 | 三菱電機株式会社 | 表示システムおよび表示方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112498368A (zh) * | 2020-11-25 | 2021-03-16 | 重庆长安汽车股份有限公司 | 自动驾驶偏移的横向轨迹规划系统及方法 |
WO2022200826A1 (ja) * | 2021-03-26 | 2022-09-29 | 日産自動車株式会社 | 他車挙動予測方法、他車挙動予測装置及び運転支援方法 |
CN117121076A (zh) * | 2021-03-26 | 2023-11-24 | 日产自动车株式会社 | 其他车辆行为预测方法、其他车辆行为预测装置及驾驶辅助方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111942378A (zh) | 2020-11-17 |
US20200385020A1 (en) | 2020-12-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6704890B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP2020185968A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP6811303B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP6782370B2 (ja) | 車両制御装置、車両制御方法、及びプログラム | |
JP6710710B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7043295B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7085371B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7017443B2 (ja) | 車両制御装置、車両制御方法、及びプログラム | |
JP7029322B2 (ja) | 車両制御装置、車両制御方法、及びプログラム | |
JP2019202690A (ja) | 車両制御装置、車両制御方法、及びプログラム | |
JP6975255B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7000202B2 (ja) | 車両制御システム、車両制御方法、およびプログラム | |
JP7345349B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP6827026B2 (ja) | 車両制御装置、車両制御方法、及びプログラム | |
JP2021020580A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
US10854083B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
JP2020147139A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP2021003909A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7080091B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP6648384B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7125969B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP2021009624A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP2021003971A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7396906B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JP7429555B2 (ja) | 車両制御装置、車両制御方法、およびプログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210329 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220405 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20221011 |