JP2021115971A - Vehicle travel control device - Google Patents
Vehicle travel control device Download PDFInfo
- Publication number
- JP2021115971A JP2021115971A JP2020010819A JP2020010819A JP2021115971A JP 2021115971 A JP2021115971 A JP 2021115971A JP 2020010819 A JP2020010819 A JP 2020010819A JP 2020010819 A JP2020010819 A JP 2020010819A JP 2021115971 A JP2021115971 A JP 2021115971A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- stop position
- traveling
- road
- information
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 claims abstract description 137
- 230000008569 process Effects 0.000 claims abstract description 123
- 230000005856 abnormality Effects 0.000 claims description 26
- 238000001514 detection method Methods 0.000 claims description 13
- 239000000284 extract Substances 0.000 claims description 3
- 238000011156 evaluation Methods 0.000 description 90
- 238000004458 analytical method Methods 0.000 description 40
- 230000008859 change Effects 0.000 description 34
- 238000004364 calculation method Methods 0.000 description 30
- 230000033001 locomotion Effects 0.000 description 28
- 238000012545 processing Methods 0.000 description 16
- 230000006399 behavior Effects 0.000 description 14
- 238000004891 communication Methods 0.000 description 10
- 230000003068 static effect Effects 0.000 description 7
- 238000013135 deep learning Methods 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 5
- 230000004397 blinking Effects 0.000 description 4
- 230000012447 hatching Effects 0.000 description 4
- 238000013528 artificial neural network Methods 0.000 description 3
- 230000033228 biological regulation Effects 0.000 description 3
- 210000005252 bulbus oculi Anatomy 0.000 description 3
- 210000003128 head Anatomy 0.000 description 3
- 230000002159 abnormal effect Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000013527 convolutional neural network Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 208000014644 Brain disease Diseases 0.000 description 1
- 208000013016 Hypoglycemia Diseases 0.000 description 1
- 208000006011 Stroke Diseases 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000017531 blood circulation Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 201000010099 disease Diseases 0.000 description 1
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 1
- 230000008451 emotion Effects 0.000 description 1
- 206010015037 epilepsy Diseases 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 208000019622 heart disease Diseases 0.000 description 1
- 230000002218 hypoglycaemic effect Effects 0.000 description 1
- 206010025482 malaise Diseases 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 208000010125 myocardial infarction Diseases 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000007480 spreading Effects 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
- 230000035900 sweating Effects 0.000 description 1
- 230000008685 targeting Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
ここに開示された技術は、車両の走行制御装置に関する技術分野に属する。 The technology disclosed herein belongs to the technical field relating to the vehicle travel control device.
従来より、運転者が体調不良を起こしたり、自動車の制御装置に異常が生じたりしたときに、車両を出来る限り安全な場所に停車させるための走行制御装置が知られている。 Conventionally, a traveling control device for stopping a vehicle in a safe place as much as possible when a driver becomes unwell or an abnormality occurs in a control device of an automobile has been known.
例えば、特許文献1には、運転者のブレーキ操作によらずに車両を停止させる緊急停車ユニットを備え、運転者状態検出部により運転者の状態の悪化が検出された場合には、車両を停車させる位置周辺の環境に応じて車両の舵角を変更しつつ車両を停車させる車両制御装置が開示されている。
For example,
しかしながら、周囲の交通状況は刻々と変化しているので、選択された走行パターンで走行させることが困難であったり、設定された位置に停車させるのが困難な場合がある。 However, since the surrounding traffic conditions are changing from moment to moment, it may be difficult to drive the vehicle in the selected driving pattern or to stop the vehicle at a set position.
ここに開示された技術は、斯かる点に鑑みてなされたものであり、車両を緊急停車させる際の安全性を向上させることを目的とする。 The technology disclosed herein has been made in view of these points, and aims to improve the safety when the vehicle is stopped in an emergency.
前記課題を解決するために、ここに開示された技術では、車両に設置された情報取得部で取得された車外環境情報に基づいて目標位置までの目標経路を生成し、該目標経路に追従するように前記車両を制御する制御部と、路肩領域情報を含む道路情報が記憶された記憶部とを備える走行制御装置を対象として、前記制御部は、前記車両が、路肩領域に隣接する第1走行レーンよりも該路肩領域から離れた第2走行レーンを走行している場合において、該車両を自動停車させるときに、前記路肩領域情報に基づいて前記車両を停車させる停車位置を探索して前記目標位置に設定し、前記目標経路として該停車位置までの退避経路を生成する工程と、前記車両の車速を所定速度以下に減速させる工程と、前記車外環境情報に基づいて、前記第2走行レーンから前記第1走行レーンのフリースペースに車両をレーンチェンジさせる工程と、前記第1走行レーンにおいて前記車両を前記所定速度以下で走行させ、前記第1走行レーンから前記停車位置に該車両を進入させて停車させる工程とを実行するとともに、前記情報取得部で取得された車外環境情報に基づいて、道路上の障害物に衝突する衝突リスクを演算し、該衝突リスクが所定以上の工程が存在する場合に該工程を取りやめて、該取りやめた工程以降の動作を実行するための前記停車位置を設定するという構成とした。 In order to solve the above-mentioned problems, the technology disclosed here generates a target route to a target position based on the outside environment information acquired by the information acquisition unit installed in the vehicle, and follows the target route. Targeting a travel control device including a control unit that controls the vehicle and a storage unit that stores road information including road shoulder area information, the control unit is a first unit in which the vehicle is adjacent to the road shoulder area. When the vehicle is automatically stopped in a second traveling lane that is farther from the road shoulder region than the traveling lane, the stop position at which the vehicle is stopped is searched for based on the road shoulder region information. The second traveling lane is based on a step of setting a target position and generating an evacuation route to the stop position as the target route, a step of decelerating the vehicle speed of the vehicle to a predetermined speed or less, and the outside environment information. In the step of changing the lane of the vehicle to the free space of the first traveling lane, the vehicle is driven at the predetermined speed or less in the first traveling lane, and the vehicle is made to enter the stopping position from the first traveling lane. In addition to executing the step of stopping the vehicle, the collision risk of colliding with an obstacle on the road is calculated based on the outside environment information acquired by the information acquisition unit, and there is a step in which the collision risk is equal to or higher than a predetermined value. In some cases, the process is canceled and the stop position for executing the operation after the canceled process is set.
このように、道路上の障害物に衝突する衝突リスクが所定以上の工程を取りやめて、取りやめた工程以降の動作を実行するための停車位置を設定することにより、一旦設定した緊急停車位置に向かう退避経路が、その後の交通流の変化によって衝突リスクが顕在化する前に、安全に緊急停車ができる停車位置及び退避経路に切り替えることができる。 In this way, by canceling the process in which the collision risk of colliding with an obstacle on the road exceeds a predetermined value and setting the stop position for executing the operation after the canceled process, the vehicle heads for the once set emergency stop position. The evacuation route can be switched to a stop position and an evacuation route where an emergency stop can be safely performed before the collision risk becomes apparent due to a subsequent change in traffic flow.
前記制御部は、前記車両の運転者の体調異常が検出された場合、前記体調異常に応じて、該体調異常検出後の経過時間または走行距離の少なくとも一方の制限を設け、当該制限の範囲内において前記停車位置を設定する、としてもよい。 When an abnormality in the physical condition of the driver of the vehicle is detected, the control unit sets a limit of at least one of the elapsed time or the mileage after the detection of the abnormality in the physical condition, and is within the range of the limitation. The stop position may be set in.
これにより、自動停車するまでに想定外の時間がかかったり、なかなか停車できないという事態を避けることができる。 As a result, it is possible to avoid a situation in which it takes an unexpected time to automatically stop or the vehicle cannot be stopped easily.
前記制御部は、前記路肩領域情報を基に、前記路肩領域の幅員及び長さのそれぞれが所定の基準値以上である領域を停車可能領域として抽出し、前記停車可能領域が複数ある場合に、該停車可能領域の広さに応じた優先度を設け、当該優先度の高い停車可能領域を前記停車位置に設定する、としてもよい。 Based on the road shoulder area information, the control unit extracts an area in which the width and length of the road shoulder area are equal to or larger than a predetermined reference value as a stoptable area, and when there are a plurality of stoptable areas, the control unit extracts. Priority may be set according to the size of the stoptable area, and the stoptable area having a high priority may be set at the stop position.
これにより、所定の制約条件のもとで、最も安全な停車場所を目指して走行させることができる。また、その安全な場所にたどりつけないことが判明した場合に、順次安全な場所を探索して、目標停車位置を変更していくことができる。 As a result, it is possible to drive toward the safest stop place under a predetermined constraint condition. In addition, when it is found that the safe place cannot be reached, the safe place can be searched in sequence and the target stop position can be changed.
以上説明したように、ここに開示された技術によると、車両を緊急停車させる際の安全性を向上させることができる。 As described above, according to the technology disclosed herein, it is possible to improve the safety when the vehicle is stopped in an emergency.
以下、例示的な実施形態について、図面を参照しながら詳細に説明する。尚、以下の説明において、車両(本実施形態では自動車)の前進走行側を単に前側といい、後退走行側を単に後側という。また、後側から前側を見たときの左側を左側といい、その逆を右側という。また、以下の説明では、車両は左側通行の地域を走行する場合を想定して説明する。 Hereinafter, exemplary embodiments will be described in detail with reference to the drawings. In the following description, the forward traveling side of the vehicle (in the present embodiment, the automobile) is simply referred to as the front side, and the backward traveling side is simply referred to as the rear side. The left side when looking at the front side from the rear side is called the left side, and the opposite is called the right side. Further, in the following description, the vehicle will be described on the assumption that the vehicle travels in a left-hand traffic area.
(車両制御システム)
図1は、実施形態の車両制御システム1の構成を例示する。車両制御システム1は、車両(具体的には自動四輪車)に設けられる。車両は、マニュアル運転とアシスト運転と自動運転とに切り換え可能である。マニュアル運転は、運転者の操作(例えばアクセルの操作など)に応じて走行する運転である。アシスト運転は、運転者の操作を支援して走行する運転である。自動運転は、運転者の操作なしに走行する運転である。車両制御システム1は、アシスト運転および自動運転において、車両を制御する。具体的には、車両制御システム1は、車両に設けられたアクチュエータ40を制御することで車両の動作(特に走行)を制御する。
(Vehicle control system)
FIG. 1 illustrates the configuration of the
車両制御システム1は、情報取得部30と、車両制御装置10とを備える。以下の説明では、車両制御システム1が設けられている車両を「自車両H」と記載し、自車両Hの周囲に存在する他の車両を「他車両J」と記載する。
The
〔アクチュエータ〕
アクチュエータ40は、駆動系のアクチュエータ、操舵系のアクチュエータ、制動系のアクチュエータなどを含む。駆動系のアクチュエータの例としては、エンジンE、トランスミッションT、モータが挙げられる。制動系のアクチュエータの例としては、ブレーキBが挙げられる。操舵系のアクチュエータの例としては、ステアリングSが挙げられる。
[Actuator]
The
〔情報取得部〕
情報取得部30は、車両の制御に用いられる各種情報を取得する。情報取得部30が取得する情報には、道路上の障害物の情報、及び、車両の走行目標となる目標位置までの目標経路を生成するための車外の環境情報(車外環境情報)が含まれる。この例では、情報取得部30は、複数のカメラ31と、複数のレーダ32と、位置センサ33と、車両状態センサ34と、乗員状態センサ35と、車外通信部36と、運転操作センサ37とを含む。
[Information acquisition department]
The
〈カメラ〉
複数のカメラ31は、互いに同様の構成を有する。複数のカメラ31は、車両の周囲を囲うように車両に設けられる。複数のカメラ31は、車両の周囲に広がる環境(路上障害物を含む。以下、車外環境という)を撮像することで、車外環境を示す画像データを取得する。複数のカメラ31の各々により得られた画像データは、車両制御装置10に送信される。カメラ31で撮像された画像データは、車外環境情報の一例である。
<camera>
The plurality of
この例では、複数のカメラ31は、広角レンズを有する単眼カメラである。例えば、カメラ31は、CCD(Charge Coupled Device)やCMOS(Complementary metal-oxide-semiconductor)などの固体撮像素子を用いて構成される。尚、カメラ31は、狭角レンズを有する単眼カメラであってもよいし、広角レンズまたは狭角レンズを有するステレオカメラであってもよい。
In this example, the plurality of
〈レーダ〉
複数のレーダ32は、互いに同様の構成を有する。複数のレーダ32は、車両の周囲を囲うように車両に設けられる。複数のレーダ32は、車外環境を検出する。具体的には、レーダ32は、車外環境へ向けて電波を送信して車外環境からの反射波を受信することで車外環境を検出する。複数のレーダ32の検出結果は、車両制御装置10に送信される。
<Radar>
The plurality of
例えば、レーダ32は、ミリ波を送信するミリ波レーダであってもよいし、レーザ光を送信するライダ(Light Detection and Ranging)であってもよいし、赤外線を送信する赤外線レーダであってもよいし、超音波を送信する超音波センサであってもよい。レーダ32の検出結果は、車外環境情報の一例である。
For example, the
〈位置センサ〉
位置センサ33は、車両の位置(例えば緯度および経度)を検出する。例えば、位置センサ33は、全地球測位システムからのGPS情報を受信し、GPS情報に基づいて車両の位置を検出する。位置センサ33により得られた情報(車両の位置)は、車両制御装置10に送信される。位置センサ33で検出された車両の位置は、車外環境情報の一例である。
<Position sensor>
The
〈車両状態センサ〉
車両状態センサ34は、車両の状態(例えば速度や加速度やヨーレートなど)を検出する。例えば、車両状態センサ34は、車両の速度を検出する車速センサ、車両の加速度を検出する加速度センサ、車両のヨーレートを検出するヨーレートセンサなどを含む。車両状態センサ34により得られた情報(車両の状態)は、車両制御装置10に送信される。
<Vehicle condition sensor>
The
〈乗員状態センサ〉
乗員状態センサ35は、車両を運転する運転者の状態(例えば運転者の身体挙動や生体情報など)を検出する。乗員状態センサ35により得られた情報(運転者の状態)は、車両制御装置10に送信される。図示しないが、例えば、乗員状態センサ35は、車内カメラ、生体情報センサなどを含む。車内カメラは、車両の内部に設けられる。車内カメラは、運転者の眼球を含む領域を撮像することで運転者の眼球を含む画像データを取得する。車内カメラにより得られた画像データは、車両制御装置10に送信される。例えば、車内カメラは、運転者の前方に配置され、運転者の眼球が撮像範囲内となるように撮像範囲が設定される。尚、車内カメラは、運転者に装着されるゴーグル(図示省略)に設けられてもよい。生体情報センサは、運転者の生体情報(例えば発汗や心拍や血流量や皮膚温など)を検出する。
<Passenger status sensor>
The
〈車外通信部〉
車外通信部36は、車両の外部に設けられた車外ネットワーク(例えばインターネットなど)を通じて情報を受信する。例えば、車外通信部36は、車両の周囲に位置する他車両Jからの通信情報、ナビゲーションシステム(図示を省略)からのカーナビゲーションデータ、交通情報、高精度地図情報などを受信する。車外通信部36により得られた情報は、車両制御装置10に送信される。車外通信部36により車外ネットワークから取得された交通情報、高精度地図情報などの情報は、車外環境情報の一例である。
<Outside communication department>
The out-of-
〈運転操作センサ〉
運転操作センサ37は、車両に加えられる運転操作を検出する。例えば、運転操作センサ37は、アクセル開度センサ、操舵角センサ、ブレーキ油圧センサなどを含む。アクセル開度センサは、車両のアクセルの操作量を検出する。操舵角センサは、車両のハンドルの操舵角を検出する。ブレーキ油圧センサは、車両のブレーキの操作量を検出する。運転操作センサ37により得られた情報(車両の運転操作)は、車両制御装置10に送信される。
<Driving operation sensor>
The driving
〔車両制御装置〕
車両制御装置10は、制御部100と、記憶部20とを備える。車両制御装置10は、アクチュエータ40および車両制御システム1の各部(この例では情報取得部30など)と電気的に接続される。そして、車両制御装置10は、車両制御システム1の各部により得られた情報に基づいてアクチュエータ40および車両制御システム1の各部を制御する。
[Vehicle control device]
The
車両制御装置10は、アシスト運転または自動運転において、車両が走行すべき経路である目標経路を決定し、車両が目標経路に追従して走行するようにアクチュエータ40の動作を制御する。例えば、車両制御装置10は、1つまたは複数の電子制御ユニット(ECU)により構成される。電子制御ユニットは、単一のIC(Integrated Circuit)により構成されてもよいし、複数のICにより構成されてもよい。また、IC内には、単一のコアまたはダイが設けられてもよいし、連携する複数のコアまたはダイが設けられてもよい。コアまたはダイは、例えば、CPU(プロセッサ)と、CPUを動作させるためのプログラムやCPUでの処理結果などの情報を記憶するメモリとにより構成されてもよい。メモリは、記憶部20の一例である。記憶部20については、後で具体的に説明する。
In assisted driving or automatic driving, the
〔制御部〕
車両制御装置10は、制御部100を備える。制御部100は、情報取得部30により取得された各種情報に基づいて、アクチュエータ40の動作を制御する。
[Control unit]
The
この例では、制御部100は、運転者の体調を監視する。そして、制御部100は、運転者の体調異常が検出されるまで通常走行制御を行い、運転者の体調異常が検出されると通常走行制御を停止して退避走行制御を開始する。通常走行制御では、制御部100は、複数の経路候補の中から目標経路を選択し、車両が目標経路を走行するようにアクチュエータ40の動作を制御する。退避走行制御では、制御部100は、車両を路肩領域Rに設定した緊急停車位置に向けて退避させるための退避経路を生成し、車両が退避経路を走行するようにアクチュエータ40の動作を制御する。制御部100は、退避走行制御において、運転者の操作なしに車両を走行させる。すなわち、退避走行制御は、前述の自動運転である。尚、上記の体調異常は、疾患により運転者の運転機能が低下した状態のことであり、運転者による車両の運転の継続が困難である状態のことである。このような体調異常の例としては、脳卒中などの脳疾患、心筋梗塞などの心疾患、癲癇、低血糖などが挙げられる。ここで、本開示における路肩領域Rとは、路肩及び路側帯のように車両の走行路に沿って路端寄りに設けられた帯状の道路のうち、車両の停車が認められている領域を指すものとする。また、路肩領域Rには、走行路の路端寄りに車両が駐停車できるように道路の一部の幅員を広げて設けられた車両用の駐停車領域(例えば、図4の斜線領域R11参照)を含む。
In this example, the
制御部100は、車外環境認識部111と、運転操作認識部112と、車両挙動推定部113と、乗員状態推定部114と、走行制御部115と、緊急停車制御部130とを有する。
The
〈車外環境認識部〉
車外環境認識部111は、複数のカメラ31の出力と、複数のレーダ32の出力と、位置センサ33の出力と、車外通信部36の出力と、車両挙動推定部113の出力に基づいて、車両の外部環境を認識する。車外環境認識部111は、車外環境認識手段の一例である。
<External environment recognition department>
The vehicle exterior
例えば、車外環境認識部111は、深層学習により生成された学習モデルを用いて、上記の出力から車両の外部環境を示す車外環境情報を生成する。深層学習では、多層ニューラルネットワーク(Deep Neural Network)が用いられる。多層ニューラルネットワークの例としては、CNN(Convolutional Neural Network)が挙げられる。
For example, the vehicle exterior
具体的には、車外環境認識部111は、カメラ31により得られた画像に対して画像処理を行うことで、走行路などの車両が移動可能な領域を表す二次元マップデータを生成する。また、車外環境認識部111は、レーダ32の検出結果に基づいて、車両の周辺に存在する物体に関する情報である物体情報を取得する。車外環境認識部111は、前記物体情報を基に、車両の周辺に存在する物体のうち車両の走行及び停車をする過程において障害となり得る路上障害物を認識する。物体の例としては、時間経過により変位する動体と、時間経過により変位しない静止体とが挙げられる。動体の例としては、自動四輪車、自動二輪車、自転車、歩行者などが挙げられる。静止体の例としては、標識、街路樹、中央分離帯、センターポール、建物などが挙げられる。また、物体情報には、物体の位置座標、物体の速度などが含まれる。尚、車外環境認識部111は、レーダ32の検出結果に加えて又は代えてカメラ31により得られた画像に基づいて物体情報を取得してもよい。そして、車外環境認識部111は、二次元マップデータと物体情報とを統合することで、車外環境を表す統合マップデータ(三次元マップデータ)を生成する。二次元マップデータ、物体情報、統合マップデータは、車外環境情報の一例である。
Specifically, the vehicle exterior
〈運転操作認識部〉
運転操作認識部112は、運転操作センサ37の出力に基づいて車両に加えられる運転操作を認識する。例えば、運転操作認識部112は、深層学習により生成された学習モデルを用いて、運転操作センサ37の出力から車両に加えられる運転操作を示すデータを生成する。
<Driving operation recognition unit>
The driving
〈車両挙動推定部〉
車両挙動推定部113は、車両状態センサ34の出力に基づいて車両の挙動(例えば速度や加速度やヨーレートなど)を推定する。例えば、車両挙動推定部113は、深層学習により生成された学習モデルを用いて、車両状態センサ34の出力から車両の挙動を示すデータを生成する。
<Vehicle behavior estimation unit>
The vehicle
例えば、車両挙動推定部113において用いられる学習モデルは、車両6軸モデルである。車両6軸モデルは、走行中の車両の「前後」「左右」「上下」の3軸方向の加速度と「ピッチ」「ロール」「ヨー」の3軸方向の角速度とをモデル化したものである。すなわち、車両6軸モデルは、車両の動きを古典的な車両運動工学的な平面上のみ(車両の前後左右(X−Y移動)とヨー運動(Z軸)のみ)で捉えるのではなく、4つの車輪にサスペンションを介して乗っている車体のピッチング(Y軸)およびロール(X軸)運動とZ軸の移動(車体の上下動)の、合計6軸を用いて車両の挙動を再現する数値モデルである。
For example, the learning model used in the vehicle
〈乗員状態推定部〉
乗員状態推定部114は、乗員状態センサ35の出力に基づいて運転者の状態(例えば運転者の健康状態や感情や姿勢など)を推定する。例えば、乗員状態推定部114は、深層学習により生成された学習モデルを用いて、乗員状態センサ35の出力から運転者の挙動を示すデータを生成する。この例では、乗員状態推定部114は、運転者の体調異常を検出する。
<Crew condition estimation unit>
The occupant
〈走行制御部〉
走行制御部115は、車外環境認識部111の出力と、運転操作認識部112の出力と、車両挙動推定部113の出力と、乗員状態推定部114の出力とに基づいて、アクチュエータ40を制御する。この例では、走行制御部115は、経路生成部116と、経路決定部117と、車両運動決定部118と、アクチュエータ制御部119と、ルールベース制御部120を有する。
<Driving control unit>
The
《経路生成部》
経路生成部116は、車外環境認識部111の出力に基づいて、車両の走行目標となる目標位置に車両を走行させるための1つまたは複数の候補経路を生成する。候補経路は、車両が走行可能な経路であり、目標経路の候補である。候補経路には、例えば、車外環境認識部111により認識された路上障害物を回避する走行経路が含まれる。
<< Route generator >>
The
例えば、経路生成部116は、ステートラティス法を用いて候補経路を生成する。具体的な図示は省略するが、経路生成部116は、車外環境認識部111により認識された走行路上に多数のグリッド点からなるグリッド領域を設定し、車両の進行方向へ向けて複数のグリッド点を順に連結することで多数の走行経路を設定する。また、経路生成部116は、複数の走行経路の各々に経路コストを付与する。例えば、走行経路における車両の安全性が高くなるにつれて、その走行経路に付与される経路コストが小さくなる。そして、経路生成部116は、複数の走行経路の各々に付与された経路コストに基づいて、複数の走行経路の中から1つまたは複数の走行経路を候補経路として選択する。
For example, the
ここで、目標位置には、車両の最終的な到達先を示す最終目標位置と、最終目標位置に車両を走行させる過程で、最終目標位置と現在の車両位置との間に適宜設定される中間目標位置とが含まれる。中間目標位置は、例えば、上記のグリッド領域の終端における車両の到達先を示す目標位置であり、走行の過程で適宜更新される。 Here, the target position is an intermediate set between the final target position indicating the final destination of the vehicle and the final target position and the current vehicle position in the process of traveling the vehicle to the final target position. The target position and is included. The intermediate target position is, for example, a target position indicating the destination of the vehicle at the end of the grid region, and is appropriately updated in the process of traveling.
また、経路生成部116は、運転者の体調異常が検出された場合のような緊急時における退避走行制御では、車両を緊急停車させる停車位置を探索して目標位置に設定し、停車位置までの退避経路を生成する。退避経路の生成方法の具体例については、後で説明する。
Further, in the evacuation running control in an emergency such as when an abnormality in the physical condition of the driver is detected, the
《経路決定部》
経路決定部117は、車外環境認識部111の出力、運転操作認識部112の出力、乗員状態推定部114の出力の少なくとも1つに基づいて、経路生成部116とルールベース制御部120と退避制御部130との各々により生成された1つまたは複数の候補経路の中から目標経路となる候補経路を選択する。例えば、経路決定部117は、運転者が正常な状態(通常走行状態)において、複数の候補経路のうち運転者が最も快適であると感じる候補経路を選択する。
《Route determination part》
The
例えば、経路決定部117は、通常走行状態における走行制御(通常走行制御)において、ルールベース制御部120により生成された候補経路よりも経路生成部116により生成された候補経路を優先的に目標経路として選択する。また、経路決定部117は、通常走行制御において、経路生成部116により生成された候補経路がルールベース制御部120により生成された候補経路から大きく逸脱している場合に、ルールベース制御部120により生成された候補経路を目標経路として選択してもよい。例えば、経路決定部117は、経路生成部116により生成された走行経路がルールベース制御部120により探索されたフリースペースを通過しない場合に、経路生成部116により生成された候補経路がルールベース制御部120により生成された候補経路から大きく逸脱していると判定してもよい。ここで、フリースペースとは、車外環境に含まれる走行路及び路肩領域のうち障害物が存在しない領域である。障害物は、動的な障害物と、静的な障害物とを含む。動的な障害物の例としては、他車両、歩行者などが挙げられる。静的な障害物の例としては、中央分離帯、センターポールなどが挙げられる。尚、以下の説明では、走行路のフリースペースを「走行路フリースペース」と呼ぶ場合がある。
For example, in the travel control (normal travel control) in the normal travel state, the
また、経路決定部117は、運転者の体調異常が検出された場合のような緊急時における退避走行制御では、経路生成部116により生成された退避経路を目標経路として選択する。
Further, the
《車両運動決定部》
車両運動決定部118は、経路決定部117により目標経路として選択された候補経路に基づいて目標運動を決定する。この目標運動は、目標経路に追従して走行するために必要となる車両の運動のことである。この例では、車両運動決定部118は、目標運動を達成するための駆動力と制動力と操舵量である目標駆動力と目標制動力と目標操舵量をそれぞれ導出する。例えば、車両運動決定部118は、車両6軸モデルに基づいて目標経路における車両の動きを演算し、その演算結果に基づいて目標運動を決定する。
《Vehicle motion decision unit》
The vehicle
《アクチュエータ制御部》
アクチュエータ制御部119は、車両運動決定部118により決定された目標運動に基づいてアクチュエータ40を制御する。この例では、アクチュエータ制御部119は、PT制御部119aと、ブレーキ制御部119bと、操舵制御部119cとを有する。PT制御部119aは、目標駆動力を示す駆動指令値を駆動系のアクチュエータに送信する。ブレーキ制御部119bは、目標制動力を示す制動指令値を制動系のアクチュエータに送信する。操舵制御部119cは、目標操舵量を示す操舵指令値を操舵系のアクチュエータに送信する。
<< Actuator control unit >>
The
〈ルールベース制御部〉
ルールベース制御部120は、深層学習により生成された学習モデルの代わりに、予め定められたルールに基づくアルゴリズムを用いて処理を行う。
<Rule-based control unit>
The rule-based
具体的には、ルールベース制御部120は、情報取得部30の出力に基づいて車外環境を認識し、その車外環境に基づいて走行路フリースペースを探索する。例えば、ルールベース制御部120は、予め設定された探索ルールに基づいて、走行路フリースペースを探索する。探索ルールには、物体を中心とする所定の範囲(例えば数mの範囲)を回避不能範囲とするというルールが含まれてもよい。また、ルールベース制御部120は、物体が動体である場合に、その動体の移動速度を考慮して走行路フリースペースを探索するように構成されてもよい。
Specifically, the rule-based
そして、ルールベース制御部120は、走行路フリースペースを通過する候補経路(すなわち障害物を回避する候補経路)を生成する。ルールベース制御部120により生成された候補経路(すなわちフリースペースを通過する候補経路)は、走行制御部115の経路決定部117において利用される。
Then, the rule-based
〈緊急停車制御部〉
緊急停車制御部130は、緊急時(例えば、乗員状態推定部114により運転者の異常が検出されたとき)に、運転者の操作によらずに該車両を緊急停車位置まで自動走行させて、該停車位置に緊急停車させるための制御を行う。具体的には、緊急停車制御部130は、停車位置決定部131と、停車経路生成部132と、リスク算出部133とを備える。
<Emergency stop control unit>
In an emergency (for example, when an abnormality of the driver is detected by the occupant state estimation unit 114), the emergency
尚、緊急停車制御部130は、運転者の異常が検出された場合に、それまでの運転モードが、マニュアル運転モード、アシスト運転モード、自動運転モードのいずれの運転モードであるかに拘わらずに自動的に作動する。
When the driver's abnormality is detected, the emergency
図2A〜図2C及び図3A〜図3Dは、緊急停車制御部130による処理の一例を示したフローチャートであり、緊急停車制御部130の各構成要素の機能についてこれらの図面を参照しつつ説明する。尚、説明の便宜上、図2A〜図2Cをまとめて図2といい、図3A〜図3Dをまとめて図3という場合がある。
2A to 2C and FIGS. 3A to 3D are flowcharts showing an example of processing by the emergency
《停車位置決定部》
停車位置決定部131は、乗員状態推定部114により運転者の異常が検出されると、路肩領域の分析を行い、その路肩領域の分析結果に基づいて緊急停車位置を設定する。緊急停車位置は、前述の最終目標位置の一例である。
《Stop position determination part》
When the driver's abnormality is detected by the occupant
図2の緊急停車制御は、運転者の異常が検出されると動作する。すなわち、運転者の異常が検出されるまでは、図2AのステップS11で待機状態となる。 The emergency stop control of FIG. 2 operates when an abnormality of the driver is detected. That is, until the driver's abnormality is detected, the standby state is set in step S11 of FIG. 2A.
図2Aにおいて、運転者の異常が検出されると、ステップS11でYES判定となる。次のステップS13及びS14において、Tは運転者異常が検出されてからの経過時間であり、運転者の異常が検出された時点をT=0とする。そうすると、運転者異常が検出された後の最初の動作では、ステップS13,S14はYES判定となり、制御フローは次のステップS15に進む。 When an abnormality of the driver is detected in FIG. 2A, a YES determination is made in step S11. In the next steps S13 and S14, T is the elapsed time from the detection of the driver abnormality, and the time point at which the driver abnormality is detected is set to T = 0. Then, in the first operation after the driver abnormality is detected, the determination in steps S13 and S14 is YES, and the control flow proceeds to the next step S15.
ステップS15では、停車位置決定部131は、退避スペースを検出するための検出候補エリアを設定する。具体的には、停車位置決定部131は、退避スペースを検出する検出候補エリアの始点Psと終点Peとを設定する。
In step S15, the stop
始点Psの設定方法は、特に限定されないが、例えば、停車位置決定部131は、自車両Hの車速を所定の速度以下まで減速させることができる地点を始点Psとして設定する。より具体的には、始点Psは、例えば、運転者の体調異常が検出されてから、自車両Hの車速を所定以下(例えば、10km/h)まで減速させ、その車速で所定時間(例えば3秒間)走行した場合における到達地点に設定される。
The method of setting the start point Ps is not particularly limited, but for example, the stop
図4には、始点Ps及び終点Peの設定例を示している。具体的に、図4では、実線の自車両HのH1の位置で運転者の異常が検出され、H2の場所で減速が開始されて、H3の場所で車両が上記の所定速度までの減速及び所定時間の走行が予測される場合に、始点PsがH3の場所に設定された例を示している。尚、本実施形態では、時間経過についての説明を容易にするために、自車両の符号Hの後ろに時間経過順を示す1,2,3…の符号を付して、位置H1,H2,H3…として説明するものとする。すなわち、位置H1,H2,H3…は、自車両Hの位置が時間経過によってどのように遷移するかを示している。他車両Jについても同様である。他の図面についても、同様に、車両の符号H,Jの後ろに数字を付して、車両位置の時間経過による遷移状態を示す場合がある。
FIG. 4 shows a setting example of the start point Ps and the end point Pe. Specifically, in FIG. 4, an abnormality of the driver is detected at the position of H1 of the own vehicle H on the solid line, deceleration is started at the location of H2, and the vehicle decelerates to the above-mentioned predetermined speed at the location of H3. An example is shown in which the starting point Ps is set to the location of H3 when traveling for a predetermined time is predicted. In the present embodiment, in order to facilitate the explanation of the passage of time, the reference numerals H of the own vehicle are followed by the
終点Peの設定方法は、特に限定されないが、例えば、始点Psから所定の車速(例えば10km/h)で所定時間走行した場合に車両が到達する地点に設定される。所定時間の設定方法は、特に限定されないが、例えば、走行シーンに合わせて設定される。具体的には、終点Peは、一般道では始点Psから60秒走行した地点、高速道路では始点Psから180秒間走行した地点、のように設定される。また、終点Peとして、実際の制限時間に対してマージンを持たせるようにしてもよい。 The method of setting the end point Pe is not particularly limited, but is set to, for example, a point reached by the vehicle when traveling for a predetermined time at a predetermined vehicle speed (for example, 10 km / h) from the start point Ps. The method of setting the predetermined time is not particularly limited, but is set according to, for example, a driving scene. Specifically, the end point Pe is set as a point where the vehicle travels for 60 seconds from the start point Ps on a general road and a point where the vehicle travels for 180 seconds from the start point Ps on an expressway. Further, as the end point Pe, a margin may be provided with respect to the actual time limit.
このように、検出候補エリアの終点Peを定めることで、どの位置までに停車させるかを確定させることができ、自動停車するまでに想定外の時間がかかったり、なかなか停車できないという事態を避けることができる。尚、停車位置決定部131による終点Peの決定方法は、特に限定されない。例えば、終点Peまでの距離(走行時間)が固定値であってもよいし、運転者の体調異常の状態や重症度、緊急度などに応じて値が変更されてもよい。
In this way, by determining the end point Pe of the detection candidate area, it is possible to determine the position to stop, and avoid the situation where it takes an unexpected time to stop automatically or it is difficult to stop. Can be done. The method of determining the end point Pe by the stop
ステップS15において、停車位置決定部131は、始点Ps及び終点Peの設定が終わると、次のステップS16では、後述する静的評価が終了しているか否かが判断される。ここでは、緊急停車位置が未設定のため、NO判定となり、制御フローは、路肩領域の分析(ステップS20)に進む。
In step S15, when the stop
−路肩領域の分析−
図2Bは、路肩領域の分析工程S20の一例について示したフローチャートである。本実施形態では、図2Bのフローに基づいた路肩領域の分析結果として、図4の走行シーンに基づいて図5の分析リストL1が作成される例、及び、図6の走行シーンに基づいて図7Aの分析リストL2が作成される例について説明する。
-Analysis of shoulder area-
FIG. 2B is a flowchart showing an example of the road shoulder region analysis step S20. In the present embodiment, as an analysis result of the road shoulder region based on the flow of FIG. 2B, an example in which the analysis list L1 of FIG. 5 is created based on the driving scene of FIG. An example in which the analysis list L2 of 7A is created will be described.
尚、図6では、後述する幅員の評価値がCの路肩領域についての図示を省略しているが、図4と同様に、停止線SLの自車両H側に第1走行レーンに沿って延びる路肩領域R(幅員の評価値がA〜C)が設けられているものとする。後述する図8、図10A、図11、図12についても同様である。また、以下の説明において、図5の分析リストL1と図7の分析リストL2とを区別しない場合には、単に分析リストLと記載する。 In FIG. 6, although the illustration of the road shoulder region where the evaluation value of the width described later is C is omitted, it extends along the first traveling lane to the own vehicle H side of the stop line SL as in FIG. It is assumed that the road shoulder region R (the evaluation value of the width is A to C) is provided. The same applies to FIGS. 8, 10A, 11 and 12, which will be described later. Further, in the following description, when the analysis list L1 of FIG. 5 and the analysis list L2 of FIG. 7 are not distinguished, they are simply described as the analysis list L.
ステップS21において、停車位置決定部131は、検出候補エリア(地点Psから地点Peの間)の道路情報を取得する。道路情報には、走行路に関する情報と、路肩領域の幅員を算出するための情報と、交通規制情報や道路構造情報などの車両を走行させたり停車させたりする上での交通制約となる情報(以下、交通制約情報という)とが含まれる。道路情報は、例えば、車外通信部36を介して外部のネットワークやGPSから取得される。
In step S21, the stop
ステップS22では、路肩領域の幅員が算出される。具体的な算出方法は、特に限定されないが、例えば、停車位置決定部131は、車外通信部36を介して受信された高精度地図情報と、情報取得部30で取得された車外環境情報に基づいて、路肩領域Rの幅員が算出される。より具体的には、例えば、図4に示すように、停車位置決定部131は、高精度地図情報の第1走行レーンの中心において、始点Psと終点Peとの間に、所定間隔でn個(nは2以上の整数)の点P1〜Pnをプロットし、それぞれの点P1〜Pnから道路端までの法線を引いて距離を求め、各法線の長さから走行レーンの1/2幅を引いて路肩領域の幅員とする。尚、高精度地図情報に路肩領域の幅員の情報が含まれている場合には、ステップS22を省略して、その情報を使用するようにしてもよい。換言すると、路肩領域の幅員は、例えば、縁石から第1走行レーンの路肩側の白線まで幅員である。
In step S22, the width of the road shoulder region is calculated. The specific calculation method is not particularly limited, but for example, the stop
ステップS22では、路肩領域の有無や路肩領域と走行路との間の白線の種類についての情報を取得し、分析リストLに反映する。図5の例では、それぞれの点Px(Ps<Px<Pe)について、路肩領域がある場合に「1」、路肩領域がない場合に「0」が設定されている。また、白線が1本の場合、すなわち、車両の駐停車が可能な路肩領域の場合に「1」、それ以外の白線の場合に「0」が設定されている。また、路肩領域を区画する白線が存在しない場所については、「−」が設定されている。図7Aについても同様である。 In step S22, information on the presence / absence of the road shoulder region and the type of the white line between the road shoulder region and the traveling road is acquired and reflected in the analysis list L. In the example of FIG. 5, for each point P x (Ps <P x <Pe), "1" is set when there is a road shoulder area, and "0" is set when there is no road shoulder area. Further, when there is one white line, that is, "1" is set in the case of the road shoulder area where the vehicle can be parked and stopped, and "0" is set in the case of other white lines. In addition, "-" is set for the place where the white line that divides the road shoulder area does not exist. The same applies to FIG. 7A.
ステップS23では、路肩領域の幅員についての評価(以下、路肩幅員評価ともいう)が実行される。図5及び図7Aの例では、路肩領域の幅員に応じて各点Pxを3段階(A、B、C)で評価をした例を示している。評価Aは路肩領域の幅員が「車両の全幅+0.5m以上」であり、評価Bは路肩領域の幅員が「車両の全幅+0.5m未満」であり、評価Bは路肩領域の幅員が「車両の全幅未満」である。車両の全幅には、例えば、自車両に関する車両情報が適用される。また、路肩領域の評価は、路肩領域の有無や白線の種類を加味したものとしてもよい。例えば、図5の点Pn−2〜Pnの欄に示すように、路肩領域の有無で「0」が設定されていたり、白線の種類で「0」が設定されている場合に、路肩領域の評価として、車両の停車位置として不適切である点であることを示す評価値(例えば「0」)が設定されるようにしてもよい。 In step S23, an evaluation of the width of the road shoulder region (hereinafter, also referred to as a road shoulder width evaluation) is executed. In the example of FIG. 5 and FIG. 7A, 3 steps each point P x according to the width of the shoulder region (A, B, C) shows an example in which the evaluation with. In evaluation A, the width of the road shoulder area is "total width of the vehicle + 0.5 m or more", in evaluation B, the width of the road shoulder area is "total width of the vehicle + 0.5 m or less", and in evaluation B, the width of the road shoulder area is "vehicle". Less than the full width of. " For example, vehicle information about the own vehicle is applied to the entire width of the vehicle. In addition, the evaluation of the road shoulder region may take into account the presence or absence of the road shoulder region and the type of white line. For example, as shown in the columns of points P n-2 to P n in FIG. 5, when "0" is set depending on the presence or absence of the road shoulder area, or when "0" is set as the type of white line, the road shoulder As the evaluation of the area, an evaluation value (for example, "0") indicating that the point is inappropriate as the stop position of the vehicle may be set.
ステップS24では、交通規制情報や道路構造情報などの交通制約情報が分析リストに反映される。交通規制情報は、例えば、交差点までの距離、横断歩道/自動車横断帯までの距離、分流路/合流路までの距離、踏切までの距離、バス停留所までの距離、駐停車禁止の道路標識/路面標示の有無、安全地帯からの距離などの情報が含まれる。道路構造情報としては、例えば、道路の勾配量、トンネルの内/外、軌道敷の内/外などの情報が含まれる。 In step S24, traffic restriction information such as traffic regulation information and road structure information is reflected in the analysis list. Traffic regulation information includes, for example, the distance to an intersection, the distance to a pedestrian crossing / car crossing zone, the distance to a branch / junction, the distance to a railroad crossing, the distance to a bus stop, and road markings / road surfaces where parking is prohibited. Information such as the presence or absence of markings and the distance from the safe zone is included. The road structure information includes, for example, information such as the amount of slope of the road, the inside / outside of the tunnel, and the inside / outside of the trackbed.
より具体的に、例えば、ステップS24では、緊急停車位置(緊急停車スペース)として設定可能か否かが分析リストLに反映される。例えば、分析リストLには、それぞれの点Pxについて、緊急停車位置として設定可能な場合に「1」、設定不可能な場合に「0」が設定される。図5の例では、交差点までの距離が5m以上ある場合には緊急停車位置の設定が可能な位置としての「1」が設定され、交差点までの距離が5m未満の場合に、緊急停車位置の設定が不可能な位置としての「0」が設定される。また、横断歩道までの距離についても同様に設定される。 More specifically, for example, in step S24, whether or not the emergency stop position (emergency stop space) can be set is reflected in the analysis list L. For example, in the analysis list L, "1" is set for each point P x when it can be set as an emergency stop position, and "0" is set when it cannot be set. In the example of FIG. 5, when the distance to the intersection is 5 m or more, "1" is set as a position where the emergency stop position can be set, and when the distance to the intersection is less than 5 m, the emergency stop position is set. "0" is set as a position that cannot be set. The distance to the pedestrian crossing is also set in the same way.
ステップS25では、本制御プロセスの実行時における路肩評価が実行される。路肩評価の方法は、特に限定されないが、例えば、路肩評価として、前述の道路情報を基にした静的評価と、動的評価との組み合わせによる評価が実行される。動的評価とは、例えば、運転者の異常が検出された場合に、その時点で情報取得部30から取得された車外環境情報に基づく評価であり、準動的障害物に関する評価(以下、準動体評価という)と、動的障害物に関する評価(以下、動体評価という)とを含む。
In step S25, the road shoulder evaluation at the time of executing this control process is executed. The method of road shoulder evaluation is not particularly limited, but for example, as road shoulder evaluation, evaluation by a combination of static evaluation based on the above-mentioned road information and dynamic evaluation is executed. The dynamic evaluation is, for example, an evaluation based on the external environment information acquired from the
準動体評価では、エンジンがオフ状態の駐車車両のように動作が停止している路上障害物、工事用の柵や看板のように一時的に設置された路上障害物、電柱等の路上障害物に対する評価が実施される。換言すると、準動体評価の評価対象である準動的障害物には、道路情報に反映されていない路上障害物であって、情報取得部30から取得された時点若しくはその前後の時間において静止体であるものが含まれる。準動体評価では、自車両Hの走行経路から路肩領域の間において、前述の法線上に路上障害物がない場合に「1」が設定され、路上障害物がある場合に「0」が設定される。例えば、図4においてCの位置に電柱が立っており、それ以外に路上障害物がないとすると、図5の分析リストL1において点P4に「0」が設定される。尚、停車位置に向かう退避経路が設定されていない場合には、例えば、現在の走行路を直進した場合における走行経路と路肩領域との間において、前述の法線上の路上障害物が評価される。
In the quasi-moving object evaluation, road obstacles that are stopped, such as parked vehicles with the engine off, road obstacles that are temporarily installed, such as construction fences and signboards, and road obstacles such as electric poles. Is evaluated. In other words, the quasi-dynamic obstacle that is the evaluation target of the quasi-moving object evaluation is a road obstacle that is not reflected in the road information, and is a stationary body at the time when it is acquired from the
動体評価では、歩行者や走行している車両、走行路において信号待ち等により一時的に停車している車両のように、「動いている路上障害物もしくは近い将来に動く可能性のある路上障害物(これらを総称して動的障害物という)」に対する評価が実施される。動体評価では、自車両Hの走行経路(準動体評価の場合と同様)から路肩領域の間において、前述の法線上に路上障害物がない場合に「1」が設定され、路上障害物がある場合に「0」が設定される。尚、動体評価では、路上障害物が前方向または後方向に移動する可能性があるので、路上障害物がある点Pに加えて、前後数点の点Pにも「0」が設定される。尚、前後のどの程度の点Pに「0」を設定するかについては、特に限定されず、例えば、固定量にしてもよいし、路上障害物の種別や、情報取得部30からの車外環境情報を基に推定される路上障害物の移動速度に基づいて設定するようにしてもよい。
In the moving object evaluation, "moving road obstacles or road obstacles that may move in the near future" such as pedestrians, running vehicles, and vehicles that are temporarily stopped due to waiting for traffic lights on the road. Evaluations are carried out on "objects (collectively referred to as dynamic obstacles)". In the moving body evaluation, "1" is set when there is no road obstacle on the above-mentioned normal line between the traveling path of the own vehicle H (similar to the case of the quasi-moving body evaluation) and the road shoulder area, and there is a road obstacle. In this case, "0" is set. In the moving object evaluation, since the road obstacle may move in the forward direction or the rear direction, "0" is set at several points P in front and behind in addition to the point P where the road obstacle exists. .. The number of points P in the front and rear to be set to "0" is not particularly limited, and may be, for example, a fixed amount, the type of road obstacle, and the environment outside the vehicle from the
路肩評価では、例えば、静的評価と動的評価をすべて掛け合わせた結果に基づいて評価値を算出する。例えば、「1」と「0」が設定されている項目について、一つでも「0」が設定されていると、その点Pについての評価値は「0」となる。例えば、図4及び図5の例において、点P1は、路肩幅員評価の評価値が「C」であり、その他の評価項目がすべて「1」となっているので、路肩評価の評価値として「C」が設定される。一方で、点P2〜P4については、路肩幅員評価の評価値は「C」であるが、動体評価の評価値が「0」なので、路肩評価の評価値として「0」が設定される。このようにして、すべての点Pxに対して、路肩評価が実行され、評価値として路肩幅員評価値の「A〜C」または「0」が設定される。すべての点Pxについての路肩評価が終わると、上記の分析リストLが、記憶部20に記憶され、図2Bの処理が終了し、制御フローは図2AのステップS30(図2Cの処理)に進む。
In the road shoulder evaluation, for example, the evaluation value is calculated based on the result of multiplying all the static evaluation and the dynamic evaluation. For example, if at least one item "0" is set for an item in which "1" and "0" are set, the evaluation value for that point P becomes "0". For example, in the example of FIG. 4 and FIG. 5, the point P 1 is the evaluation value of the shoulder width evaluation is "C", the other evaluation items are all set to "1", as the evaluation value of the shoulder Rating "C" is set. On the other hand, for the point P 2 to P 4, although the evaluation value of the shoulder width evaluation is "C", since the evaluation value of the moving object evaluation is "0", "0" is set as the evaluation value of the shoulder Rating .. In this way, the road shoulder evaluation is executed for all the points P x , and the road shoulder width evaluation values "A to C" or "0" are set as the evaluation values. When shoulder assessment of all points P x ends, the above analysis list L is stored in the
分析リストLの静的評価は、最初に始点Ps及びPeが設定された場合にのみ評価が実行される。一方で、動的評価は、車両の走行過程において随時または所定期間ごとに更新される。動的評価の更新は、例えば、後述する図2AのステップS19で実行される。 The static evaluation of the analysis list L is performed only when the starting points Ps and Pe are set first. On the other hand, the dynamic evaluation is updated at any time or at predetermined intervals in the traveling process of the vehicle. The update of the dynamic evaluation is executed, for example, in step S19 of FIG. 2A described later.
−停車位置設定工程−
図2Cでは、路肩領域の分析工程S20で生成された分析リストLに基づいて、停車位置の設定工程として、緊急停車位置の探索及び設定が実行される。
-Stop position setting process-
In FIG. 2C, an emergency stop position search and setting is executed as a stop position setting step based on the analysis list L generated in the road shoulder region analysis step S20.
ステップS31では、記憶部20から前述の分析リストLが読みだされ、その分析リストLを用いて車両を緊急停車させることができる領域(以下、停車可能領域という)が抽出される。具体的には、停車可能領域として、例えば、分析リストの評価値がA〜Cの領域のうち、路肩領域の幅員が所定幅員以上であり、かつ、その所定幅員以上の領域が所定距離にわたって連続する領域が設定される。上記の所定幅員として、例えば、評価値がA,Bの領域に限定してもよいし、上記の所定幅員に評価値がA〜Cの領域をすべて含ませるようにしてもよい。
In step S31, the above-mentioned analysis list L is read from the
図4及び図5の例では、停車可能領域として、評価値がA,Bの領域が設定されているものとする。そうすると、図4に示すように、ステップS31では、停車可能領域R11が抽出される。図6及び図7Aの例では、停車可能領域に評価値がA〜Cの領域をすべて含ませるものとしている。そうすると、図6に示すように、ステップS31では、停車可能領域R21〜R25が抽出される。尚、図4及び図6において、RNは交通制約のある制約領域を示している。 In the examples of FIGS. 4 and 5, it is assumed that the areas where the evaluation values are A and B are set as the stoptable areas. Then, as shown in FIG. 4, in step S31, the stoptable area R11 is extracted. In the examples of FIGS. 6 and 7A, it is assumed that the stoptable area includes all the areas having evaluation values A to C. Then, as shown in FIG. 6, in step S31, the stoptable areas R21 to R25 are extracted. In addition, in FIG. 4 and FIG. 6, RN indicates a restricted area with traffic restrictions.
ステップS32では、自車両Hの現在位置(現在位置が始点Psより手前の場合は始点Ps)から終点Peの間に、停車可能領域があるか否かが判定される。図4の例では、停車可能領域R11が抽出されているので、ステップS32はYES判定となり、制御フローは次のステップS33に進む。図6の例についても、停車可能領域R21〜R25が抽出されているので図4と同様に、制御フローは次のステップS33に進む。 In step S32, it is determined whether or not there is a stoptable area between the current position of the own vehicle H (when the current position is before the start point Ps, the start point Ps) and the end point Pe. In the example of FIG. 4, since the stoptable area R11 is extracted, the determination in step S32 is YES, and the control flow proceeds to the next step S33. In the example of FIG. 6, since the stoptable areas R21 to R25 are extracted, the control flow proceeds to the next step S33 as in FIG.
ステップS33では、停車可能領域が複数あるか否かが判定される。図4の例のように、停車可能領域が1つしかない場合、その停車可能領域R11内に緊急停車位置に設定され(ステップS36)、緊急停車位置の設定処理は終了となる。一方で、図6の例のように、停車可能領域が複数ある場合には、制御フローは次のステップS35に進む。 In step S33, it is determined whether or not there are a plurality of stoptable areas. As in the example of FIG. 4, when there is only one stoptable area, the emergency stop position is set in the stoptable area R11 (step S36), and the emergency stop position setting process ends. On the other hand, when there are a plurality of stoptable areas as in the example of FIG. 6, the control flow proceeds to the next step S35.
ステップS35では、優先度に基づいて緊急停車位置の設定が可能か否かが判定される。図6の例では、路肩領域の幅員が広い順に評価値がA,B,Cと設定されているので、優先度は、評価値がA,B,Cの順に高い。そうすると、図6の例では、図7Aに示すように、評価値Aの停車可能領域がR22,R24の2つあるので、ステップS35においてNO判定となり、制御フローはステップS38に進む。ステップS38では、同じ優先度(評価値A)の中で、本制御プロセスの実行時点において停車が可能であり、かつ、最も近い領域である停車可能領域R22内に緊急停車位置が設定される。緊急停車位置の設定が終わると、図2Cの設定処理、すなわち、図2AのステップS30の処理は終了となる。 In step S35, it is determined whether or not the emergency stop position can be set based on the priority. In the example of FIG. 6, since the evaluation values are set as A, B, and C in the order of the width of the road shoulder region, the priority is higher in the order of the evaluation values A, B, and C. Then, in the example of FIG. 6, as shown in FIG. 7A, since there are two stoptable areas of the evaluation value A, R22 and R24, a NO determination is made in step S35, and the control flow proceeds to step S38. In step S38, within the same priority (evaluation value A), an emergency stop position is set in the stoptable area R22, which is the closest area where the vehicle can be stopped at the time of execution of the control process. When the setting of the emergency stop position is completed, the setting process of FIG. 2C, that is, the process of step S30 of FIG. 2A is completed.
一方、ステップS35でYES判定となった場合、すなわち、優先度に基づく緊急停車位置の設定が可能な場合には、停車が可能な停車可能領域のうち、最も優先度の高い領域内に緊急停車位置が設定される。 On the other hand, if a YES determination is made in step S35, that is, if the emergency stop position can be set based on the priority, the emergency stop is within the highest priority area among the stoptable areas where the vehicle can be stopped. The position is set.
尚、停車可能領域が自車両Hの長さよりも十分に長い場合に、停車可能領域の中でどこを緊急停車位置に設定するかは特に限定されない。例えば、その停車可能領域のうちの手前側の位置が緊急停車位置に設定される。緊急停車位置の設定が終わると、図2Cの設定処理、すなわち、図2AのステップS30の処理は終了となる。 When the stoptable area is sufficiently longer than the length of the own vehicle H, there is no particular limitation on which part of the stopable area is set as the emergency stop position. For example, the position on the front side of the stoptable area is set as the emergency stop position. When the setting of the emergency stop position is completed, the setting process of FIG. 2C, that is, the process of step S30 of FIG. 2A is completed.
以下の説明において、説明の便宜上、上記の停車位置決定部131による緊急停車位置を設定する工程を「停車位置設定工程」と呼ぶものとする。
In the following description, for convenience of explanation, the step of setting the emergency stop position by the above-mentioned stop
《停車経路生成部》
停車経路生成部132では、停車位置決定部131によって設定された緊急停車位置までの退避経路を生成する。具体的には、停車経路生成部132は、経路生成部116による経路生成と同様の処理を実行する。具体的には、停車経路生成部132は、車外環境認識部111の出力に基づいて複数の候補経路を生成する。また、停車経路生成部132は、複数の走行経路の各々に付与された経路コストに基づいて、複数の走行経路の中から安全でかつ最短で緊急停車位置に向かう走行経路を緊急停車位置に向かう退避経路(以下、単に退避経路という)として選択する。尚、停車経路生成部132は、より安全性を担保するために、ルールベース制御部120と同様の処理に基づいて、退避経路を生成するようにしてもよい。停車経路生成部132は、選択した退避経路を車両運動決定部118に送信する。
《Stop route generator》
The stop
《リスク算出部》
リスク算出部133は、情報取得部30で取得された車外環境情報に基づいて、後述する退避経路生成工程、減速工程、レーンチェンジ工程、第1走行レーン走行工程、停車工程において、自車両Hが路上障害物に衝突する衝突リスクを算出する。リスク算出部133にて考慮される路上障害物は、動体(例えば、自動四輪車、自動二輪車、自転車、歩行者など)と、静止体(工事などで一時的に設置された設置物、駐車車両など)の両方が含まれる。リスク算出部133で算出された衝突リスクは、停車位置決定部に送信される。ここで、同一方向に向かう走行路のうち、路肩領域Rに隣接する走行レーンを第1走行レーンと呼ぶ。また、第1走行レーンに隣接し、かつ、第1走行レーンよりも路肩領域Rから離れた走行レーンがある場合に、その走行レーンを第2走行レーンと呼ぶ。また、第2走行レーンに隣接し、かつ、第2走行レーンよりも路肩領域Rから離れた走行レーンがある場合に、その走行レーンを第3走行レーンと呼ぶ。すなわち、走行路は、路肩領域側から、第1走行レーン、第2走行レーン、第3走行レーンの順に並んだ走行レーンを有する。尚、走行レーンは、第1走行レーンの1つであってもよいし、同一方向の走行レーンが4レーン以上あってもよい。
《Risk calculation department》
The
〔退避走行制御〕
次に、図2及び図3を参照して退避走行制御について説明する。
[Evacuation running control]
Next, the evacuation running control will be described with reference to FIGS. 2 and 3.
まず、退避走行制御について、概要を説明すると、退避走行制御では、前述の停車位置設定工程に加えて、退避経路生成工程、減速工程、レーンチェンジ工程、第1走行レーン走行工程及び停車工程が実行される。退避経路生成工程は、停車位置設定工程で設定された緊急停車位置までの退避経路を生成する工程である。減速工程は、自車両Hの車速を所定速度以下に減速させる工程である。レーンチェンジ工程は、複数の走行レーン(同一方向)がある場合において、自車両Hが第1走行レーン以外を走行しているときに、情報取得部30で取得された車外環境情報に基づいて、第1走行レーンに向かって車両をレーンチェンジさせる工程である。第1走行レーン走行工程は、第1走行レーンにおいて自車両Hを所定速度以下で走行させる工程である。停車工程は、第1走行レーンから停車可能領域に車両を進入させて、緊急停車位置に自車両Hを停車させる工程である。
First, the outline of the evacuation travel control will be explained. In the evacuation travel control, in addition to the above-mentioned stop position setting process, the evacuation route generation process, the deceleration process, the lane change process, the first travel lane travel process, and the stop process are executed. Will be done. The evacuation route generation step is a step of generating an evacuation route to the emergency stop position set in the stop position setting step. The deceleration step is a step of decelerating the vehicle speed of the own vehicle H to a predetermined speed or less. In the lane change process, when there are a plurality of traveling lanes (in the same direction) and the own vehicle H is traveling in a lane other than the first traveling lane, the lane change process is based on the outside environment information acquired by the
退避走行制御では、自車両Hが緊急停車位置に停車するまでの間、図2及び図3のフローが繰り返し実行される。尚、上記の《停車位置決定部》において、図2AのステップS30までの動作について説明したので、ここでは、その後の動作について説明する。 In the evacuation travel control, the flows of FIGS. 2 and 3 are repeatedly executed until the own vehicle H stops at the emergency stop position. Since the operation up to step S30 in FIG. 2A has been described in the above-mentioned << Stop position determination unit >>, the subsequent operation will be described here.
《退避走行制御(1)》
以下の説明では、自車両Hが、図6の走行シーンを走行している際に、運転者異常が検出されたものとして説明する。すなわち、図3Aの制御フローの開始時点において、図6に示す位置に始点Ps、終点Peが設定され、図7Aの分析リストL2が作成されているものとする。また、停車可能領域としてR21〜R25(図6参照)が抽出され、緊急停車位置が停車可能領域R22内に設定された状態であるものとする。
<< Evacuation running control (1) >>
In the following description, it is assumed that the driver abnormality is detected while the own vehicle H is traveling in the driving scene of FIG. That is, it is assumed that the start point Ps and the end point Pe are set at the positions shown in FIG. 6 at the start time of the control flow of FIG. 3A, and the analysis list L2 of FIG. 7A is created. Further, it is assumed that R21 to R25 (see FIG. 6) are extracted as the stoptable area and the emergency stop position is set in the stoptable area R22.
図2Aにおいて、ステップS30の処理、すなわち、停車位置決定部131による停車位置設定工程が終了すると、制御フローは図3AのステップS41に進む。
In FIG. 2A, when the process of step S30, that is, the stop position setting step by the stop
ステップS41において、緊急停車制御部130では、停車位置の設定があるか否かが確認される。停車位置の設定には、新規に緊急停車位置が設定された場合と、詳細は後述するが、緊急停車位置に向かって走行している途中で緊急停車位置が変更(再設定)された場合とが含まれる。図2のステップS30において緊急停車位置が設定されているので、ステップS41はYES判定となり、制御フローはステップS42に進む。
In step S41, the emergency
−退避経路生成工程−
ステップS42では、停車位置決定部131によって設定された緊急停車位置までの退避経路が生成される。具体的に、退避経路生成工程では、停車経路生成部132が、停車位置決定部131によって設定された緊急停車位置までの退避経路を生成する。退避経路を生成については、上記の《停車経路生成部》で説明したので、ここではその説明を省略する。
-Evacuation route generation process-
In step S42, an evacuation route to the emergency stop position set by the stop
次のステップS43において、緊急停車制御部130は、自車両Hがあらかじめ設定された所定の速度まで減速しているかを確認する。前述のとおり、車両挙動推定部113は、車両状態センサ34(例えば、車速センサ)の出力を基に車速を推定する。そこで、緊急停車制御部130は、例えば、車両挙動推定部113で推定された自車両Hの車速情報を基に、自車両Hが所定の速度(例えば、10km/h)まで減速されているかを確認する。
In the next step S43, the emergency
例えば、所定速度まで減速できていない場合、ステップS43はNO判定となり、制御フローはステップS60の「減速工程」に進む。図6の例では、自車両HがH1とH2の間を走行している場合が相当する。 For example, if the speed has not been reduced to a predetermined speed, the determination in step S43 is NO, and the control flow proceeds to the "deceleration step" in step S60. In the example of FIG. 6, it corresponds to the case where the own vehicle H is traveling between H1 and H2.
−減速工程−
図3Bは、減速工程についての処理動作を示すフローチャートである。
-Deceleration process-
FIG. 3B is a flowchart showing a processing operation for the deceleration process.
減速工程では、まず、ステップS61において、報知装置Dを用いて自車両Hを緊急停車させることが報知される。報知装置Dは、ハザードランプのように光によって視覚的に緊急停車を報知する光報知装置と、ホーンやスピーカーのように音や音声によって緊急停車を報知する音報知装置とを含む。具体的には、例えば、緊急停車制御部130は、ホーンで音を発しながら、ハザードランプを点滅させて、周囲の他車両J等に、自車両Hが緊急停車動作(減速動作)に入ることを報知する。尚、ステップS61において、光報知装置と音報知装置のいずれか一方を用いて自車両Hを緊急停車させることを報知するようにしてもよい。
In the deceleration step, first, in step S61, it is notified that the own vehicle H is urgently stopped by using the notification device D. The notification device D includes an optical notification device such as a hazard lamp that visually notifies an emergency stop by light, and a sound notification device such as a horn or a speaker that notifies an emergency stop by sound or voice. Specifically, for example, the emergency
また、ステップS61の処理と並行して、ステップS62において、リスク算出部133は、情報取得部で取得された車外環境情報に基づいて、減速工程を実行すること及びその後の工程における衝突リスクを算出する。例えば、リスク算出部133は、カメラ31やレーダ32の出力に基づいて、自車両の後方や斜め後方を走行する他車両Jの位置や速度の情報を把握し、自車両が減速した場合に、他車両Jが自車両Hに衝突するリスクを算出する。
Further, in parallel with the process of step S61, in step S62, the
次のステップS63において、緊急停車制御部130は、リスク算出部133で算出された衝突リスクが所定以上かどうかを判断する。衝突リスクの評価方法は、特に限定されないが、例えば、(1)他車両Jの位置に応じた位置スコアと速度に応じた速度スコアを設定し、その積算値が所定の衝突スコア以上になっているか否かで衝突リスクを判断してもよいし、(2)緊急停車制御部130内で車両モデル等を用いて走行シミュレーションを行うことにより衝突リスクを判断するようにしてもよい。
In the next step S63, the emergency
例えば、図6に示すように、周囲に他車両Jが走行していない場合、衝突リスクは所定未満となり(ステップS62でNO判定)、緊急停車制御部130は、減速制御を開始する(ステップS64)。具体的な減速制御の方法は、特に限定されないが、例えば、緊急停車制御部130は、車両運動決定部118に対して、所定の速度に向かって減速をするように指示する減速指示信号を送信する。車両運動決定部118では、減速制御信号を受信すると、アクチュエータ制御部119を介して各アクチュエータを制御し、自車両Hを減速させる。そして、所定時間以内に減速処理が終わった場合には、次のステップS65でYES判定となり、緊急停車制御部130は、減速工程を終了する。図6の例では、自車両HがH2の位置で減速工程が終わり、自車両Hの車速が所定速度以下になったものとする。減速工程が終了すると、制御フローは、図3AのステップS44に進む。
For example, as shown in FIG. 6, when another vehicle J is not traveling around, the collision risk becomes less than a predetermined value (NO determination in step S62), and the emergency
尚、図示は省略するが、ステップS63において、緊急停車制御部130が減速制御を開始した後においても、リスク算出部133によるリスク算出を繰り返し実施し、所定以上の衝突リスクがある場合に、割り込み処理により減速制御を一時停止してステップS63に戻り、YES判定(ステップS68)に進むようにしてもよい。ステップS68の制御については、後ほど説明する。
Although not shown, in step S63, even after the emergency
図3Aに戻り、ステップS44において、緊急停車制御部130は、車両が第1走行レーンを走行しているか否かを確認する。緊急停車制御部130は、例えば、位置センサ33で検出された車両の位置情報や、カメラ31で撮像された車外環撮の画像データに基づいて、自車両の走行レーンを確認する。図6のH2の位置を自車両Hが走行している場合、ステップステップS44でNO判定となり、次のステップS45に進む。ステップS45では、レーンチェンジ動作が終わっているかどうかが確認されるので、こちらでもNO判定となり、制御フローは次のステップS70の「レーンチェンジ工程」にすすむ。
Returning to FIG. 3A, in step S44, the emergency
−レーンチェンジ工程−
図3Cは、レーンチェンジ(レーンチェンジともいう)工程の処理動作を示すフローチャートである。
-Lane change process-
FIG. 3C is a flowchart showing a processing operation of a lane change (also referred to as a lane change) process.
まず、ステップS71において、リスク算出部133は、情報取得部で取得された車外環境情報に基づいて、レーンチェンジ工程を実行すること及びその後の工程における衝突リスクを算出する。例えば、リスク算出部133は、カメラ31やレーダ32の出力に基づいて、自車両の前方、路肩側の斜め前方、路肩側の斜め後方及び後方における路上障害物(例えば、他車両J)の位置や速度の情報を把握し、自車両が路肩領域側の走行レーンにレーンチェンジした場合に、他車両Jと衝突するリスクを算出する。
First, in step S71, the
次のステップS72において、緊急停車制御部130は、リスク算出部133で算出された衝突リスクが所定以上かどうかを判断する。衝突リスクの評価方法は、特に限定されないが、例えば、前述の「減速工程」と同様の方法が適用できる。
In the next step S72, the emergency
例えば、図6に示すように、周囲に他車両Jが走行していない場合、衝突リスクは所定未満となり(ステップS72でNO判定)、緊急停車制御部130は、レーンチェンジ制御を開始する(ステップS73)。具体的なレーンチェンジ制御の方法は、特に限定されないが、例えば、緊急停車制御部130は、ハザードランプの点滅をやめさせて、路肩領域側の方向指示器(図示省略)を点滅させるとともに、車両運動決定部118に対して路肩領域側の走行レーンに向かってレーンチェンジをするように指示するレーンチェンジ指示信号を送信する。車両運動決定部118では、レーンチェンジ指示信号を受信すると、アクチュエータ制御部119を介して各アクチュエータを制御し、自車両Hをレーンチェンジさせる。図6の例では、自車両Hが位置H4でレーンチェンジ工程が終わり、自車両Hは、所定速度以下の車速で第1走行レーンの走行を開始したものとする。レーンチェンジ工程が終了すると、制御フローは、図3AのステップS80に進む。
For example, as shown in FIG. 6, when another vehicle J is not traveling around, the collision risk becomes less than a predetermined value (NO determination in step S72), and the emergency
−第1走行レーン走行工程、停車工程−
図3Dは、第1走行レーン走行工程及び停車工程の処理動作を示すフローチャートである。
-First driving lane driving process, stopping process-
FIG. 3D is a flowchart showing the processing operations of the first traveling lane traveling process and the stopping process.
まず、ステップS81及びステップS82では、緊急停車制御部130は、カメラ31により停車可能領域R22が認識されるまでの間、例えば、ハザードランプを点滅させながら、第1走行レーンにおいて自車両Hを所定速度(例えば、10km/h)以下で走行させる。
First, in steps S81 and S82, the emergency
そして、情報取得部30(例えば、カメラ31やレーダ32)により停車可能領域R22(緊急停車位置)が認識されると、ステップS81でYES判定となり、制御フローはステップS84に進む。
Then, when the information acquisition unit 30 (for example, the
ステップS84において、リスク算出部133は、情報取得部30(例えば、カメラ31やレーダ32)で認識された停車可能領域R22(緊急停車位置)の衝突リスクを算出する。例えば、リスク算出部133は、カメラ31やレーダ32の出力に基づいて、停車可能領域R22(緊急停車位置)の路上障害物(例えば、停車した他車両J)の有無を確認することで、路上障害物に衝突するリスクを算出する。
In step S84, the
ステップS85において、緊急停車制御部130は、カメラ31やレーダ32の出力に基づいて、停車可能領域R22がフリースペースか否か、換言すると、停車可能領域R22に進入した場合に路上障害物に衝突するリスクがあるかどうかを確認する。図6の例では、自車両Hが位置H5まで走行したときに、停車可能領域R22がフリースペースであることが認識できたものとする。そうすると、ステップS85でNO判定となり、緊急停車制御部130は、第1走行レーン走行工程として、停車可能領域R22の手前まで自車両Hを走行させる(ステップS86)。尚、図示は省略するが、第1走行レーン走行工程においても、前述の「減速工程」や「レーンチェンジ工程」と同様に、情報取得部で取得された車外環境情報に基づいて、第1走行レーン走行工程を実行すること及びその後の停車工程における衝突リスクを算出するようにしてもよい。そして、緊急停車制御部130は、衝突リスクが所定以上と判断した場合に、その場に停車させるなどの状況に応じた制御を実行するようにしてもよい。
In step S85, the emergency
次のステップS91において、リスク算出部133は、情報取得部で取得された車外環境情報に基づいて、第1走行レーン走行工程及び/または停車工程における衝突リスクを算出する。例えば、リスク算出部133は、カメラ31やレーダ32の出力に基づいて、自車両の前方、路肩側の斜め前方、路肩側の斜め後方及び後方における路上障害物(例えば、自転車や歩行者等)の位置や速度の情報を把握し、自車両が第1走行レーン走行したり、停車可能領域R22に進入する際に、路上障害物に衝突するリスクを算出する。
In the next step S91, the
次のステップS92において、緊急停車制御部130は、リスク算出部133で算出された衝突リスクが所定以上かどうかを判断する。衝突リスクの評価方法は、特に限定されないが、例えば、前述の「減速工程」と同様の方法が適用できる。
In the next step S92, the emergency
例えば、図6に示すように、周囲に路上障害物がなく、停車可能領域R22がフリースペースの場合、衝突リスクは所定未満となり(ステップS92でNO)、緊急停車制御部130は、停車可能領域R22への進入及び緊急停車位置への停車制御を開始する(ステップS93)。具体的な停車制御の方法は、特に限定されないが、例えば、緊急停車制御部130は、ハザードランプの点滅をやめさせて、路肩領域側の方向指示器(図示省略)を点滅させるとともに、車両運動決定部118に対して停車可能領域R22に進入して停車するように指示する停車指示信号を送信する。車両運動決定部118では、停車指示信号を受信すると、アクチュエータ制御部119を介して各アクチュエータを制御し、自車両Hを停車可能領域R22に進入させ、緊急停車位置に停車させる。自車両Hの緊急停車位置への停車が終わると退避走行制御は終了となる。
For example, as shown in FIG. 6, when there are no road obstacles in the vicinity and the stoptable area R22 is a free space, the collision risk is less than a predetermined value (NO in step S92), and the emergency
《退避走行制御(2)》
以下の説明では、自車両Hが、図8の走行シーンを走行している際に、運転者異常が検出されたものとして説明する。なお、前述の《退避走行制御(1)》の場合と同様に、図3Aの制御フローの開始時点において、図8に示す位置に始点Ps、終点Peが設定され、図7Aの分析リストL2が作成されているものとする。また、自車両HがH1の位置を走行しているときには、停車可能領域R22に停車している他車両Jaは認識できておらず、自車両HがH5の位置に来たときに初めて他車両Jaが認識できたものとする。
<< Evacuation running control (2) >>
In the following description, it is assumed that the driver abnormality is detected while the own vehicle H is traveling in the driving scene of FIG. As in the case of << evacuation running control (1) >> described above, the start point Ps and the end point Pe are set at the positions shown in FIG. 8 at the start time of the control flow of FIG. 3A, and the analysis list L2 of FIG. 7A It is assumed that it has been created. Further, when the own vehicle H is traveling at the position of H1, the other vehicle Ja stopped in the stoptable area R22 cannot be recognized, and the other vehicle is not recognized until the own vehicle H comes to the position of H5. It is assumed that Ja can recognize it.
ここでは、前述の《退避走行制御(1)》との相違点を中心に説明するものとし、《退避走行制御(1)》と共通の動作について説明を省略する場合がある。例えば、自車両HがH5の位置に到達するまでの動作、すなわち、図3AのステップS80の手前までの動作は前述の《退避走行制御(1)》と共通である。そこで、ここでは自車両HがH5の位置まで走行し、図3Dの制御プロセスが開始されたところからの動作について説明する。 Here, the differences from the above-mentioned << retracted travel control (1) >> will be mainly described, and the description of the operation common to the << retracted travel control (1) >> may be omitted. For example, the operation until the own vehicle H reaches the position of H5, that is, the operation before step S80 in FIG. 3A is the same as the above-mentioned << evacuation running control (1) >>. Therefore, here, the operation from the point where the own vehicle H travels to the position of H5 and the control process of FIG. 3D is started will be described.
−第1走行レーン走行工程、停車工程−
図8の例では、停車可能領域R22が認識されたときに(ステップS81でYES)、停車可能領域R22に他車両Jaが停車しているので、ステップS85でYES判定となる。すなわち、緊急停車制御部130は、停車可能領域R22に進入すると、他車両Jaとの衝突リスクが所定以上であると判断し、第1走行レーン走行工程を途中で取りやめて、停車位置の再設定を実行する。具体的には、緊急停車制御部130は、図3Dの制御プロセスを中断し、制御フローが図2AのステップS13に戻される。
-First driving lane driving process, stopping process-
In the example of FIG. 8, when the stoptable area R22 is recognized (YES in step S81), another vehicle Ja is stopped in the stoptable area R22, so that a YES determination is made in step S85. That is, when the emergency
−停車位置設定工程−
図2Aにおいて、自車両Hが位置H5(図8参照)を走行しているので、ステップS13はYES判定、ステップS15はNO判定となる。また、緊急停車位置は、最初のフローで実行済みのため、ステップS16はYES判定となり、制御フローはステップS26に進む。
-Stop position setting process-
In FIG. 2A, since the own vehicle H is traveling at the position H5 (see FIG. 8), the determination in step S13 is YES and the determination in step S15 is NO. Further, since the emergency stop position has already been executed in the first flow, the determination in step S16 is YES, and the control flow proceeds to step S26.
ステップS26では、現在の自車両Hの位置よりも先にある点Pxにおける分析リストLの動的評価に係る評価値(準動的障害物及び動的障害物の項目)と路肩領域の総合的な評価値(図7Aの右端の欄)が更新される。図7Bには、更新された分析リストL2を示している。図7Bでは、領域R22に対する準動的障害物の評価結果として「0」が設定される。その結果、領域R22における路肩評価の評価値として「0」が設定される。尚、停車可能領域R23〜R25、制約領域RNの評価値は変わらなかったものとする。 At step S26, overall current road shoulder area (the item of quasi moving obstacle and moving obstacle) evaluation value according to the dynamic evaluation of the analysis list L in P x point which is earlier than the position of the vehicle H Evaluation value (rightmost column in FIG. 7A) is updated. FIG. 7B shows the updated analysis list L2. In FIG. 7B, “0” is set as the evaluation result of the quasi-dynamic obstacle with respect to the region R22. As a result, "0" is set as the evaluation value of the road shoulder evaluation in the region R22. It is assumed that the evaluation values of the stoptable areas R23 to R25 and the constraint area RN have not changed.
このように、分析リストLの静的評価は、最初に始点Ps及びPeが設定された場合にのみ実行し、工程を途中で取りやめた際には、動的評価に係る評価値のみを更新するようにしている。これにより、走行過程で工程を取りやめた場合における演算時間を大幅に短縮することができる。 In this way, the static evaluation of the analysis list L is executed only when the starting points Ps and Pe are set first, and when the process is canceled in the middle, only the evaluation value related to the dynamic evaluation is updated. I am trying to do it. As a result, the calculation time when the process is canceled in the traveling process can be significantly shortened.
ステップS26での分析リストの更新が終わると、次のステップS30(図2C参照)では、緊急停車位置の探索及び設定が実行される。尚、各制御プロセスの処理は、これまでの説明と同じなので、以下の説明では、処理結果を中心に説明する。 When the update of the analysis list in step S26 is completed, in the next step S30 (see FIG. 2C), the search and setting of the emergency stop position are executed. Since the processing of each control process is the same as the description so far, the processing results will be mainly described in the following description.
図2CのステップS31では、停車可能領域としてR23〜R25が抽出される。上記のとおり、領域R22は、路肩評価の評価値として「0」が設定されているので、停車可能領域として抽出されない。 In step S31 of FIG. 2C, R23 to R25 are extracted as a stoptable area. As described above, the area R22 is not extracted as a stoptable area because "0" is set as the evaluation value of the road shoulder evaluation.
ステップS32及びステップS33は、停車可能領域R23〜R25が抽出されているのでYES判定となる。 In step S32 and step S33, since the stoptable areas R23 to R25 are extracted, a YES determination is made.
ステップS35において、ここでは図7Bに示すように、優先度Aの停車可能領域がR24の1つなので、優先度に基づく緊急停車位置の設定が可能である。したがって、ステップS35でYES判定となり、次の緊急停車位置が停車可能領域R24内に設定される。図2Cの設定処理が終了すると、図2AのステップS30の処理は終了となり、制御フローは図3Aに進む。 In step S35, as shown in FIG. 7B, since the stoptable area of priority A is one of R24, the emergency stop position can be set based on the priority. Therefore, a YES determination is made in step S35, and the next emergency stop position is set in the stoptable area R24. When the setting process of FIG. 2C is completed, the process of step S30 of FIG. 2A is completed, and the control flow proceeds to FIG. 3A.
図2のステップS30において緊急停車位置が設定されているので、図3AステップS41はYES判定となり、制御フローはステップS42の退避経路生成工程に進む。 Since the emergency stop position is set in step S30 of FIG. 2, the determination in FIG. 3A step S41 is YES, and the control flow proceeds to the evacuation route generation step of step S42.
−退避経路生成工程−
ステップS42では、停車経路生成部132により、停車可能領域R24内に設定された緊急停車位置までの退避経路が生成される。
-Evacuation route generation process-
In step S42, the stop
−減速工程−
自車両Hは、すでに所定速度以下まで減速されているので、ステップS43でYES判定となり、ここでは、減速工程は実行されず、制御フローは次のステップS44に進む。
-Deceleration process-
Since the own vehicle H has already been decelerated to a predetermined speed or less, a YES determination is made in step S43, where the deceleration step is not executed and the control flow proceeds to the next step S44.
−レーンチェンジ工程−
自車両Hは、すでに第1走行レーンを走行しているので、ステップS44でYES判定となり、ここでは、レーンチェンジ工程は実行されず、制御フローは次のステップS80に進む。
-Lane change process-
Since the own vehicle H has already traveled in the first traveling lane, a YES determination is made in step S44, where the lane change process is not executed and the control flow proceeds to the next step S80.
−第1走行レーン走行工程、停車工程−
ステップS81及びステップS82では、緊急停車制御部130は、カメラ31により停車可能領域R24が認識されるまでの間、例えば、ハザードランプを点滅させながら、第1走行レーンにおいて自車両Hを所定速度(例えば、10km/h)以下で走行させる。
-First driving lane driving process, stopping process-
In steps S81 and S82, the emergency
そして、情報取得部30(例えば、カメラ31やレーダ32)により停車可能領域R22(緊急停車位置)が認識されると、ステップS81でYES判定となり、制御フローはステップS84に進む。
Then, when the information acquisition unit 30 (for example, the
この時点で、自車両は位置H8を走行しているものとする。また、図8の例では、自車両Hが位置H8まで走行したときに、停車可能領域R24がフリースペースであることが認識できたものとする。 At this point, it is assumed that the own vehicle is traveling at position H8. Further, in the example of FIG. 8, it is assumed that when the own vehicle H travels to the position H8, it can be recognized that the stoptable area R24 is a free space.
そうすると、ステップS84において、ステップS85でNO判定となり、緊急停車制御部130は、第1走行レーン走行工程として、停車可能領域R24の手前まで自車両Hを走行させる(ステップS86)。
Then, in step S84, a NO determination is made in step S85, and the emergency
そして、ステップS91ではリスク算出部133により衝突リスクが算出され、ステップS92では緊急停車制御部130により衝突リスクが所定以上かどうかが判断される。
Then, in step S91, the
図8の例では、停車可能領域R24がフリースペースなので、ステップS92でNO判定となる。そうすると、緊急停車制御部130が、停車可能領域R24への進入及び緊急停車位置への停車制御を開始し、自車両Hの緊急停車位置への停車が終わると退避走行制御は終了となる。
In the example of FIG. 8, since the stoptable area R24 is a free space, a NO determination is made in step S92. Then, the emergency
《退避走行制御(3)》
以下の説明では、自車両Hが、図9の走行シーンを走行している際に、運転者異常が検出されたものとして説明する。なお、前述の《退避走行制御(2)》の場合と同様に、図3Aの制御フローの開始時点において、図9に示す位置に始点Ps、終点Peが設定され、図7Aの分析リストL2が作成されているものとする。
<< Evacuation running control (3) >>
In the following description, it is assumed that the driver abnormality is detected while the own vehicle H is traveling in the driving scene of FIG. As in the case of << evacuation running control (2) >> described above, the start point Ps and the end point Pe are set at the positions shown in FIG. 9 at the start time of the control flow of FIG. 3A, and the analysis list L2 of FIG. 7A is displayed. It is assumed that it has been created.
ここでは、前述の《退避走行制御(2)》との相違点を中心に説明するものとし、《退避走行制御(2)》と共通の動作について説明を省略する場合がある。尚、図9において、自車両Hの位置H1は、図6の位置H2と対応している。すなわち、ここでは、図3AのステップS60の減速工程まで終了しており、図3AのステップS44からの動作について説明する。尚、図9に示すように、位置H2の時点で、自車両は第3走行レーンを走行しており、第2車線レーンにおいて後方から自車両Hよりも速い他車両Jが接近しているものとする。 Here, the differences from the above-mentioned << retracted travel control (2) >> will be mainly described, and the description of the operation common to the << retracted travel control (2) >> may be omitted. In FIG. 9, the position H1 of the own vehicle H corresponds to the position H2 in FIG. That is, here, the deceleration step of step S60 of FIG. 3A has been completed, and the operation from step S44 of FIG. 3A will be described. As shown in FIG. 9, at the time of position H2, the own vehicle is traveling in the third traveling lane, and another vehicle J, which is faster than the own vehicle H, is approaching from behind in the second lane. And.
図3AのステップS44において、自車両H(位置H2)は、第3レーンを走行しているので、ステップS44ではNO判定となり、制御フローはステップS70のレーンチェンジ工程に進む。 In step S44 of FIG. 3A, since the own vehicle H (position H2) is traveling in the third lane, a NO determination is made in step S44, and the control flow proceeds to the lane change step of step S70.
−レーンチェンジ工程−
ステップS71では、リスク算出部133により、位置H1において情報取得部で取得された車外環境情報に基づいて、他車両Jと衝突するリスクが算出される。ここでは、他車両Jが自車両よりも早い速度で近づいており、他車両Jとの衝突リスク(衝突スコア)が所定以上になっているという算出結果が出たものとする。そうすると、次のステップS72でYES判定となり、制御フローはステップS76に進む。
-Lane change process-
In step S71, the
ステップS76では、レーンチェンジをせずに、それまで走行していた走行レーンでの走行が継続され、制御フローは、次のステップS77に進む。 In step S76, the traveling in the traveling lane that has been traveling up to that point is continued without changing the lane, and the control flow proceeds to the next step S77.
ステップS77では、自車両Hが再探索基準位置を通過したかどうかが確認される。再探索基準位置とは、緊急停車位置に停車させる場合に、各工程を走行レーンのどの位置までに終わらせておく必要があるかに基づいて設定された位置である。再探索基準位置の設定方法は、特に限定されないが、例えば、(1)自車両の位置と車速とに基づくテーブルを用意し、そのテーブルに基づいて設定する、(2)内部で車両モデル等を用いた演算を行う、といった方法が適用できる。図9及び図10Aの例では、停車可能領域R22に対する再探索基準位置として自車両Hが薄いドットハッチングの領域を超えた場合に再探索するように設定されているものとする。同様に、停車可能領域R24に対する再探索基準位置として自車両Hが濃いドットハッチングの領域を超えた場合に再探索するように設定されているものとする。そうすると、ステップS77でNO判定となり、制御フローはステップS71に戻る。その後、自車両Hが位置H2、他車両Jが位置J2まで走行したものとする。 In step S77, it is confirmed whether or not the own vehicle H has passed the re-search reference position. The re-search reference position is a position set based on the position in the traveling lane where each process needs to be completed when the vehicle is stopped at the emergency stop position. The method of setting the re-search reference position is not particularly limited, but for example, (1) prepare a table based on the position and vehicle speed of the own vehicle, and set based on the table, (2) internally set the vehicle model and the like. A method such as performing the calculation used can be applied. In the examples of FIGS. 9 and 10A, it is assumed that the re-search reference position for the stoptable area R22 is set so as to re-search when the own vehicle H exceeds the thin dot hatching area. Similarly, it is assumed that the own vehicle H is set to search again when the own vehicle H exceeds the dark dot hatching area as the re-search reference position with respect to the stoptable area R24. Then, a NO determination is made in step S77, and the control flow returns to step S71. After that, it is assumed that the own vehicle H has traveled to the position H2 and the other vehicle J has traveled to the position J2.
ステップS71では、リスク算出部133により、位置H2において情報取得部で取得された車外環境情報に基づいて、他車両Jと衝突するリスクが算出される。図9に示すように、位置H2においても他車両J(位置J2)との衝突リスク(衝突スコア)が所定以上になっているという算出結果が出たものとする。そうすると、制御フローは、ステップS72でYES判定となる。そして、ステップS74のときに、自車両Hが位置H3、他車両Jが位置J3まで走行したものとする。すなわち、自車両Hが、薄いドットハッチングの領域を超えて、その先の濃いドットハッチングの領域に進入したとする。
In step S71, the
そうすると、ステップS77でYES判定となり、レーンチェンジ工程を途中で取りやめて、停車位置の再設定を実行する。具体的には、緊急停車制御部130は、図3Cの制御プロセスを中断し、制御フローが図2AのステップS13に戻される。
Then, a YES determination is made in step S77, the lane change process is canceled in the middle, and the stop position is reset. Specifically, the emergency
−停車位置設定工程−
図2Aにおいて、自車両Hが位置H3(図9参照)を走行しているので、ステップS13はYES判定、ステップS15はNO判定となる。また、緊急停車位置は、最初のフローで実行済みのため、ステップS16はYES判定となり、制御フローはステップS26に進む。
-Stop position setting process-
In FIG. 2A, since the own vehicle H is traveling at the position H3 (see FIG. 9), the determination in step S13 is YES and the determination in step S15 is NO. Further, since the emergency stop position has already been executed in the first flow, the determination in step S16 is YES, and the control flow proceeds to step S26.
ステップS26では、現在の自車両Hの位置よりも先にある点Pxにおける分析リストLの動的評価に係る評価値が更新される。図7Cには、更新された分析リストL2を示している。図7Cでは、停車可能領域R22が、自車両よりも先にあるが、評価の対象外(「−」を記入)となっており、それ以外の評価は図7Bと同じであったものとする。 At step S26, evaluation value according to the dynamic evaluation of the analysis list L in P x point which is earlier is updated from the position of the current own vehicle H. FIG. 7C shows the updated analysis list L2. In FIG. 7C, it is assumed that the stoptable area R22 is ahead of the own vehicle but is not subject to evaluation (enter “-”), and the other evaluations are the same as in FIG. 7B. ..
次のステップS30(図2C参照)では、緊急停車位置の探索及び設定が実行される。ここでの緊急停車位置の設定プロセスは、前述の《退避走行制御(2)》と同様であり、次の緊急停車位置が停車可能領域R24内に設定される。 In the next step S30 (see FIG. 2C), the search and setting of the emergency stop position are executed. The process of setting the emergency stop position here is the same as that of the above-mentioned << Evacuation running control (2) >>, and the next emergency stop position is set in the stoptable area R24.
−退避経路生成工程−
ステップS42では、停車経路生成部132により、停車可能領域R24内に設定された緊急停車位置までの退避経路が生成される。
-Evacuation route generation process-
In step S42, the stop
−減速工程−
自車両Hは、すでに所定速度以下まで減速されているので、ステップS43でYES判定となり、ここでは、減速工程は実行されず、制御フローは次のステップS44に進む。
-Deceleration process-
Since the own vehicle H has already been decelerated to a predetermined speed or less, a YES determination is made in step S43, where the deceleration step is not executed and the control flow proceeds to the next step S44.
−レーンチェンジ工程−
図3CのステップS71では、リスク算出部133により、位置H3において情報取得部で取得された車外環境情報に基づいて、他車両Jと衝突するリスクが算出される。ここでは、他車両J(位置J3)は、自車両H(位置H2)の斜め前方を、自車両Hよりも速い速度で走行しているものとする。したがって、位置H3では、衝突リスク(衝突スコア)が所定未満になっているという算出結果が出たものとする。
-Lane change process-
In step S71 of FIG. 3C, the
そうすると、ステップS72においてNO判定となり、緊急停車制御部130は、自車両を第3走行レーンから第2走行レーンにレーンチェンジさせる(図9の位置H4から位置H5参照)。そして、第2走行レーンにレーンチェンジが完了すると、いったん図3Cのレーンチェンジ工程は終了となる。その後、制御フローは図3AのステップS44に戻ってNO判定となり、再びステップS70において、第2走行レーンから第1走行レーンへのレーンチェンジ工程が実行される(図9の位置H6から位置H7参照)。
Then, a NO determination is made in step S72, and the emergency
−第1走行レーン走行工程、停車工程−
停車可能領域R24への緊急停車については、前述の《退避走行制御(2)》と同様であり、ここでは、説明を省略する。自車両Hの緊急停車位置(停車可能領域R24内)への停車が終わると退避走行制御は終了となる。
-First driving lane driving process, stopping process-
The emergency stop in the stoptable area R24 is the same as the above-mentioned << Evacuation running control (2) >>, and the description thereof is omitted here. When the vehicle H finishes stopping at the emergency stop position (within the stoptable area R24), the evacuation running control ends.
《退避走行制御(4)》
以下の説明では、自車両Hが、図10Aの走行シーンを走行している際に、運転者異常が検出されたものとして説明する。なお、前述の《退避走行制御(3)》の場合と同様に、図3Aの制御フローの開始時点において、図10Aに示す位置に始点Ps、終点Peが設定され、図7Aの分析リストL2が作成されているものとする。
<< Evacuation running control (4) >>
In the following description, it is assumed that the driver abnormality is detected while the own vehicle H is traveling in the driving scene of FIG. 10A. At the start of the control flow of FIG. 3A, the start point Ps and the end point Pe are set at the positions shown in FIG. 10A, and the analysis list L2 of FIG. It is assumed that it has been created.
ここでは、前述の《退避走行制御(3)》との相違点を中心に説明するものとし、《退避走行制御(3)》と共通の動作について説明を省略する場合がある。例えば、自車両HがH7の位置に到達するまでの動作、すなわち、「第1走行レーン走行工程、停車工程」を開始するところまでの動作は、前述の《退避走行制御(1)》と共通である。そこで、ここでは自車両HがH7の位置まで走行し、図3Dの制御プロセスが開始されたところからの動作について説明する。尚、自車両Hが位置H6を走行しているときには、停車可能領域R24に停車している他車両Jbは認識できておらず、自車両HがH7の位置に来たときに初めて他車両Jbが認識できたものとする。 Here, the differences from the above-mentioned << retracted travel control (3) >> will be mainly described, and the description of the operation common to the << retracted travel control (3) >> may be omitted. For example, the operation until the own vehicle H reaches the position of H7, that is, the operation until the start of the "first traveling lane traveling process, stopping process" is the same as the above-mentioned << evacuation traveling control (1) >>. Is. Therefore, here, the operation from the point where the own vehicle H travels to the position of H7 and the control process of FIG. 3D is started will be described. When the own vehicle H is traveling at the position H6, the other vehicle Jb stopped in the stoptable area R24 cannot be recognized, and the other vehicle Jb is not recognized until the own vehicle H comes to the position H7. Can be recognized.
−第1走行レーン走行工程、停車工程−
図10Aの例では、自車両HがH7の位置に来たときに停車可能領域R24が認識される、すなわちステップS81でYES判定となる。そして、停車可能領域R24に他車両Jbが停車しているので、ステップS85はYES判定となる。すなわち、緊急停車制御部130は、停車可能領域R24に進入すると、他車両Jaとの衝突リスクが所定以上であると判断し、第1走行レーン走行工程を途中で取りやめて、停車位置の再設定を実行する。具体的には、緊急停車制御部130は、図3Dの制御プロセスを中断し、制御フローが図2AのステップS13に戻される。
-First driving lane driving process, stopping process-
In the example of FIG. 10A, the stoptable region R24 is recognized when the own vehicle H comes to the position of H7, that is, a YES determination is made in step S81. Then, since the other vehicle Jb is stopped in the stoptable area R24, the determination in step S85 is YES. That is, when the emergency
−停車位置設定工程−
図2Aにおいて、自車両Hの位置がHを走行しているので、ステップS13はYES判定、ステップS15はNO判定となる。また、緊急停車位置は、最初のフローで実行済みのため、ステップS16はYES判定となり、制御フローはステップS26に進む。
-Stop position setting process-
In FIG. 2A, since the position of the own vehicle H is traveling in H, the determination in step S13 is YES and the determination in step S15 is NO. Further, since the emergency stop position has already been executed in the first flow, the determination in step S16 is YES, and the control flow proceeds to step S26.
ステップS26では、現在の自車両Hの位置よりも先にある点Pxにおける分析リストLの動的評価に係る評価値が更新される。図7Dには、更新された分析リストL2を示している。図7Dでは、領域R24に対する準動的障害物の評価結果として「0」が設定される。その結果、領域R24における路肩評価の評価値として「0」が設定される。尚、停車可能領域R25、制約領域RNの評価値は変わらなかったものとする。 At step S26, evaluation value according to the dynamic evaluation of the analysis list L in P x point which is earlier is updated from the position of the current own vehicle H. FIG. 7D shows the updated analysis list L2. In FIG. 7D, “0” is set as the evaluation result of the quasi-dynamic obstacle for the region R24. As a result, "0" is set as the evaluation value of the road shoulder evaluation in the area R24. It is assumed that the evaluation values of the stoptable area R25 and the constraint area RN have not changed.
次のステップS30(図2C参照)では、緊急停車位置の探索及び設定が実行される。 In the next step S30 (see FIG. 2C), the search and setting of the emergency stop position are executed.
図2CのステップS31では、停車可能領域としてR25のみが抽出される。上記のとおり、領域R24は、路肩評価の評価値として「0」が設定されているので、停車可能領域として抽出されない。 In step S31 of FIG. 2C, only R25 is extracted as a stoptable area. As described above, the area R24 is not extracted as a stoptable area because "0" is set as the evaluation value of the road shoulder evaluation.
停車可能領域R25のみが抽出されているので、ステップS32はYES判定、ステップS33はNO判定となる。そして、次のステップS36では、停車可能領域R25内に緊急停車位置に設定され、停車位置設定工程は終了となる。 Since only the stoptable area R25 is extracted, the determination in step S32 is YES and the determination in step S33 is NO. Then, in the next step S36, the emergency stop position is set in the stoptable area R25, and the stop position setting process is completed.
−退避経路生成工程−
ステップS42では、停車経路生成部132により、停車可能領域R25内に設定された緊急停車位置までの退避経路が生成される。
-Evacuation route generation process-
In step S42, the stop
−減速工程−
自車両Hは、すでに所定速度以下まで減速されているので、ステップS43でYES判定となり、ここでは、減速工程は実行されず、制御フローは次のステップS44に進む。
-Deceleration process-
Since the own vehicle H has already been decelerated to a predetermined speed or less, a YES determination is made in step S43, where the deceleration step is not executed and the control flow proceeds to the next step S44.
−レーンチェンジ工程−
自車両Hは、すでに第1走行レーンを走行しているので、ステップS44でYES判定となり、ここでは、レーンチェンジ工程は実行されず、制御フローは次のステップS80に進む。
-Lane change process-
Since the own vehicle H has already traveled in the first traveling lane, a YES determination is made in step S44, where the lane change process is not executed and the control flow proceeds to the next step S80.
−第1走行レーン走行工程、停車工程−
停車可能領域R25への緊急停車については、前述の《退避走行制御(3)》の停車可能領域R24への停車と実質的に同じような流れであり、ここでは、説明を省略する。図10Bに示すように、自車両Hの緊急停車位置(停車可能領域R25内)への停車が終わると退避走行制御は終了となる。
-First driving lane driving process, stopping process-
The emergency stop in the stoptable area R25 is substantially the same as the stop in the stoptable area R24 in the above-mentioned << Evacuation running control (3) >>, and the description thereof will be omitted here. As shown in FIG. 10B, the evacuation running control ends when the vehicle H finishes stopping at the emergency stop position (within the stoptable area R25).
以上のように、本実施形態によると、車両制御装置10の制御部100は、車両を緊急停車させる場合に、記憶部20に記憶された路肩領域Rの情報を基に車両を停車させる停車位置を設定する停車位置設定工程と、停車位置までの退避経路を生成する退避経路生成工程と、車両の車速を所定速度以下に減速させる減速工程と、車外環境情報に基づいて、第2走行レーンから第1走行レーンのフリースペースに車両をレーンチェンジさせるレーンチェンジ工程と、第1走行レーンにおいて車両を前記所定速度以下で走行させる第1走行レーン走行工程と、前記第1走行レーンから前記停車位置に該車両を進入させて停車させる停車工程とを実行するように構成されている。そして、制御部100は、情報取得部で取得された車外環境情報に基づいて、道路上の障害物に衝突する衝突リスクを演算し、その衝突リスクが所定以上の工程が存在する場合に該工程を取りやめて、取りやめた工程以降の動作を実行するための停車位置を設定する。
As described above, according to the present embodiment, when the vehicle is urgently stopped, the
このように、道路上の障害物に衝突する衝突リスクが所定以上の工程を取りやめて、取りやめた工程以降の動作を実行するための停車位置を設定することにより、一旦設定した緊急停車位置に向かう退避経路が、その後の交通流の変化によって衝突リスクが顕在化する前に、安全に緊急停車ができる停車位置及び退避経路に切り替えることができる。 In this way, by canceling the process in which the collision risk of colliding with an obstacle on the road exceeds a predetermined value and setting the stop position for executing the operation after the canceled process, the vehicle heads for the once set emergency stop position. The evacuation route can be switched to a stop position and an evacuation route where an emergency stop can be safely performed before the collision risk becomes apparent due to a subsequent change in traffic flow.
前述の実施形態は単なる例示に過ぎず、本開示の範囲を限定的に解釈してはならない。本開示の範囲は請求の範囲によって定義され、請求の範囲の均等範囲に属する変形や変更は、全て本開示の範囲内のものである。 The above embodiments are merely examples, and the scope of the present disclosure should not be construed in a limited manner. The scope of the present disclosure is defined by the scope of claims, and all modifications and changes belonging to the equivalent scope of the scope of claims are within the scope of the present disclosure.
ここに開示された技術は、車外環境認識手段で認識された車外環境情報に基づいて目標位置までの目標経路を生成し、該目標経路に追従するように前記車両を制御する走行制御部を備える、車両の走行制御装置として有用である。 The technology disclosed herein includes a travel control unit that generates a target route to a target position based on the vehicle exterior environment information recognized by the vehicle exterior environment recognition means and controls the vehicle so as to follow the target route. , Useful as a vehicle travel control device.
10 車両制御装置(走行制御装置)
100 制御部
20 記憶部
30 情報取得部
R 路肩領域
10 Vehicle control device (travel control device)
100
Claims (4)
前記制御部は、前記車両が、路肩領域に隣接する第1走行レーンよりも該路肩領域から離れた第2走行レーンを走行している場合において、該車両を自動停車させるときに、
前記路肩領域情報に基づいて前記車両を停車させる停車位置を探索して前記目標位置に設定し、前記目標経路として該停車位置までの退避経路を生成する工程と、
前記車両の車速を所定速度以下に減速させる工程と、
前記車外環境情報に基づいて、前記第2走行レーンから前記第1走行レーンのフリースペースに車両をレーンチェンジさせる工程と、
前記第1走行レーンにおいて前記車両を前記所定速度以下で走行させ、前記第1走行レーンから前記停車位置に該車両を進入させて停車させる工程とを実行するとともに、
前記情報取得部で取得された車外環境情報に基づいて、道路上の障害物に衝突する衝突リスクを演算し、該衝突リスクが所定以上の工程が存在する場合に該工程を取りやめて、該取りやめた工程以降の動作を実行するための前記停車位置を設定する
ことを特徴とする車両の走行制御装置。 Includes a control unit that generates a target route to a target position based on the outside environment information acquired by the information acquisition unit installed in the vehicle and controls the vehicle so as to follow the target route, and road shoulder area information. Equipped with a storage unit that stores road information
When the vehicle is traveling in a second traveling lane farther from the road shoulder region than the first traveling lane adjacent to the road shoulder region, the control unit automatically stops the vehicle.
A step of searching for a stop position at which the vehicle is stopped based on the road shoulder area information, setting the target position, and generating an evacuation route to the stop position as the target route.
A process of reducing the vehicle speed of the vehicle to a predetermined speed or less, and
A process of changing the lane of the vehicle from the second traveling lane to the free space of the first traveling lane based on the external environment information.
In the first traveling lane, the vehicle is driven at a speed equal to or lower than the predetermined speed, the vehicle is made to enter the stopping position from the first traveling lane, and the vehicle is stopped.
Based on the vehicle exterior environment information acquired by the information acquisition unit, the collision risk of colliding with an obstacle on the road is calculated, and if there is a process in which the collision risk is equal to or higher than a predetermined value, the process is canceled and the process is canceled. A vehicle travel control device, characterized in that the stop position for executing the operation after the process is set.
前記制御部は、前記車両が路肩領域に隣接する第1走行レーンを走行している場合において前記車両を自動停車させるときに、
前記路肩領域情報に基づいて前記車両を停車させる停車位置を探索して前記目標位置に設定し、前記目標経路として該停車位置までの退避経路を生成する工程と、
前記車両の車速を所定速度以下に減速させる工程と、
前記車外環境情報に基づいて、前記車両を前記停車位置まで走行させ前記第1走行レーンから前記停車位置に車両を進入させて停車させる工程とを実行するとともに、
前記情報取得部で取得された車外環境情報に基づいて、道路上の障害物に衝突する衝突リスクを演算し、該衝突リスクが所定以上の工程が存在する場合に、該工程を取りやめて、該取りやめた工程以降の動作を実行するための停車位置を設定する
ことを特徴とする車両の走行制御装置。 Includes a control unit that generates a target route to a target position based on the outside environment information acquired by the information acquisition unit installed in the vehicle and controls the vehicle so as to follow the target route, and road shoulder area information. Equipped with a storage unit that stores road information
When the vehicle is traveling in the first traveling lane adjacent to the road shoulder region, the control unit automatically stops the vehicle.
A step of searching for a stop position at which the vehicle is stopped based on the road shoulder area information, setting the target position, and generating an evacuation route to the stop position as the target route.
A process of reducing the vehicle speed of the vehicle to a predetermined speed or less, and
Based on the outside environment information, the process of traveling the vehicle to the stop position, entering the vehicle from the first traveling lane to the stop position, and stopping the vehicle is executed.
Based on the vehicle exterior environment information acquired by the information acquisition unit, the collision risk of colliding with an obstacle on the road is calculated, and if there is a process in which the collision risk is equal to or higher than a predetermined value, the process is canceled and the process is canceled. A vehicle travel control device characterized by setting a stop position for executing an operation after a canceled process.
前記制御部は、前記車両の運転者の体調異常が検出された場合、前記体調異常に応じて、該体調異常検出後の経過時間または走行距離の少なくとも一方の制限を設け、当該制限の範囲内において前記停車位置を設定する
ことを特徴とする車両の走行制御装置。 In the traveling control device according to claim 1 or 2.
When an abnormality in the physical condition of the driver of the vehicle is detected, the control unit sets a limit of at least one of the elapsed time or the mileage after the detection of the abnormality in the physical condition, and is within the range of the limitation. A vehicle traveling control device, characterized in that the stop position is set in the above.
前記制御部は、前記路肩領域情報を基に、前記路肩領域の幅員及び長さのそれぞれが所定の基準値以上である領域を停車可能領域として抽出し、
前記停車可能領域が複数ある場合に、該停車可能領域の広さに応じた優先度を設け、当該優先度の高い停車可能領域を前記停車位置に設定する
ことを特徴とする車両の走行制御装置。 In the traveling control device according to claim 3,
Based on the road shoulder area information, the control unit extracts an area in which the width and length of the road shoulder area are equal to or larger than a predetermined reference value as a stoptable area.
When there are a plurality of stoptable areas, a vehicle travel control device is characterized in that a priority is provided according to the size of the stoptable area and the stoptable area having a high priority is set at the stop position. ..
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020010819A JP7347238B2 (en) | 2020-01-27 | 2020-01-27 | Vehicle travel control device |
US17/123,116 US11745733B2 (en) | 2020-01-27 | 2020-12-16 | Travel control apparatus for vehicle, vehicle controlling method and computer program therefor |
EP20215894.5A EP3854621A3 (en) | 2020-01-27 | 2020-12-21 | Control apparatus for vehicle, and vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020010819A JP7347238B2 (en) | 2020-01-27 | 2020-01-27 | Vehicle travel control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021115971A true JP2021115971A (en) | 2021-08-10 |
JP7347238B2 JP7347238B2 (en) | 2023-09-20 |
Family
ID=77173816
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020010819A Active JP7347238B2 (en) | 2020-01-27 | 2020-01-27 | Vehicle travel control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7347238B2 (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2022172768A (en) * | 2021-05-07 | 2022-11-17 | 三菱電機株式会社 | Vehicle driving assistance device and vehicle driving assistance method |
CN115649159A (en) * | 2022-12-27 | 2023-01-31 | 中国第一汽车股份有限公司 | Vehicle collision early warning method and device, intelligent driving vehicle and electronic equipment |
JP2023043238A (en) * | 2021-09-16 | 2023-03-29 | 三菱電機株式会社 | Target route generation device and target route generation method |
WO2023145117A1 (en) * | 2022-01-31 | 2023-08-03 | 日立Astemo株式会社 | Vehicle-mounted electronic control device |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015228090A (en) * | 2014-05-30 | 2015-12-17 | 株式会社デンソー | Limp mode assist system |
JP2016149122A (en) * | 2015-02-10 | 2016-08-18 | 株式会社デンソー | Evacuation control system and evacuation control method |
JP2017065420A (en) * | 2015-09-30 | 2017-04-06 | 日立オートモティブシステムズ株式会社 | Lane change system |
JP2019510674A (en) * | 2016-03-24 | 2019-04-18 | 本田技研工業株式会社 | System and method for trajectory planning for unforeseen pedestrians |
JP2019084885A (en) * | 2017-11-02 | 2019-06-06 | トヨタ自動車株式会社 | Lane-change support apparatus |
JP2020093730A (en) * | 2018-12-14 | 2020-06-18 | トヨタ自動車株式会社 | Vehicle travel control apparatus |
JP2020164038A (en) * | 2019-03-29 | 2020-10-08 | 本田技研工業株式会社 | Vehicle control system |
JP2020166659A (en) * | 2019-03-29 | 2020-10-08 | 本田技研工業株式会社 | Vehicle control system |
-
2020
- 2020-01-27 JP JP2020010819A patent/JP7347238B2/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015228090A (en) * | 2014-05-30 | 2015-12-17 | 株式会社デンソー | Limp mode assist system |
JP2016149122A (en) * | 2015-02-10 | 2016-08-18 | 株式会社デンソー | Evacuation control system and evacuation control method |
JP2017065420A (en) * | 2015-09-30 | 2017-04-06 | 日立オートモティブシステムズ株式会社 | Lane change system |
JP2019510674A (en) * | 2016-03-24 | 2019-04-18 | 本田技研工業株式会社 | System and method for trajectory planning for unforeseen pedestrians |
JP2019084885A (en) * | 2017-11-02 | 2019-06-06 | トヨタ自動車株式会社 | Lane-change support apparatus |
JP2020093730A (en) * | 2018-12-14 | 2020-06-18 | トヨタ自動車株式会社 | Vehicle travel control apparatus |
JP2020164038A (en) * | 2019-03-29 | 2020-10-08 | 本田技研工業株式会社 | Vehicle control system |
JP2020166659A (en) * | 2019-03-29 | 2020-10-08 | 本田技研工業株式会社 | Vehicle control system |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2022172768A (en) * | 2021-05-07 | 2022-11-17 | 三菱電機株式会社 | Vehicle driving assistance device and vehicle driving assistance method |
JP7237109B2 (en) | 2021-05-07 | 2023-03-10 | 三菱電機株式会社 | Vehicle driving support device and vehicle driving support method |
JP2023043238A (en) * | 2021-09-16 | 2023-03-29 | 三菱電機株式会社 | Target route generation device and target route generation method |
JP7258094B2 (en) | 2021-09-16 | 2023-04-14 | 三菱電機株式会社 | Target route generation device and target route generation method |
WO2023145117A1 (en) * | 2022-01-31 | 2023-08-03 | 日立Astemo株式会社 | Vehicle-mounted electronic control device |
CN115649159A (en) * | 2022-12-27 | 2023-01-31 | 中国第一汽车股份有限公司 | Vehicle collision early warning method and device, intelligent driving vehicle and electronic equipment |
Also Published As
Publication number | Publication date |
---|---|
JP7347238B2 (en) | 2023-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6704890B2 (en) | Vehicle control device, vehicle control method, and program | |
JP2021115973A (en) | Vehicle control device | |
JP7347238B2 (en) | Vehicle travel control device | |
JP4694440B2 (en) | Driver support system | |
CN107614349B (en) | Controller of vehicle and control method for vehicle | |
RU2760046C1 (en) | Driving assistance and driving assistance device | |
EP3854621A2 (en) | Control apparatus for vehicle, and vehicle | |
CN111824126B (en) | Vehicle control system | |
JP2020163900A (en) | Vehicle control device, vehicle control method, and program | |
WO2016170647A1 (en) | Occlusion control device | |
JP2019182305A (en) | Vehicle control device, vehicle control method, and program | |
CN110239549B (en) | Vehicle control device, vehicle control method, and storage medium | |
JP2020166659A (en) | Vehicle control system | |
CN115298073B (en) | Vehicle travel support method and travel support device | |
KR102184598B1 (en) | Driving Prediction and Safety Driving System Based on Judgment of Driver Emergency Situation of Autonomous Driving Vehicle | |
JP2021068016A (en) | Vehicle controller, vehicle control method and program | |
JP2021157403A (en) | Vehicle control device, vehicle control method, and program | |
JP7375576B2 (en) | Vehicle control device | |
JP2021160532A (en) | Vehicle control device, vehicle control method, and program | |
JP7388208B2 (en) | Vehicle control device | |
JP2021160531A (en) | Vehicle control device, vehicle control method, and program | |
US20210241001A1 (en) | Vehicle control system | |
JP2019147437A (en) | Vehicle control device, vehicle control method and program | |
JP2019094880A (en) | Vehicle control device, vehicle control method, and program | |
JP7184694B2 (en) | vehicle control system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220720 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230518 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230523 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230724 |
|
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: 20230808 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230821 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7347238 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |