JP7846462B2 - 車両運転支援装置 - Google Patents

車両運転支援装置

Info

Publication number
JP7846462B2
JP7846462B2 JP2023186397A JP2023186397A JP7846462B2 JP 7846462 B2 JP7846462 B2 JP 7846462B2 JP 2023186397 A JP2023186397 A JP 2023186397A JP 2023186397 A JP2023186397 A JP 2023186397A JP 7846462 B2 JP7846462 B2 JP 7846462B2
Authority
JP
Japan
Prior art keywords
vehicle
continuous structure
collision
avoidance
time
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2023186397A
Other languages
English (en)
Other versions
JP2025075325A (ja
Inventor
祐一 竹平
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2023186397A priority Critical patent/JP7846462B2/ja
Priority to US18/739,349 priority patent/US12600352B2/en
Publication of JP2025075325A publication Critical patent/JP2025075325A/ja
Application granted granted Critical
Publication of JP7846462B2 publication Critical patent/JP7846462B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • B62D15/0265Automatic obstacle avoidance by steering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/001Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits the torque NOT being among the input parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/408Radar; Laser, e.g. lidar
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/04Vehicle stop
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/06Direction of travel

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Regulating Braking Force (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Description

本発明は、自車両がガードレール及び側壁等の連続構造物に衝突しないように衝突回避動作を行う車両運転支援装置に関する。
従来の装置は、自車両の進行方向にある障害物が連続構造物である場合、障害物が連続構造物でない場合に比較して、衝突回避動作としての「自動制動(自動ブレーキ)又は自動操舵」の開始時期を遅らせる(特許文献1を参照。)。これにより、運転者自身が衝突回避のための運転操作を開始する前に衝突回避動作が実行される可能性が低下するので、運転者が衝突回避動作について違和感を覚える頻度を低減することができる。
特開2017-226393号公報
しかしながら、従来の装置は、図2及び図3に示したように、自車両HVが連続構造物CSの自車両側の端部Peに衝突する場合を考慮していない。このため、図2及び図3に示したように、自動制動のみにより衝突を回避する第1回避経路R1及び自車両HVの向きが連続構造物CSの長手方向に沿うように自動操舵を行って衝突を回避する第2回避経路R2は考慮されるが、自車両HVの進行方向が連続構造物CSの長手方向と交差するように自動操舵を行って衝突を回避する第3回避経路R3は考慮されていなかった。そのため、従来の装置によれば、自車両が連続構造物の端部に衝突するようなシーンにおいて、運転者自身が衝突回避のための運転操作を開始する前に衝突回避動作が実行される場合があり、運転者が衝突回避動作について違和感を覚える頻度を十分に低減できていないという問題がある。
本発明は、係る課題を解決するためになされた。即ち、本発明の目的の一つは、自車両が連続構造物の端部に衝突する可能性があるシーンにおいて、運転者が衝突回避動作の介入を煩わしいと感じる頻度をより低減することができる、車両運転支援装置を提供することにある。
本発明の車両運転支援装置の一態様は、
自車両の進行方向の所定領域に障害物が存在している場合に(S405)衝突回避動作を行って前記自車両と前記障害物との衝突を回避する(S450)車両運転支援装置(DS)であって、
前記障害物が連続構造物(CS)であり且つ前記自車両が前記連続構造物の前記自車両の側の端部(Pe)に衝突する可能性があると判定したとき(S430)、
前記衝突回避動作として前記自車両に制動力を付与する自動制動を実行して前記自車両を前記端部の手前で停止させることにより前記自車両と前記連続構造物との衝突を回避する第1回避経路(R1)に従って前記自車両を走行させた場合における前記自動制動の開始時刻である第1時刻(T1)を算出し(S510)、
前記衝突回避動作として自動操舵を実行して前記自車両の進行方向を変化させて前記自車両を前記連続構造物の前記自車両側の領域を通過させることにより前記自車両と前記連続構造物との衝突を回避する第2回避経路(R2)を算出し、前記第2回避経路(R2)に従って前記自車両を走行させるための前記自動操舵の開始時刻である第2時刻(T2)を算出し(S520)、
前記衝突回避動作として自動操舵を実行して前記自車両を前記連続構造物の長手方向と交差するように前記連続構造物の前記端部(Pe)の側方の領域を通過させることにより前記自車両と前記連続構造物との衝突を回避する第3回避経路(R3)を算出し、前記第3回避経路(R3)に従って前記自車両を走行させるための前記自動操舵の開始時刻である第3時刻(T3)を算出し(S550)、
前記第1時刻(T1)、前記第2時刻(T2)及び前記第3時刻(T3)のうちの最も遅い時刻に対応する前記第1回避経路(R1)、前記第2回避経路(R2)及び前記第3回避経路(R3)のうちの一つを(最終的な)衝突回避経路として選択するとともに(S580)、前記最も遅い時刻にて前記選択された衝突回避経路に対応する前記衝突回避動作を開始する(S450)。
この態様によれば、自動制動により連続構造物の端部(Pe)との衝突を回避する第1回避経路(R1)、及び、自動操舵により自車両を「連続構造物の自車両側の領域」を通過させることにより連続構造物の端部との衝突を回避する第2回避経路(R2)のみならず、自動操舵により自車両を連続構造物の長手方向と交差させて自車両を連続構造物の端部(Pe)の側方の領域を通過させることにより連続構造物との衝突を回避する第3回避経路(R3)が、衝突回避経路の候補として考慮され、これらの経路の中で衝突回避動作が最も遅く開始される経路が最終的な衝突回避経路として採用される。この結果、衝突回避動作の開始時期がより遅くなるので、連続構造物を認識している運転者が衝突回避のための運転操作を開始する前に衝突回避動作が実行されてしまう可能性が低減され得る。その結果、運転者が衝突回避動作について違和感を覚える頻度を低減することができる。
この場合、前記第2回避経路(R2)に従って前記自車両を走行させた場合に前記自車両が前記連続構造物との衝突を回避した時点以降において前記自車両が他の障害物と衝突することなく停車可能な停車スペース(SP1)が存在していない場合、前記第2回避経路が前記衝突回避経路として選択されないことが望ましい(S530、S540、S440)。更に、前記第3回避経路(R3)に従って前記自車両を走行させた場合に前記自車両が前記連続構造物との衝突を回避した時点以降において前記自車両が他の障害物と衝突することなく停車可能な停車スペース(SP2)が存在していない場合、前記第3回避経路が前記衝突回避経路として選択されないことが望ましい(S560、S570、S440)。自動操舵により連続構造物との衝突を回避できた後に自車両が安全に停車可能なスペースがないような回避経路は最終的な衝突回避経路としては適切ではないからである。
上記説明においては、本発明の理解を助けるために、後述する実施形態に対応する発明の構成に対し、その実施形態で用いた名称及び/又は符号を括弧書きで添えている。しかしながら、本発明の各構成要素は、前記名称及び/又は符号によって規定される実施形態に限定されるものではない。本発明は、車両運転支援方法及びそのプログラムにも及ぶ。
本発明の実施形態に係る車両運転支援装置の概略構成図である。 連続構造物との衝突を回避するための回避経路を示した平面図である。 連続構造物との衝突を回避するための回避経路を示した平面図である。 図1に示した運転支援ECUのCPUが実行するルーチンである。 図1に示した運転支援ECUのCPUが実行するサブルーチンである。 連続構造物との衝突を回避するための回避経路を示した平面図である。
本発明の実施形態に係る「車両運転支援装置DS(以下、「装置DS」と称する。)」は、図1に示した構成要素を備えていて、自車両HVに適用(搭載)される。自車両HVは、内燃機関を動力源とする車両、電動機を動力源とする車両(即ち、電気自動車)及びハイブリッド車両等の何れであってもよい。
本明細書において、「ECU」は、CPU(プロセッサ)、ROM、RAM、データの書き込み可能な不揮発性メモリ及びインタフェース等を含むマイクロコンピュータを備える電子式制御装置(制御ユニット)である。ECUは、コントローラ又はコンピュータとも称される。図1に示した複数のECUはCANを通して互いに情報交換可能に接続されている。これらの複数のECUの幾つか又は全部は一つのECUに統合されてもよい。
運転支援ECU10は、図1に記載された構成要素を用いて衝突回避制御を実行する。
カメラ装置20は、カメラ21とイメージECU22とを含む。カメラ21は、所定時間が経過する毎に自車両HVの前方のシーンを撮影して画像データを取得する。イメージECU22は、カメラ21からの画像データを解析することによりカメラ情報を生成し、カメラ情報を運転支援ECU10に送信する。カメラ情報は、画像データそのもの、撮影された物標の「自車両HVに対する位置、相対縦速度、相対横速度及び種別」等のカメラ物標情報を含む。物標の種別は、他車両及び歩行者等の移動物及び移動しない構造物を含む。構造物は、更に、電柱及びポール等の単独構造物及びガードレール及び側壁等の連続構造物を含む。連続構造物は、厚さ(奥行方向長さ)が厚さ閾値以下であり、水平方向長さ(長手方向の長さ)が長さ閾値以上であり、略一定の高さを有する構造物である。
レーダ装置30は、自車両HVの周辺に存在する物標についての情報をミリ波帯の電波を用いて取得する周知の装置であり、レーダ31とレーダECU32とを含む。レーダ31は、所定時間が経過する毎に、所定の検出範囲内にミリ波を送信し、物標により反射されたミリ波を受信する。レーダ31は、送信及び受信したミリ波についての情報をレーダECU32に送信する。レーダECU32は、レーダ31からの情報に基いてレーダ情報を取得し、運転支援ECU10にレーダ情報を送信する。レーダ情報は、物標までの距離、物標の方位及び物標の相対速度等を含む。
なお、運転支援ECU10は、カメラ情報とレーダ情報とを統合し、物標の位置(物標までの縦距離、物標の横位置、物標方位)、物標の相対速度及び物標の種別を含むフュージョン物標情報を生成する。また、運転支援ECU10は、自車両HVを基準としたX-Y座標を用いて物標の位置を認識する。図2に示したように、このX-Y座標のY軸は自車両HVの前後方向に伸びる中心軸CLであり、X軸は中心軸CLに直交する方向に伸びる軸である。X-Y座標の原点は自車両HVの前端部の車幅方向中央である。
パワートレーンECU40はパワートレーンアクチュエータ41を駆動することにより図示しない自車両HVの動力源を含む駆動装置を制御し、以て、駆動力を発生させる。
ブレーキECU50はブレーキアクチュエータ51を駆動することにより図示しない自車両HVの制動装置を制御し、以て、自車両HVに制動力を付与する。ブレーキECU50は、運転支援ECU10からの指示に応じてブレーキアクチュエータ51を駆動し、自車両HVを自動制動することができる(自車両HVに自動ブレーキを付与できる。)。
ステアリングECU60は操舵モータ61を駆動することにより図示しない自車両HVの操舵装置を制御し、以て、自車両HVの舵角を変更する。ステアリングECU60は、運転支援ECU10からの指示に応じて操舵モータ61を駆動し、自車両HVを自動操舵することができる。
警報ECU70は、運転支援ECU10からの指示に応じて、運転席から視認可能な位置に配設されて所定の表示を行う警報表示装置71と、警報音を発生する警報音発生装置72と、を制御することができる。
運転支援ECU10は以下の「センサ及びスイッチ」の検出値(出力値)を入力する。
・自車両HVのアクセルペダル操作量APを検出するアクセルペダル操作量センサ81。
・自車両HVのブレーキペダル操作量BPを検出するブレーキペダル操作量センサ82。
・自車両HVの速度(即ち、自車速Vh)を検出する車速センサ83。
・自車両HVのヨーレートYrを検出するヨーレートセンサ84。
・自車両HVの操舵角Stを検出する操舵角センサ85。
・操舵トルクセンサ、前後加速度センサ及び横加速度センサ等のその他のセンサ群86。
(作動の概要)
図2及び図3に示したように、装置DSは、自車両HVの進行方向の所定領域に障害物が存在していて、且つ、その障害物が連続構造物CSである場合、自車両HVがその連続構造物CSの自車両側の端部Peに衝突する可能性があるか否かを判定する。装置DSは、自車両HVがその端部Peに衝突する可能性があると判定した場合、自車両HVと端部Peとの衝突を回避するための以下の3種類の回避経路を算出する。
(1)第1回避経路R1:衝突回避動作として自車両HVに制動力を付与する自動制動を実行して自車両HVを端部Peの手前で停止させるときの経路。
(2)第2回避経路R2:衝突回避動作として自動操舵を実行して自車両HVの進行方向を変化させて自車両HVを「連続構造物CSの自車両側の領域」を通過させる経路。
(3)第3回避経路R3:衝突回避動作として自動操舵を実行して自車両HVの進行方向を変化させて自車両HVを連続構造物CSの長手方向と交差させ連続構造物CSの端部Peの側方の領域(連続構造物CSが存在しない領域)を通過させる経路。
そして、装置DSは、第1回避経路R1において自動制動を開始させる時刻(第1時刻、第1タイミング)T1、第2回避経路R2において自動操舵を開始させる時刻(第2時刻、第2タイミング)T2、及び、第3回避経路R3において自動操舵を開始させる時刻(第3時刻、第3タイミング)T3を算出し、それらの中から最も遅い時刻に対応する回避経路を最終的な衝突回避経路として選択する。装置DSは、現在の時刻が「最も遅い時刻」に一致したときに、依然として自車両HVと端部Peとが衝突する可能性がある場合、その最も遅い時刻に開始時刻が対応している衝突回避動作を開始する。
(具体的作動)
運転支援ECU10のCPU10a(以下、単に「CPU」と称する。)は図4にフローチャートにより示したルーチンを所定時間(演算周期)dtの経過毎に実行する。なお、以下において「ステップ」は「S」と表記される。
所定のタイミングになると、CPUは、図4のS400から処理を開始してS405に進み、自車両HVの進行方向に障害物が存在しているか否かを判定する。より具体的に述べると、CPUは、自車両HVの車幅(又は、車幅にマージンを加えた値)を幅として有し且つ自車両HVの進行方向に伸びる帯状の領域であって自車両HVの先端部からの距離が「自車速Vhに応じて定まる所定距離」以内の領域に障害物が存在しているか否かを、自車速Vh及びフュージョン物標情報に基いて判定する。即ち、CPUは、自車両HVが現時点の「操舵角及び自車速Vh」を維持した場合、所定の一定時間以内に自車両HVと衝突すると考えられる物標(障害物)が存在するか否かを判定する。自車両HVの進行方向に障害物が存在しない場合、CPUはS405からS495に直接進んで本ルーチンを一旦終了する。
これに対し、自車両HVの進行方向に障害物が存在している場合、CPUはS405からS410に進み、衝突回避動作実行中フラグXEの値が「0」であるか否かを判定する。このフラグXEの値は、後述する衝突回避制御によって何等かの衝突回避動作が実行されている場合に「1」に設定される。なお、フラグXEの値は、図示しない自車両HVのイグニッション・キー・スイッチがオフ位置からオン位置へと変更されたときにCPUにより実行される図示しないイニシャライズルルーチンにおいて「0」に設定される。フラグXEの値が「0」でない場合、CPUはS410からS495に直接進む。
衝突回避動作実行中フラグXEの値が「0」である場合、CPUはS410からS415に進み、フュージョン物標情報(特に、カメラ情報)に基いて、自車両HVの進行方向に位置していると判定された障害物が連続構造物であるか否かを判定する。例えば、運転支援ECU10は、連続構造物の代表例である「ガードレール及び側壁等」の画像上の特徴を事前に学習している。一方、CPUは、カメラ情報に含まれる画像データから撮影されている物標の特徴を抽出する。CPUは、学習している画像上の特徴と画像データから抽出された特徴とを比較することによって(即ち、パターンマッチング手法を用いて)、障害物が連続構造物の一つに該当するか否かを判定することにより、障害物が連続構造物であるか否かを判定する。或いは、CPUは、フュージョン物標情報により取得された物標の位置及び形状を、平面図である二次元マップに描き、その描かれた形状に基いて障害物が連続構造物であるか否かを判定してもよい。
障害物が連続構造物でない場合、CPUはS415からS420に進み、周知の「通常の障害物(移動物及び単独構造物)に対する衝突回避制御」を実行する。なお、CPUは、この周知の衝突回避制御によって何等かの衝突回避動作が開始したとき、衝突回避動作実行中フラグXEの値を「1」に設定する。その後、CPUはS495に進む。
これに対し、障害物が連続構造物である場合、CPUはS415からS425に進み、連続構造物に関する以下に述べる情報(連続構造物情報)をフュージョン物標情報から取得する。
・連続構造物CSの水平方向(長手方向)の長さL(図2を参照。)。
・連続構造物CSのX軸に対する角度θ(図2を参照。)。
・連続構造物CSの位置(自車両HVの現時点位置におけるX-Y座標上の位置)。
次に、CPUはS430に進み、自車両HVが連続構造物CSの自車両側の端部Pe(図2及び図3を参照。)に衝突する恐れがあるか否かを判定する。即ち、CPUは、自車両HVが現時点の「操舵角及び自車速Vh」を維持した場合、自車両HVが連続構造物CSの自車両HV側の端部Peに達するか否かを判定する。
自車両HVが連続構造物CSの自車両側の端部Peに衝突する恐れがない場合、CPUはS430からS435に進み、「通常の連続構造物CSに対する衝突回避制御(例えば、特許文献1を参照。)」を実行する。なお、CPUは、この通常の連続構造物CSに対する衝突回避制御によって何等かの衝突回避動作が開始したとき、衝突回避動作実行中フラグXEの値を「1」に設定する。その後、CPUはS495に進む。
これに対し、自車両HVが連続構造物CSの自車両側の端部Peに衝突する恐れがある場合、CPUはS430からS440に進み、衝突回避経路の演算、選択及び衝突回避動作の開始時刻(開始タイミング)の決定を行う。
より具体的に述べると、CPUはS440に進んだとき、図5のサブルーチンの処理をS500から開始し、S510に進む。
CPUはS510にて、図2及び図3に示した「衝突回避動作としての自動制動のみにより連続構造物CSとの衝突を回避する第1回避経路R1」において、その自動制動の制動開始時刻(即ち、ブレーキECU50を介してブレーキアクチュエータ51を作動させ始める時刻)T1を「自車速Vh及び図4のS425にて取得した連続構造物に関する情報等」に基いて演算する。
より具体的に述べると、CPUは、自車両HVが現時点の進行方向を維持している状態において、自車両HVを制動装置が発生する制動力を用いて現時点の自車速Vhから一定の減速度にて減速させた場合に、自車両HVが連続構造物CSに衝突する前に(連続構造物から所定距離だけ自車両HV側の位置に)停止できるようにするための自動制動開始時刻T1を演算する。この自動制動開始時刻T1は便宜上「第1時刻T1」とも称される。
次に、CPUはS520にて、図2及び図3に示した「自車両HVの進行方向が連続構造物CSの長手方向に沿って連続構造物CSの自車両側の領域を通過するように衝突回避動作としての自動操舵を行って連続構造物CSとの衝突を回避する第2回避経路R2」を演算する。この自動操舵は便宜上「順方向自動操舵」とも称される。更に、CPUは、その演算した第2回避経路R2に沿って自車両HVを走行させるための自動操舵の操舵開始時刻(即ち、ステアリングECU60を介して操舵モータ61を作動させ始める時刻)T2を、自車速Vh及びS425にて取得した連続構造物に関する情報等に基いて演算する。この操舵開始時刻T2は便宜上「第2時刻T2」とも称される。
一例として、CPUは、図2に示したシーンにおいて、平面視における連続構造物CSの自車両側の表面に沿った直線CSLを自車両HV側に所定のマージン距離αだけ平行移動した直線SL1と、平面視における自車両HVの左先端部PLを通る中心軸CLと平行な直線SL2と、の両方に接する複数の円弧を演算により求める。CPUは、その複数の円弧のそれぞれに従って自車両HVが現時点の自車速Vhで通過した場合の自車両HVの横加速度を演算する。そして、演算された複数の横加速度のうち、許容横加速度閾値以下で且つ最大の横加速度を選択し、その選択した横加速度に対応する円弧を第2回避経路R2として選択する。更に、CPUは、現時点の自車速Vhに基いて、選択した第2回避経路R2と直線SL2との接点CP2に自車両HVの左先端部PLが到達する時刻を操舵開始時刻T2(即ち、第2時刻T2)として求める。
次に、CPUはS530に進み、自車両HVを第2回避経路R2に沿って移動させ且つ自車両HVが連続構造物CSとの衝突を回避した時点(即ち、自車両HVの進行方向が連続構造物CSの長手方向と平行になる時点である第1時点)の直後において自車両HVの停車スペース(図2のSP1を参照。)が存在するか否かを判定する。より具体的に述べると、第1時点において、CPUが、自車両HVの進行方向に別の障害物(図2のOB1を参照。)が存在しているか又は自車両HVが通過できる走路が終了していると判定したとしても、その第1時点から自動制動を開始すれば自車両HVが安全に停止できる状況にあるか否かを判定する。
第2回避経路R2に沿って移動した自車両HVが連続構造物CSとの衝突を回避した時点(第1時点)の直後に自車両HVの停車スペースが存在しない場合、CPUはS530からS540に進み、第2回避経路R2が衝突回避経路として選択されることがないようにするために操舵開始時刻(第2時刻)T2を「現在の時刻Tnow」に便宜上設定する。その後、CPUはS550に進む。これに対し、第1時点の直後に自車両HVの停車スペースが存在している場合、CPUはS530からS550に直接進む。
次に、CPUはS550にて、図2及び図3に示した「自車両HVの向きが連続構造物CSの長手方向と交差するように衝突回避動作としての自動操舵を行って連続構造物CSとの衝突を回避する第3回避経路R3」を演算する。この自動操舵は便宜上「逆方向自動操舵」とも称される。更に、CPUは、その演算した第3回避経路R3に沿って自車両HVを走行させるための自動操舵の操舵開始時刻(即ち、ステアリングECU60を介して操舵モータ61を作動させ始める時刻)T3を、自車速Vh及びS425にて取得した連続構造物に関する情報等に基いて演算する。この操舵開始時刻T3は便宜上「第3時刻T3」とも称される。
一例として、CPUは、図2に示したシーンにおいては、平面視における連続構造物CSの自車両HV側の端部Peを通り、且つ、平面視における自車両HVの右先端部PRを通る中心軸CLと平行な直線SL3に接する複数の円弧を演算により求める。CPUは、その複数の円弧のそれぞれに従って自車両HVが現時点の自車速Vhで通過した場合の自車両HVの横加速度を演算する。そして、演算された複数の横加速度のうち、許容横加速度閾値以下で且つ最大の横加速度を選択し、その選択した横加速度に対応する円弧を第3回避経路R3として選択する。更に、CPUは、現時点の自車速Vhに基いて、選択した第3回避経路R3と直線SL3との接点CP3に自車両HVの右先端部PRが到達する時刻を操舵開始時刻(第3時刻)T3として求める。
次に、CPUはS560に進み、自車両HVを第3回避経路R3に沿って移動させ且つ自車両HVが連続構造物CSとの衝突を回避した時点(即ち、自車両HVの右後端部が連続構造物CSの長手方向の延長線CSLと交差した時点である第2時点)において自車両の停車スペース(図2のSP2を参照。)が自車両HVの進行方向に存在するか否かを判定する。より具体的に述べると、第2時点において、CPUが、自車両HVの進行方向に別の障害物(図2のOB2を参照。)が存在しているか又は自車両HVが通過できる走路が終了していると判定したとしても、その第2時点から自動制動を開始すれば自車両HVが安全に停止できる状況にあるか否かを判定する。
第3回避経路R3に沿って移動した自車両HVが連続構造物CSとの衝突を回避した時点(第2時点)の直後に自車両HVの停車スペースが存在しない場合、CPUはS550からS570に進み、第3回避経路R3が衝突回避経路として選択されることがないようにするために操舵開始時刻(第3時刻)T3を「現在の時刻Tnow」に便宜上設定する。その後、CPUはS580に進む。これに対し、第2時点の直後に自車両HVの停車スペースが存在している場合、CPUはS560からS580に直接進む。
CPUはS580にて、第1時刻T1、第2時刻T2及び第3時刻T3のうち、最も遅い時刻(現在の時刻Tnowから最も離れている時刻)を選択し、その選択した時刻に対応した回避経路を最終的な回避経路として選択する。例えば、第2時刻T2が最も遅い時刻である場合、CPUは第2時刻T2を衝突回避動作の開始時刻として決定するとともに、第2時刻T2に対応した第2回避経路R2を衝突回避経路として選択する。その後、CPUはS595に進み、図4の445へと進む。
CPUはS445にて、現時点(現在の時刻)がS440にて決定された衝突回避動作の開始時刻と一致しているか否かを判定する。現時点が衝突回避動作の開始時刻と一致していない場合、CPUはS445からS495に直接進む。従って、この場合、衝突回避動作は開始されない。
これに対し、現時点(現在の時刻)がS440にて決定された衝突回避動作の開始時刻と一致している場合、CPUはS445からS450に進み、S440にて選択した衝突回避経路に応じた衝突回避動作を開始する。
次に、CPUはS455に進み、衝突回避動作実行中フラグXEの値を「1」に設定し、S495に進んで本ルーチンを一旦終了する。
以上、説明したように、装置DSは、第1回避経路R1、第2回避経路R2及び第3回避経路R3のうち、衝突回避動作が最も遅く開始される経路に従って自車両HVと連続構造物CSの端部Peとの衝突を回避する。例えば、図2及び図3に示した例においては、自車両HVが点CP3に到達する時刻が最も遅いので、第3回避経路R3を用いた衝突回避動作が実行される。更に、仮に停車スペースSP2が存在しないとすると、第3回避経路R3を用いた衝突回避動作は行われないので、図2に示した例においては第2回避経路R2を用いた衝突回避動作が実行されるところ、図3に示した例においては第1回避経路R1を用いた衝突回避動作が実行される。
更に、上記実施形態によれば、図6に示したように、第2回避経路として「端部Peを考慮せず自車両HVの進行方向全体に連続構造物CSが存在する場合の経路R2a」ではなく、「端部Peを回避するための経路R2b」が演算されるので、第2回避経路のための順方向自動操舵の開始時刻をより遅い時刻にすることができる(地点CP2b及び地点CP2aを参照。)。
本発明は上記実施形態に限定されることはなく、本発明の範囲内において種々の変形例を採用することができる。例えば、第2回避経路R2及び第3回避経路R3の算出方法は上述した手法に限られない。例えば、運転支援ECU10は、自車両HVが連続構造物CSの端部Peと衝突したと仮定した場合における自車両HVのラップ率Rpと、自車速Vhと、衝突回避のための経路を示す円弧の半径と、の関係を予めルックアップテーブルの形式にて記憶しておき、このルックアップテーブルに実際のラップ率Rpと実際の現時点における自車速Vhとを適用することによって第2回避経路R2及び第3回避経路R3のそれぞれの半径を求め、求められた半径の円弧に基いて第2回避経路R2及び第3回避経路R3を算出してもよい。更に、運転支援ECUは、自車速Vhと上述した連続構造物情報とから最適な「第2回避経路R2及び第3回避経路R3」を導出する機械学習済みAIを用いてこれらの経路を演算してもよい。また、上記図2及び図3に示した例において、自車両HVは直進しているが、自車両HVが旋回している場合にも本発明を適用することができる。
加えて、運転支援ECU10は、停車スペース(SP1、SP2)となる可能性があるスペースが存在するか否かを、図示しないナビゲーションECUが備える地図情報から取得してもよい。また、例えば、本発明は、自動運転車両において自動運転から運転者による運転へと運転モードが遷移した状態にある自車両に適用可能である。
10…運転支援ECU、20…カメラ装置、30…レーダ装置、50…ブレーキECU、51…ブレーキアクチュエータ、60…ステアリングECU、61…操舵モータ。

Claims (5)

  1. 自車両の進行方向の所定領域に障害物が存在している場合に衝突回避動作を行って前記自車両と前記障害物との衝突を回避する車両運転支援装置であって、
    前記障害物が連続構造物であり且つ前記自車両が前記連続構造物の前記自車両の側の端部に衝突する可能性があると判定したとき、
    前記衝突回避動作として前記自車両に制動力を付与する自動制動を実行して前記自車両を前記端部の手前で停止させることにより前記自車両と前記連続構造物との衝突を回避する第1回避経路に従って前記自車両を走行させた場合における前記自動制動の開始時刻である第1時刻を算出し、
    前記衝突回避動作として自動操舵を実行して前記自車両の進行方向を変化させて前記自車両を前記連続構造物の前記自車両側の領域を通過させることにより前記自車両と前記連続構造物との衝突を回避する第2回避経路を算出し、前記第2回避経路に従って前記自車両を走行させるための前記自動操舵の開始時刻である第2時刻を算出し、
    前記衝突回避動作として自動操舵を実行して前記自車両を前記連続構造物の長手方向と交差するように前記連続構造物の前記端部の側方の領域を通過させることにより前記自車両と前記連続構造物との衝突を回避する第3回避経路を算出し、前記第3回避経路に従って前記自車両を走行させるための前記自動操舵の開始時刻である第3時刻を算出し、
    前記第1時刻、前記第2時刻及び前記第3時刻のうちの最も遅い時刻に対応する前記第1回避経路、前記第2回避経路及び前記第3回避経路のうちの一つを衝突回避経路として選択するとともに、前記最も遅い時刻にて前記選択された衝突回避経路に対応する前記衝突回避動作を開始する、
    車両運転支援装置。
  2. 請求項1に記載の車両運転支援装置であって、
    前記第2回避経路に従って前記自車両を走行させた場合に前記自車両が前記連続構造物との衝突を回避した時点以降において前記自車両が他の障害物と衝突することなく停車可能な停車スペースが存在していない場合、前記第2回避経路を前記衝突回避経路として選択しない、
    車両運転支援装置。
  3. 請求項1又は請求項2に記載の車両運転支援装置であって、
    前記第3回避経路に従って前記自車両を走行させた場合に前記自車両が前記連続構造物との衝突を回避した時点以降において前記自車両が他の障害物と衝突することなく停車可能な停車スペースが存在していない場合、前記第3回避経路を前記衝突回避経路として選択しない、
    車両運転支援装置。
  4. 自車両の進行方向の所定領域に障害物が存在している場合に衝突回避動作を行って前記自車両と前記障害物との衝突を回避する車両運転支援方法であって、
    前記障害物が連続構造物であり且つ前記自車両が前記連続構造物の前記自車両の側の端部に衝突する可能性があるか否かを判定する第1ステップと、
    前記自車両が前記連続構造物の前記自車両の側の端部に衝突する可能性があると判定した場合、
    前記衝突回避動作として前記自車両に制動力を付与する自動制動を実行して前記自車両を前記端部の手前で停止させることにより前記自車両と前記連続構造物との衝突を回避する第1回避経路に従って前記自車両を走行させた場合における前記自動制動の開始時刻である第1時刻を算出し、
    前記衝突回避動作として自動操舵を実行して前記自車両の進行方向を変化させて前記自車両を前記連続構造物の前記自車両側の領域を通過させることにより前記自車両と前記連続構造物との衝突を回避する第2回避経路を算出し、前記第2回避経路に従って前記自車両を走行させるための前記自動操舵の開始時刻である第2時刻を算出し、
    前記衝突回避動作として自動操舵を実行して前記自車両を前記連続構造物の長手方向と交差するように前記連続構造物の前記端部の側方領域を通過させることにより前記自車両と前記連続構造物との衝突を回避する第3回避経路を算出し、前記第3回避経路に従って前記自車両を走行させるための前記自動操舵の開始時刻である第3時刻を算出する、
    第2ステップと、
    前記第1時刻、前記第2時刻及び前記第3時刻のうちの最も遅い時刻に対応する前記第1回避経路、前記第2回避経路及び前記第3回避経路のうちの一つを衝突回避経路として選択するとともに、前記最も遅い時刻にて前記選択された衝突回避経路に対応する前記衝突回避動作を開始する、第3ステップと、
    を含む車両運転支援方法。
  5. 自車両の進行方向の所定領域に障害物が存在している場合に衝突回避動作を行って前記自車両と前記障害物との衝突を回避するために前記自車両に搭載されたコンピュータに実行させるプログラムであって、
    前記プログラムは前記コンピュータに、
    前記障害物が連続構造物であり且つ前記自車両が前記連続構造物の前記自車両の側の端部に衝突する可能性があるか否かを判定する第1ステップと、
    前記自車両が前記連続構造物の前記自車両の側の端部に衝突する可能性があると判定した場合、
    前記衝突回避動作として前記自車両に制動力を付与する自動制動を実行して前記自車両を前記端部の手前で停止させることにより前記自車両と前記連続構造物との衝突を回避する第1回避経路に従って前記自車両を走行させた場合における前記自動制動の開始時刻である第1時刻を算出し、
    前記衝突回避動作として自動操舵を実行して前記自車両の進行方向を変化させて前記自車両を前記連続構造物の前記自車両側の領域を通過させることにより前記自車両と前記連続構造物との衝突を回避する第2回避経路を算出し、前記第2回避経路に従って前記自車両を走行させるための前記自動操舵の開始時刻である第2時刻を算出し、
    前記衝突回避動作として自動操舵を実行して前記自車両を前記連続構造物の長手方向と交差するように前記連続構造物の前記端部の側方領域を通過させることにより前記自車両と前記連続構造物との衝突を回避する第3回避経路を算出し、前記第3回避経路に従って前記自車両を走行させるための前記自動操舵の開始時刻である第3時刻を算出する、
    第2ステップと、
    前記第1時刻、前記第2時刻及び前記第3時刻のうちの最も遅い時刻に対応する前記第1回避経路、前記第2回避経路及び前記第3回避経路のうちの一つを衝突回避経路として選択するとともに、前記最も遅い時刻にて前記選択された衝突回避経路に対応する前記衝突回避動作を開始する、第3ステップと、
    を実行させるプログラム。

JP2023186397A 2023-10-31 2023-10-31 車両運転支援装置 Active JP7846462B2 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2023186397A JP7846462B2 (ja) 2023-10-31 2023-10-31 車両運転支援装置
US18/739,349 US12600352B2 (en) 2023-10-31 2024-06-11 Vehicle driving support device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2023186397A JP7846462B2 (ja) 2023-10-31 2023-10-31 車両運転支援装置

Publications (2)

Publication Number Publication Date
JP2025075325A JP2025075325A (ja) 2025-05-15
JP7846462B2 true JP7846462B2 (ja) 2026-04-15

Family

ID=95485696

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2023186397A Active JP7846462B2 (ja) 2023-10-31 2023-10-31 車両運転支援装置

Country Status (2)

Country Link
US (1) US12600352B2 (ja)
JP (1) JP7846462B2 (ja)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017134519A (ja) 2016-01-26 2017-08-03 トヨタ自動車株式会社 車両用衝突回避支援システム
JP2017226393A (ja) 2016-06-24 2017-12-28 トヨタ自動車株式会社 衝突回避装置
JP2018197048A (ja) 2017-05-23 2018-12-13 トヨタ自動車株式会社 衝突回避制御装置
JP2018197059A (ja) 2017-05-24 2018-12-13 トヨタ自動車株式会社 衝突回避制御装置
CN111483457A (zh) 2019-01-28 2020-08-04 株式会社万都 用于避免碰撞的装置、系统和方法
US20230150486A1 (en) 2021-11-16 2023-05-18 Jungheinrich Aktiengesellschaft Method for dealing with obstacles in an industrial truck

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5403158B2 (ja) 2011-04-11 2014-01-29 トヨタ自動車株式会社 車両制御装置及び車両制御方法
US9008914B2 (en) * 2011-09-26 2015-04-14 Toyota Jidosha Kabushiki Kaisha Driving support system for a vehicle
CN103827941B (zh) 2011-09-26 2016-03-16 丰田自动车株式会社 车辆的驾驶辅助系统
US9393960B2 (en) 2012-11-28 2016-07-19 Toyota Jidosha Kabushiki Kaisha Vehicle cruise control device
CN105142995B (zh) 2013-04-23 2017-08-25 丰田自动车株式会社 车速控制装置
JP6815958B2 (ja) 2017-09-19 2021-01-20 トヨタ自動車株式会社 車両周辺監視装置
JP7136054B2 (ja) 2019-08-29 2022-09-13 トヨタ自動車株式会社 車両制御システム
JP7207256B2 (ja) 2019-10-15 2023-01-18 トヨタ自動車株式会社 車両制御システム
JP7226238B2 (ja) 2019-10-15 2023-02-21 トヨタ自動車株式会社 車両制御システム
JP7255460B2 (ja) 2019-11-15 2023-04-11 トヨタ自動車株式会社 車両制御システム
JP7272241B2 (ja) 2019-11-18 2023-05-12 トヨタ自動車株式会社 車両走行制御装置及び車両制御システム
JP7569227B2 (ja) * 2021-01-25 2024-10-17 トヨタ自動車株式会社 車両衝突回避支援装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017134519A (ja) 2016-01-26 2017-08-03 トヨタ自動車株式会社 車両用衝突回避支援システム
JP2017226393A (ja) 2016-06-24 2017-12-28 トヨタ自動車株式会社 衝突回避装置
JP2018197048A (ja) 2017-05-23 2018-12-13 トヨタ自動車株式会社 衝突回避制御装置
JP2018197059A (ja) 2017-05-24 2018-12-13 トヨタ自動車株式会社 衝突回避制御装置
CN111483457A (zh) 2019-01-28 2020-08-04 株式会社万都 用于避免碰撞的装置、系统和方法
US20230150486A1 (en) 2021-11-16 2023-05-18 Jungheinrich Aktiengesellschaft Method for dealing with obstacles in an industrial truck

Also Published As

Publication number Publication date
US12600352B2 (en) 2026-04-14
US20250136097A1 (en) 2025-05-01
JP2025075325A (ja) 2025-05-15

Similar Documents

Publication Publication Date Title
CN109591813B (zh) 碰撞避免辅助装置
JP7132713B2 (ja) 車両走行制御装置、車両走行制御システムおよび車両走行制御方法
CN110816525B (zh) 车辆驾驶辅助装置
JP7443177B2 (ja) 衝突回避支援装置
JP7470588B2 (ja) 衝突回避支援装置
JP7609246B2 (ja) 車両制御装置、車両制御方法及びそのプログラム
JP6607826B2 (ja) 走行制御装置
JP2023069305A (ja) 車両の運転支援装置、車両の運転支援方法、およびプログラム
CN106965807A (zh) 车辆的驾驶辅助装置
US11932243B2 (en) Vehicle control device and control method
JP7247849B2 (ja) 駐車支援装置
CN114506325A (zh) 一种超车辅助控制方法、系统及计算机可读介质
JP2022125597A (ja) 車両衝突回避支援装置
CN112644464A (zh) 驻车辅助装置
JP7846462B2 (ja) 車両運転支援装置
JP2022113287A (ja) 車両衝突回避支援装置
JP2004110346A (ja) 車両用運転操作補助装置、車両用運転操作補助方法、およびその方法を適用した車両
JP7849662B2 (ja) 運転支援装置
JP2024060411A (ja) 衝突回避支援装置、衝突回避支援方法及び衝突回避支援プログラム
JP2025097140A (ja) 車両制御装置
JP2025149474A (ja) 衝突予測装置
JP2025163829A (ja) 車両制御装置、車両制御方法及びそのプログラム
JP2025093204A (ja) 車両制御装置
JP2023141765A (ja) 運転支援装置、運転支援方法及び運転支援プログラム
JP2021054345A (ja) 車両の運転支援制御装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20250620

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20260219

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20260317

R150 Certificate of patent or registration of utility model

Ref document number: 7846462

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150