JP2022113644A - 走行制御装置 - Google Patents
走行制御装置 Download PDFInfo
- Publication number
- JP2022113644A JP2022113644A JP2021203418A JP2021203418A JP2022113644A JP 2022113644 A JP2022113644 A JP 2022113644A JP 2021203418 A JP2021203418 A JP 2021203418A JP 2021203418 A JP2021203418 A JP 2021203418A JP 2022113644 A JP2022113644 A JP 2022113644A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- target trajectory
- lane
- correct
- traveling
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
【課題】車両の周辺状況に応じた適切な態様で走行軌道を補正する。【解決手段】自車両の周辺状況を認識する認識部411と、認識部411により自車両が走行する自車線の一方に隣接し、自車線と進行方向が同じである第1隣接車線を走行する第1他車両が認識され、自車両が第1他車両の側方を通過すると予測されるとき、または、第1他車両が自車両の側方を通過すると予測されるとき、自車両の目標軌道を車幅方向に第1他車両と離れる方向に補正するための補正量を算出する算出部413と、認識部411により自車線の他方に隣接する第2隣接車線を走行する第2他車両が認識されるとき、第2他車両の走行状況に基づいて、目標軌道を補正するか否かを決定する決定部414と、決定部414により目標軌道を補正すると決定されると、算出部413により算出された補正量に基づいて目標軌道を補正する補正部415と、を備える。【選択図】図3
Description
本発明は、周辺状況に応じて車両の走行軌道を補正する走行制御装置に関する。
この種の装置として、従来、車両が走行する車線に隣接する車線を走行する他車両の接近を認識すると、他車両から離れる方向に操舵角を補正するようにした装置が知られている(例えば特許文献1参照)。
しなしながら、特許文献1記載の装置のように、単に他車両から離れる方向に走行軌道を補正したのでは、その方向に他の車両が存在するときなど自車両の周囲の状況によっては、乗員に違和感を生じさせるおそれがある。
本発明の一態様である走行制御装置は、自車両の周辺状況を認識する認識部と、認識部により認識された周辺状況に応じて、自車両の目標軌道を生成する生成部と、認識部により自車両が走行する自車線の一方に隣接し、自車線と進行方向が同じである第1隣接車線を走行する第1他車両が認識され、自車両が第1他車両の側方を通過すると予測されるとき、または、第1他車両が自車両の側方を通過すると予測されるとき、生成部により生成された目標軌道を車幅方向に第1他車両と離れる方向に補正するための補正量を算出する算出部と、認識部により自車線の他方に隣接する第2隣接車線を走行する第2他車両が認識されるとき、第2他車両の走行状況に基づいて、目標軌道を補正するか否かを決定する決定部と、決定部により目標軌道を補正すると決定されると、算出部により算出された補正量に基づいて目標軌道を補正する補正部と、を備える。
本発明によれば、車両の周辺状況に応じた適切な態様で走行軌道を補正することができる。
以下、図1~図10を参照して本発明の実施形態について説明する。本発明の実施形態に係る走行制御装置は、運転支援機能あるいは自動運転機能を有する車両に適用することができる。以下では、自動運転機能を有する車両(自動運転車両)に、走行制御装置を適用する例を説明する。なお、本実施形態に係る走行制御装置が適用される車両を、他車両と区別して自車両と呼ぶことがある。また、自車両は、ドライバによる運転操作が不要な自動運転モードでの走行だけでなく、ドライバの運転操作による手動運転モードでの走行も可能である。
図1は、自車両を制御する車両制御システム(車両制御装置)10の全体構成を概略的に示すブロック図である。図1に示すように、車両制御装置10は、コントローラ40と、コントローラ40にそれぞれ電気的に接続された外部センサ群31と、内部センサ群32と、入出力装置33と、測位センサ34と、地図データベース35と、ナビゲーション装置36と、通信ユニット37と、走行用アクチュエータ(以下、単にアクチュエータと呼ぶ)ACとを主に有する。
外部センサ群31は、自車両の周辺情報である外部状況を検出する複数のセンサの総称である。例えば外部センサ群31には、自車両の全方位の照射光に対する散乱光を測定して自車両から周辺の障害物までの距離を測定するライダ、電磁波を照射し反射波を検出することで自車両の周辺の他車両や障害物等を検出するレーダが含まれる。また例えば外部センサ群31には、自車両に搭載され、CCDやCMOS等の撮像素子を有して自車両の周辺(前方、後方および側方)を撮像するカメラや、自車両の周辺からの音の信号を入力するマイクロホン(以下、単にマイクと称する)などが含まれる。外部センサ群31により検出された信号および外部センサ群31に入力された信号はコントローラ40に送信される。
内部センサ群32は、自車両の走行状態や車内の状態を検出する複数のセンサの総称である。例えば内部センサ群32には、自車両の車速を検出する車速センサ、自車両の前後方向の加速度および左右方向の加速度(横加速度)をそれぞれ検出する加速度センサ、走行駆動源の回転数を検出する回転数センサ、自車両の重心の鉛直軸回りの回転角速度を検出するヨーレートセンサなどが含まれる。手動運転モードでのドライバの運転操作、例えばアクセルペダルの操作、ブレーキペダルの操作、ステアリングの操作等を検出するセンサも内部センサ群32に含まれる。内部センサ群32による検出信号はコントローラ40に送信される。
入出力装置33は、ドライバから指令が入力されたり、ドライバに対し情報が出力されたりする装置の総称である。例えば入出力装置33には、操作部材の操作によりドライバが各種指令を入力する各種スイッチ、ドライバが音声で指令を入力するマイク、ドライバに表示画像を介して情報を提供する表示部、ドライバに音声で情報を提供するスピーカなどが含まれる。各種スイッチには、自動運転モードおよび手動運転モードのいずれかを指令する手動自動切換スイッチ(SW)が含まれる。
手動自動切換スイッチは、例えばドライバが手動操作可能なスイッチとして構成され、スイッチ操作に応じて、自動運転機能を有効化した自動運転モードまたは自動運転機能を無効化した手動運転モードへの切換指令を出力する。手動自動切換スイッチの操作によらず、所定の走行条件が成立したときに、手動運転モードから自動運転モードへの切換、あるいは自動運転モードから手動運転モードへの切換を指令することもできる。すなわち、手動自動切換スイッチが自動的に切り換わることで、モード切換を手動ではなく自動で行うこともできる。
測位センサ34は、例えばGPSセンサであって、GPS衛星から送信された測位信号を受信し、受信した信号に基づいて自車両の絶対位置(緯度、経度など)を測定する。なお、測位センサ34には、GPSセンサだけでなく準天頂軌道衛星から送信される電波を利用して測位するセンサも含まれる。測位センサ34からの信号(測定結果を示す信号)はコントローラ40に送信される。
地図データベース35は、ナビゲーション装置36に用いられる一般的な地図情報を記憶する装置であり、例えばハードディスクにより構成される。地図情報には、道路の位置情報、道路形状(曲率など)の情報、交差点や分岐地点の位置情報が含まれる。なお、地図データベース35に記憶される地図情報は、コントローラ40の記憶部42に記憶される高精度な地図情報とは異なる。
ナビゲーション装置36は、ドライバにより入力された目的地までの道路上の目標経路を探索するとともに、目標経路に沿った案内を行う装置である。目的地の入力および目標経路に沿った案内は、入出力装置33を介して行われる。目標経路は、測位センサ34により測定された自車両の現在位置と、地図データベース35に記憶された地図情報とに基づいて演算される。
通信ユニット37は、インターネット回線などの無線通信網を含むネットワークを介して図示しない各種サーバと通信し、地図情報および交通情報などを定期的に、あるいは任意のタイミングでサーバから取得する。取得した地図情報は、地図データベース35や記憶部42に出力され、地図情報が更新される。取得した交通情報には、渋滞情報や、信号が赤から緑に変わるまでの残り時間等の信号情報が含まれる。
アクチュエータACは、自車両の走行動作に関する各種機器を作動するための機器である。アクチュエータACには、ブレーキ装置を作動するブレーキ用アクチュエータ、およびステアリング装置を駆動する操舵用アクチュエータなどが含まれる。アクチュエータACは、自車両の走行を制御するための走行用アクチュエータである。走行駆動源がエンジンである場合、アクチュエータACには、エンジンのスロットルバルブの開度(スロットル開度)を調整するスロットル用アクチュエータが含まれる。走行駆動源が走行モータである場合、走行モータがアクチュエータACに含まれる。自車両の制動装置を作動するブレーキ用アクチュエータと転舵装置を駆動する転舵用アクチュエータもアクチュエータACに含まれる。
コントローラ40は、電子制御ユニット(ECU)により構成される。なお、エンジン制御用ECU、変速機制御用ECU等、機能の異なる複数のECUを別々に設けることができるが、図1では、便宜上、これらECUの集合としてコントローラ40が示される。コントローラ40は、CPU等の演算部41と、ROM,RAM,ハードディスク等の記憶部42と、図示しないその他の周辺回路とを有するコンピュータを含んで構成される。
記憶部42には、車線の中央位置の情報や車線位置の境界の情報等を含む高精度の詳細な地図情報が記憶される。より具体的には、地図情報として、道路情報、交通規制情報、住所情報、施設情報、電話番号情報等が記憶される。道路情報には、高速道路、有料道路、国道などの道路の種別を表す情報、道路の車線数、各車線の幅員、道路の勾配、道路の3次元座標位置、車線のカーブの曲率、車線の合流ポイントおよび分岐ポイントの位置、道路標識、中央分離帯の有無等の情報が含まれる。交通規制情報には、工事等により車線の走行が制限または通行止めとされている情報などが含まれる。記憶部42には、変速動作の基準となるシフトマップ(変速線図)、各種制御のプログラム、プログラムで用いられる閾値等の情報も記憶される。
演算部41は、自動走行に関する機能的構成として、自車位置認識部43と、外界認識部44と、行動計画生成部45と、走行制御部46とを有する。
自車位置認識部43は、測位センサ34で受信した自車両の位置情報および地図データベース35の地図情報に基づいて、地図上の自車両の位置(自車位置)を認識する。なお、自車位置認識部43は、記憶部42に記憶された地図情報(建物の形状などの情報)と、外部センサ群31が検出した自車両の周辺情報とを用いて自車位置を認識してもよく、これにより自車位置を高精度に認識することができる。例えば、自車位置認識部43は、記憶部42に記憶された地図情報と、外部センサ群31のカメラにより撮像された自車両の周囲の画像データとを用いて自車位置を認識することができる。また、道路上や道路脇の外部に設置されたセンサで自車位置を測定可能であるとき、そのセンサと通信ユニット37を介して通信することにより、自車位置を高精度に認識することもできる。
外界認識部44は、ライダ、レーダ、カメラ等の外部センサ群31からの信号に基づいて自車両の周囲の外部状況を認識する。外界認識部44は、例えば自車両の周辺を走行する周辺車両(前方車両や後方車両)の位置や速度や加速度、自車両の周囲に停車または駐車している周辺車両の位置、および他の物体の位置や状態などを認識する。他の物体には、標識、信号機、道路の境界線や停止線、建物、ガードレール、電柱、看板、歩行者、自転車等が含まれる。他の物体の状態には、信号機の色(赤、緑、黄)、歩行者や自転車の移動速度や向きなどが含まれる。
行動計画生成部45は、例えばナビゲーション装置36で演算された目標経路と、自車位置認識部43で認識された自車位置と、外界認識部44で認識された外部状況とに基づいて、現時点から所定時間先までの自車両の走行軌道(目標軌道)を生成する。目標経路上に目標軌道の候補となる複数の軌道が存在するときには、行動計画生成部45は、その中から法令を順守し、かつ効率よく安全に走行する等の基準を満たす最適な軌道を選択し、選択した軌道を目標軌道とする。そして、行動計画生成部45は、生成した目標軌道に応じた行動計画を生成する。
行動計画には、現時点から所定時間T先までの間に単位時間Δt毎に設定される走行計画データ、すなわち単位時間Δt毎の時刻に対応付けて設定される走行計画データが含まれる。走行計画データは、単位時間毎の自車両の位置データと車両状態のデータとを含む。位置データは、例えば道路上の2次元座標位置を示す目標点のデータであり、車両状態のデータは、車速を表す車速データと自車両の向きを表す方向データなどである。走行計画は単位時間毎に更新される。
行動計画生成部45は、現時点から所定時間T先までの単位時間Δt毎の位置データを時刻順に接続することにより、目標軌道を生成する。このとき、目標軌道上の単位時間Δt毎の各目標点の車速(目標車速)に基づいて、単位時間Δt毎の加速度(目標加速度)を算出する。すなわち、行動計画生成部45は、目標車速と目標加速度とを算出する。なお、目標加速度を走行制御部46で算出するようにしてもよい。
行動計画生成部45は、目標軌道を生成する際に、まず走行態様を決定する。具体的には、前方車両に追従する追従走行、前方車両を追い越すための追い越し走行、走行車線を変更する車線変更走行、高速道路や有料道路の本線に合流する合流走行、走行車線を逸脱しないように車線を維持するレーンキープ走行、定速走行、減速走行または加速走行等の走行態様を決定する。そして、走行態様に基づいて目標軌道を生成する。
走行制御部46は、自動運転モードにおいて、行動計画生成部45で生成された目標軌道に沿って自車両が走行するように各アクチュエータACを制御する。すなわち、単位時間毎の目標点Pを自車両が通過するように、スロットル用アクチュエータ、変速用アクチュエータ、ブレーキ用アクチュエータ、および操舵用アクチュエータなどをそれぞれ制御する。
より具体的には、走行制御部46は、自動運転モードにおいて道路勾配などにより定まる走行抵抗を考慮して、行動計画生成部45で算出された単位時間毎の目標加速度を得るための要求駆動力を算出する。そして、例えば内部センサ群32により検出された実加速度が目標加速度となるようにアクチュエータACをフィードバック制御する。すなわち、自車両が目標車速および目標加速度で走行するようにアクチュエータACを制御する。なお、手動運転モードでは、走行制御部46は、内部センサ群32により取得されたドライバからの走行指令(アクセル開度等)に応じて各アクチュエータACを制御する。
ところで、図2Aに示すように、片側3車線の左側通行の道路RDにおいて、自車両101が走行する車線(走行車線)LN2の一方に隣接する車線(隣接車線)LN3を他車両102が走行しているときに、自車両101の他車両102に対する相対速度が所定速度以上であるとき、自車両101は他車両102の側方を通過する。このとき、自車両101と他車両102との車幅方向の距離が十分に確保されていないと、自車両101が他車両102の側方を通過するときに自車両101が他車両102に接近し、自車両101の乗員に違和感を与える可能性がある。なお、図中の車線LN4は対向車線であり、車線LN4と車線LN3との間には中央分離帯MSが設けられている。
一方、自車両101と他車両102との車幅方向の距離が十分に確保されるように、自車両101の走行軌道を左側(図における上側)に移動させることで、上記のような乗員の違和感を軽減できる。しかしながら、図2Bに示すように、自車両101の走行車線LN2の他方に隣接する車線(隣接車線)LN1に他車両103が存在するとき、自車両101の走行軌道を左側に移動させると、自車両101と他車両103とが接近するため、自車両101の乗員にその接近による違和感を与える可能性がある。そこで、本実施形態では、周辺車両の側方を通過するときに、周辺車両との接近による乗員の違和感を軽減するように、以下のように走行制御装置を構成する。
図3は、本発明の実施形態に係る走行制御装置200の要部構成を示すブロック図である。この走行制御装置200は、図1の車両制御装置10の一部を構成する。図3に示すように、走行制御装置200は、コントローラ40と、カメラ11と、レーダ12と、ライダ13とを有する。
カメラ11は、CCDやCMOS等の撮像素子(イメージセンサ)を有する単眼カメラであり、図1の外部センサ群31の一部を構成する。カメラ11はステレオカメラであってもよい。カメラ11は、例えば自車両101の前部の所定位置に取り付けられ、自車両101の前方空間を連続的に撮像し、対象物の画像(カメラ画像)を取得する。対象物には、例えば、図2Bに示す他車両102,103が含まれる。カメラ11は、カメラ画像を含む画像データを、コントローラ40に出力する。レーダ12は、自車両101に搭載され、電磁波を照射し反射波を検出することで自車両101の周辺の車両や障害物等を検出する。レーダ12は、検出値(検出データ)をコントローラ40に出力する。ライダ13は、自車両101に搭載され、自車両101の全方位の照射光に対する散乱光を測定して自車両101から周辺の車両や障害物までの距離を検出する。ライダ13は、検出値(検出データ)をコントローラ40に出力する。
図3に示すように、コントローラ40は、演算部41が担う機能的構成として、認識部411と、生成部412と、算出部413と、決定部414と、補正部415とを有する。認識部411は、例えば図1の外界認識部44により構成される。生成部412と算出部413と決定部414と補正部415とは、例えば図1の行動計画生成部45により構成される。なお、ここでは、自車両101が図2Bの走行車線LN2を走行中であるときを例にして、各構成要素について説明する。
認識部411は、カメラ11からの画像データや、レーダ12からの検出データ、ライダ13からの検出データに基づいて、自車両101の周辺状況を認識する。生成部412は、認識部411により認識された周辺状況に応じて、現時点から所定時間T先までの自車両の目標軌道を生成する。算出部413は、認識部411により自車両101の走行車線LN2の一方に隣接する車線LN3を走行する他車両102が認識され、自車両101が他車両102の側方を通過すると予測されるとき、生成部412により生成された目標軌道を車幅方向に他車両102と離れる方向に補正するための補正量を算出する。補正量は、次式(I)により算出される。なお、CAは、算出部413により算出される目標軌道の補正量である。LWは、自車両101の走行車線の幅である。VWは、自車両101の車幅である。MGは、道路上の白線の認識誤差等を考慮して設定されるマージンである。LWは、認識部411によりカメラ11からの画像データに基づき認識された値を用いてもよいし、記憶部42に記憶された道路情報から得られる値を用いてもよい。なお、自車両101の走行車線の幅が増減する場合、それに伴ってLWの値が変化する。その場合、LWの値の変化に応じてCAは更新される。
CA=LW/2-VW/2-MG ・・・(I)
CA=LW/2-VW/2-MG ・・・(I)
決定部414は、認識部411により自車両101の走行車線LN2の他方に隣接する車線LN1を走行する他車両103が認識されるとき、他車両103の走行状況に基づいて、自車両101の目標軌道を補正するか否かを決定する。
図4は、目標軌道を補正するか否かを決定(判定)するための判定エリアの一例を示す図である。決定部414は、認識部411により認識された他車両102に対する相対速度が閾値以上であって、且つ、他車両102の所定時点(現時点よりも先の時点)における位置が判定エリアLA,RAに含まれるとき、自車両101が他車両102の側方を通過すると予測し、目標軌道を補正すると決定する。このとき、決定部414は、他車両102に対する相対速度が閾値(第1閾値)以上であるか否かに加えて、他車両102とのTTC(衝突余裕時間:Time To Collision)が第2閾値未満であるか否かを判定する。そして、他車両102とのTTCが第2閾値未満であるときには、目標軌道の補正が間に合わないと判断し、目標軌道を補正しないと決定する。すなわち、決定部414は、自車両101が目標軌道の補正(目標軌道を車幅方向に他車両102と離れる方向に変更する補正)が完了するまでにかかる最小時間以上の時間経過後に他車両102の側方を通過すると予測されるときには、目標軌道を補正すると決定し、そうでないとき、すなわち目標軌道の補正が間に合わないと判断されるときには、目標軌道を補正しないと決定する。判定エリアLA,RAは、前後方向の長さ(自車両101の進行方向の長さ、すなわち、図4における左右方向の長さ)がDLであり、左右方向の長さ(自車両101の車幅方向の長さ、すなわち、図4における上下方向の長さ)がDWであるエリアである。DWは、認識部411の認識誤差や走行制御部46の制御誤差に基づいて予め設定される。DLは、現時点から第1所定時間(≦所定時間T)先の時点までの自車両101の移動距離に基づき設定される。以下では、説明の簡略化のため、判定エリアLA,RAを2次元のエリアとして説明するが、判定エリアLA,RAは高さを有する3次元のエリアであってもよい。なお、他車両102の所定時点における位置が、判定エリアLA,RAのうちの自車両101から距離IL以内のエリア(以下、補正禁止エリアと呼ぶ)に含まれるときは、目標軌道を補正しないと決定する。ILは、現時点から第2所定時間(<第1所定時間)先の時点までの自車両101の移動距離に基づき設定される。これにより、急な転舵により生じる乗員への違和感や不快感が抑制される。以下、判定エリアLA,RAのうちの補正禁止エリア以外のエリアを補正対象エリアと呼ぶ。
補正部415は、決定部414により目標軌道を補正すると決定されると、算出部413により算出された補正量に基づいて目標軌道を補正する。ここで、補正部415による目標軌道の補正について説明する。まず、自車両101の走行車線LN2の一方に隣接する車線LN3のみに他車両が認識されるときの目標軌道の補正について説明する。図5A~5Dは、目標軌道の補正を説明するための図である。
図5Aには、車線LN2を走行中である自車両101と、車線LN3を走行中である他車両102とが示されている。なお、自車両101の走行速度は50kphであり、他車両102の走行速度は30kphであるとする。すなわち、自車両101の他車両102に対する相対速度は、20kph(=50kph-30kph)である。図中の実線の矢印線ORは、自車両101の現時点(以下、時点t0とする)から所定時間T先までの目標軌道を表す。図中の破線で描かれた他車両102Pは、所定時点における他車両102を模式的に表す。なお、所定時点は、現時点よりも第2所定時間先の時点である。図中の一点鎖線BDは、判定エリアRAの補正禁止エリアと補正対象エリアとの境界を表す。図5Aに示す例では、他車両102Pの一部が判定エリアRAに含まれるため、自車両101の他車両102に対する相対速度が閾値以上であるとき、目標軌道ORは、破線の矢印線MVで示される目標軌道に補正される。なお、相対速度とともにTTCを考慮する場合には、目標軌道ORは、相対速度が第1閾値以上であって、TTCが第2閾値未満であるとき、破線の矢印線MVで示される目標軌道に補正される。図中の破線CNは、補正継続軌道を表す。補正継続軌道は、補正部415により目標軌道が補正されるときに生成部412により生成される目標軌道であり、自車両101を補正後の目標軌道MVの終点の位置(車幅方向の位置)で継続して走行させるための目標軌道である。なお、図5A~5Dでは、判定エリアLAの図示を省略する。
図5Bには、時点t0よりも後の時点(以下、時点t1とする)の自車両101と他車両102との位置関係が示されている。図5Bに示すように、自車両101が補正後の目標軌道MVの始点に到達すると、自車両101は、目標軌道MVに沿って他車両102から離れるように横移動(図において上方向への移動)を開始する。以下、目標軌道MVを横移動軌道とも呼ぶ。なお、横移動軌道MVの始点と終点の間に境界BDが位置するときには、生成部412による目標軌道の生成は行われない。
図5Cには、時点t1よりも後の時点(以下、時点t2とする)の自車両101と他車両102との位置関係が示されている。図5Cに示すように、他車両102P(時点t2から第2所定時間先の時点における他車両102)の位置が判定エリアRAから外れると、生成部412は、自車両101を元の位置(車幅方向の位置)へ復帰させるための目標軌道(以下、復帰軌道と呼ぶ)を生成する。図中の破線の矢印線RTは、自車両101の復帰軌道を表す。なお、他車両102が右側(図において下側)へ移動することにより、他車両102が判定エリアRAから外れたときにも、同様にして、生成部412により復帰軌道が生成される。
図5Dには、時点t2よりも後の時点(以下、時点t3とする)の自車両101と他車両102との位置関係が示されている。図5Dに示すように、自車両101が復帰軌道RTの始点に到達すると、自車両101は、復帰軌道RTに沿って横移動(図において下方向への移動)を開始して、元の位置(車幅方向の位置)に復帰する。以上のようにして、自車両101の目標軌道の補正が行われる。これにより、自車両110は、急な転舵等、急な走行制御の変化を発生させることなく、他車両102との車幅方向における接近を回避しながら、他車両102の側方を通過することができる。
次いで、自車両101の走行車線LN2の一方に隣接する車線LN3と、他方に隣接する車線LN1との両車線に、他車両(他車両102,103)が認識されるときの目標軌道の補正について説明する。ここでは、自車両101の走行車線LN2の一方(右側)に隣接する車線LN3に他車両102が認識され、自車両101の他車両102に対する相対速度が閾値以上であって、かつ、他車両102の所定時点(現時点よりも先の時点)における位置が判定エリアRAに含まれる場合を例にする。この場合、自車両101の走行車線LN2の他方(左側)に隣接する車線LN1に他車両が認識されなければ、自車両101の目標軌道は、車幅方向に他車両102と離れる方向に補正される。しかしながら、図2Bに示すように車線LN1に他車両103が認識されるとき、自車両101の目標軌道を車幅方向に他車両102と離れる方向に補正すると自車両101と他車両103とが接近するおそれがある。そこで、このような接近を回避するため、決定部414は、他車両103の走行状況に基づいて、目標軌道を車幅方向に他車両102と離れる方向に補正するか否かを決定する。具体的には、決定部414は、認識部411により認識された他車両103の走行位置や走行速度や走行加速度などに基づいて、補正(目標軌道を車幅方向に他車両102と離れる方向に変更する補正)後の目標軌道に沿って自車両101が走行したときに自車両101と他車両103とが最も接近する距離(以下、接近距離と呼ぶ)を予測する。このとき、決定部414は、車幅方向の接近距離と進行方向の接近距離とを予測する。そして、決定部414は、予測した自車両101と他車両103との車幅方向の接近距離が第1所定値以上であるか、または、自車両101と他車両103との進行方向の接近距離が第2所定値以上であるとき、目標軌道を補正すると決定する。一方、決定部414は、予測した自車両101と他車両103との車幅方向の接近距離が第1所定値未満であり、かつ、予測した自車両101と他車両103との進行方向の接近距離が第2所定値未満であるとき、目標軌道を補正しないと決定する。上記所定値(第1所定値および第2所定値)は、官能評価等の結果に基づいて予め設定される。なお、第1所定値と第2所定値とには異なる値が設定されてもよい。
図6は、予め記憶されたプログラムに従い、図3のコントローラ40のCPUで実行される処理の一例を示すフローチャートである。このフローチャートに示す処理は、例えば、コントローラ40に電源が投入されると開始され、所定周期で繰り返される。
まず、ステップS11で、自車両101の周辺状況を認識する。具体的には、自車両101の走行車線の一方に隣接する車線を走行する他車両(以下、第1他車両と呼ぶ場合がある)が、自車両101の前方において認識されたか否かを判定する。ステップS11で否定されると、処理を終了する。ステップS11で肯定されると、ステップS12で、自車両101が第1他車両の側方を通過するか否かを判定する。より詳細には、自車両101の第1他車両に対する相対速度が所定速度以上であるか否かを判定する。ステップS12で否定されると、ステップS16に進む。ステップS12で肯定されると、ステップS13で、自車両101の目標軌道を車幅方向に第1他車両と離れる方向に補正するための補正量を算出する。ステップS14で、自車両101の走行車線の他方の隣接車線を走行する他車両(以下、第2他車両と呼ぶ場合がある)が認識されたか否かを判定する。ステップS14で否定されると、ステップS17に進む。ステップS14で肯定されると、ステップS15で、ステップS13で算出された補正量に基づいて自車両101の目標軌道が補正されたときに自車両101と第2他車両とが接近するか否かを判定する。すなわち、補正後の目標軌道に沿って自車両101が走行したときに、自車両101と第2他車両とが最も接近する距離(接近距離)が所定値未満であるか否かを判定する。ステップS15で肯定されると、ステップS16で、自車両101の目標軌道を補正しないと決定する。一方、ステップS15で否定されると、ステップS17で、自車両101の目標軌道を補正すると決定する。
以上のようにして、自車両101の目標軌道を補正するか否かが決定される。自車両101の目標軌道を補正すると決定されると、図5A~図5Dで示されるような目標軌道の補正が行われる。ただし、図7Aに示すように、走行車線LN3と対向車線LN4との間に中央分離帯MSが設けられている道路RDにおいて、自車両101が車線LN3を走行していて、第1他車両(他車両102)が走行車線LN2を走行していて、第2他車両(他車両103)が車線LN3に対向する車線(対向車線)LN4を走行する対向車両であるときには、ステップS15の判定の結果に依らずに、すなわち、自車両101と他車両103との接近度合いに依らずに、ステップS17に進んで目標軌道を補正すると決定する。これにより、目標軌道の補正が不要に抑制されることを防止できる。また、図7Bに示すように、第2他車両(他車両103)が路肩等に停止(駐車や停車)しているときには、目標軌道の補正は行われない。すなわち、ステップS14,S15の判定の結果に依らずに処理は終了し、停止中の他車両103を回避するための走行制御が行われる。なお、このとき行われる走行制御については説明を省略する。
本発明の実施形態によれば以下のような作用効果を奏することができる。
(1)走行制御装置200は、自車両101の周辺状況を認識する認識部411と、認識部411により認識された周辺状況に応じて、自車両101の目標軌道を生成する生成部412と、認識部411により自車両101が走行する自車線(図2Bの車線LN2)の一方に隣接し、自車線と進行方向が同じである第1隣接車線(図2Bの車線LN3)を走行する第1他車両(図2Bの他車両102)が認識され、自車両101が第1他車両の側方を通過すると予測されるとき、生成部412により生成された目標軌道を車幅方向に第1他車両と離れる方向に補正するための補正量を算出する算出部413と、認識部411により自車線の他方に隣接する第2隣接車線(図2Bの車線LN1)を走行する第2他車両(図2Bの他車両103)が認識されるとき、第2他車両の走行状況に基づいて、目標軌道を補正するか否かを決定する決定部414と、決定部414により目標軌道を補正すると決定されると、算出部413により算出された補正量に基づいて目標軌道を補正する補正部415と、を備える。これにより、車両の周辺状況に応じた適切な態様で走行軌道を補正することができる。
(1)走行制御装置200は、自車両101の周辺状況を認識する認識部411と、認識部411により認識された周辺状況に応じて、自車両101の目標軌道を生成する生成部412と、認識部411により自車両101が走行する自車線(図2Bの車線LN2)の一方に隣接し、自車線と進行方向が同じである第1隣接車線(図2Bの車線LN3)を走行する第1他車両(図2Bの他車両102)が認識され、自車両101が第1他車両の側方を通過すると予測されるとき、生成部412により生成された目標軌道を車幅方向に第1他車両と離れる方向に補正するための補正量を算出する算出部413と、認識部411により自車線の他方に隣接する第2隣接車線(図2Bの車線LN1)を走行する第2他車両(図2Bの他車両103)が認識されるとき、第2他車両の走行状況に基づいて、目標軌道を補正するか否かを決定する決定部414と、決定部414により目標軌道を補正すると決定されると、算出部413により算出された補正量に基づいて目標軌道を補正する補正部415と、を備える。これにより、車両の周辺状況に応じた適切な態様で走行軌道を補正することができる。
(2)決定部414は、第2他車両の走行状況に基づいて、補正部415により補正された目標軌道に沿って自車両101が走行したときに第2他車両と最も接近する車幅方向の距離(第1接近距離)および進行方向の距離(第2接近距離)を予測し、予測した第1接近距離または第2接近距離が所定値未満であるとき、目標軌道を補正しないと決定する。これにより、自車両の走行車線の他方に隣接する車線にも他車両が存在するとき、その他車両との接近度合いを考慮して目標軌道を補正するか否かが決定される。よって、車両の周辺状況に応じたより適切な態様で走行軌道を補正することができる。
(3)決定部414は、第2他車両が走行する第2隣接車線が、自車両101が走行する自車線の対向車線(図7Aの車線LN4)であり、自車線と対向車線との間に分離帯(図7Aの中央分離帯MS)が設けられているとき、予測した第1接近距離または第2接近距離が所定値未満であっても自車両101の目標軌道を補正しないと決定する。これにより、自車両の目標軌道の補正が不要に抑制されることを防止できる。よって、車両の周辺状況に応じたより適切な態様で走行軌道を補正できる。
(4)決定部414は、自車両101の第1所定時間先に到達する第1地点と、自車両101が第1所定時間より短い第2所定時間先に到達する第2地点との間の区間を目標軌道の補正対象エリアに設定し、第2所定時間先における第1他車両の位置が補正対象エリアに含まれると予測され、且つ、自車両の第1他車両に対する相対速度が所定速度(第1閾値)以上であるとき、目標軌道を補正すると決定する。また、決定部414は、自車両101の現在位置と第2地点との区間を目標軌道の補正禁止エリアに設定し、第2所定時間先における第1他車両の位置が補正禁止エリアに含まれると予測されるとき、目標軌道を補正しないと決定する。これにより、急な転舵等、急な走行制御の変化により生じる乗員への違和感や不快感が抑制される。さらに、決定部414は、第2所定時間先における第1他車両の位置が補正対象エリアに含まれると予測され、且つ、自車両101の第1他車両に対する相対速度が第1閾値以上であるときであっても、自車両101の第1他車両との衝突余裕時間が第2閾値未満であるときには、目標軌道を補正しないと決定する。これにより、第1他車両の側方を通過するまでに目標軌道の補正が完了しない(間に合わない)ときに補正が行われないようにすることができる。
上記実施形態は種々の形態に変更することができる。以下、変形例について説明する。上記実施形態では、決定部414が、第2所定時間先における第1他車両の位置が補正対象エリアに含まれると予測され、且つ、自車両の第1他車両に対する相対速度が所定速度以上であるとき、目標軌道を補正すると決定するようにしたが、決定部の構成はこれに限定されない。例えば、決定部は、第2所定時間先における第1他車両の位置が補正対象エリアに含まれるか否かを所定時間間隔で予測し、第2所定時間先における第1他車両の位置が所定回数連続で補正対象エリアに含まれると予測されたときに、目標軌道を補正すると決定してもよい。
また、上記実施形態では、上記式(I)により算出される補正量CAに基づいて自車両101の目標軌道を補正するようにしたが、ステップS13で算出された補正量CAが0であるとき、ステップS16に進んで自車両101の目標軌道を補正しないと決定してもよい。
また、上記実施形態では、自車両101の他車両102に対する相対速度が変化しない場合を例にして説明したが、他車両102の速度の変化に合わせて、目標軌道を補正してもよい。例えば、自車両101が図5Bの横移動軌道MVに沿って横移動した後に他車両102の速度が上昇して、自車両101の他車両102に対する相対速度が0となって両車両間の距離が一定の状態が継続するときには、その状態が解消するまで横移動後の位置で走行するように、補正継続軌道を繰り返し生成するようにしてもよい。
また、上記実施形態では、図7Aに示すように自車線LN3と対向車線LN4との間に中央分離帯MSが設けられているときには、ステップS15の判定の結果に依らずに、すなわち、自車両101と対向車線LN4を走行する他車両103との接近度合いに依らずに、他車両102と離れる方向(対向車線LN4側)に目標軌道を補正するようにした。
一方で、図8に示すように、自車線LN3と対向車線LN4との間に分離帯が設けられていないときには、自車両101の目標軌道を他車両102と離れる方向に補正すると、自車両101が対向車線LN4の他車両103と接近したときに乗員に違和感や不快感を与えるおそれがある。そこで、このような問題に対処するため、決定部は、ステップS14で対向車線LN4を走行中の他車両103が自車両101の前方で認識されたとき、自車両と他車両103との距離に基づいて目標軌道を補正するか否かを決定してもよい。
具体的には、決定部は、自車線LN3と対向車線LN4との間に分離帯が設けられていない道路において、認識部411により対向車線LN4を走行中の他車両103が認識されると、その時点における自車両101と他車両103との車幅方向の距離が第3所定値以上であるか否かを判定する。そして、自車両101と他車両103との車幅方向の距離が第3所定値以上であるとき、目標軌道を補正すると決定する。また、決定部は、その時点における自車両101と他車両103との進行方向の距離が第4所定値以上であるか否かを判定する。そして、自車両101と他車両103との進行方向の距離が第4所定値以上であるとき、目標軌道を補正すると決定する。第3所定値および第4所定値は、予め設定されてもよいし、認識部411により認識された他車両103の走行位置や走行速度や走行加速度などに基づいて設定されてもよい。
また、上記実施形態では、自車両101が隣接車線を走行する第1他車両の側方を通過するときに、目標軌道を車幅方向に第1他車両と離れる方向に補正すると他方の隣接車線を走行する第2他車両に接近すると判定されるとき(S15でYES)、目標軌道を補正しないと決定するようにした(S16)。一方、第1他車両が自車両101の側方を通過するときにも、自車両101の目標軌道は車幅方向に第1他車両と離れる方向に補正され、自車両101が他方の隣接車線を走行する第2他車両に接近するおそれがある。このような問題に対処するため、次のように走行制御装置200を構成してもよい。
図9は、本変形例に係る判定エリアの一例を示す図である。決定部414は、認識部411により認識された他車両102に対する相対速度が閾値以上であって、且つ、他車両102の所定時点(現時点よりも先の時点)における位置が判定エリアRLA,RRAに含まれるとき、他車両102が自車両101の側方を通過すると予測し、目標軌道を補正すると決定する。判定エリアRLA,RRAは、前後方向の長さがRDLであり、左右方向の長さがRDWである。RDW,RDLは、DW,DLと同様にして設定されるため説明を省略する。また、判定エリアRLA,RRAは、LA,RAと同様に、2次元のエリアではなく、高さを有する3次元のエリアであってもよい。判定エリアRLA,RRAのうち自車両101の後端部から距離RIL以内のエリアは、補正禁止エリアとして設定される。距離RILは、距離ILと同じ長さであってもよいし、距離ILと異なる値が設定されてもよい。
図10は、他車両が自車両の側方を通過するシーンの一例を示す図である。図10には、車線LN2を走行中である自車両101と、車線LN3を走行中である他車両102とが示されている。なお、自車両101の走行速度は30kphであり、他車両102の走行速度は50kphであるとする。すなわち、他車両102の自車両101に対する相対速度は、20kph(=50kph-30kph)である。図中の実線の矢印線ORは、自車両101の現時点から所定時間T先までの目標軌道を表す。図中の破線で描かれた他車両102Pは、所定時点における他車両102を模式的に表す。なお、所定時点は、現時点よりも第2所定時間(<第1所定時間)先の時点である。また、図5Aと同様に、自車両110から距離RILの位置に境界BDが設定される。
図10に示す例では、他車両102Pの一部が判定エリアRRAに含まれるため、他車両102の自車両101に対する相対速度が閾値以上であるとき、目標軌道ORは、破線の矢印線MVで示される目標軌道に補正される。なお、相対速度とともにTTCを考慮する場合には、目標軌道ORは、相対速度が第1閾値以上であって、TTCが第2閾値未満であるとき、破線の矢印線MVで示される目標軌道に補正される。図中の破線CNは、補正継続軌道を表す。なお、図10では、判定エリアRLAの図示を省略する。
図10に示すように、他車両102が自車両101の側方を通過するとき、自車両101の目標軌道が車幅方向に他車両102と離れる方向に補正される。このとき、他方の隣接車線LN1に他車両が存在すると、該他車両に自車両101が接近するおそれがある。そこで、本変形例では、ステップS12で、自車両101が第1他車両の側方を通過するか否かに加えて、第1他車両が自車両101の側方を通過するか否かを判定する。そして、自車両101が第1他車両の側方を通過すると判定されたとき、または、第1他車両が自車両101の側方を通過すると判定されたとき、ステップS13に移行する。これにより、車両の周辺状況に応じてより適切な態様で走行軌道を補正することができる。
また、上記実施形態では、自車両101が走行する車線LN2の一方に隣接する車線を車線LN3とし、車線LN3を走行する車両102を第1他車両とし、車線LN2の他方に隣接する車線を車線LN1とし、車線LN1を走行する車両103を第2他車両として、車両101の目標軌道を補正する例を説明したが、車線LN2の一方に隣接する車線を車線LN1とし、車線LN1を走行する車両103を第1他車両とし、車線LN2の他方に隣接する車線を車線LN3とし、車線LN3を走行する車両102を第2他車両として、車両101の目標軌道を補正してもよい。
さらに、上記実施形態では、認識部411は、カメラ11からの画像データ等に基づいて自車両101の周辺車両(他車両102,103)やその周辺車両の走行状況を認識したが、認識部の構成はこれに限らない。例えば、認識部は、路車間通信や車車間通信等により通信ユニット37を介して受信される情報に基づいて、自車両101の周辺車両やその周辺車両の走行状況を認識してもよい。
以上の説明はあくまで一例であり、本発明の特徴を損なわない限り、上述した実施形態および変形例により本発明が限定されるものではない。上記実施形態と変形例の一つまたは複数を任意に組み合わせることも可能であり、変形例同士を組み合わせることも可能である。
10 車両制御装置、11 カメラ、12 レーダ、13 ライダ、40 コントローラ、200 走行制御装置、411 認識部、412 生成部、413 算出部、414 決定部、415 補正部
Claims (7)
- 自車両の周辺状況を認識する認識部と、
前記認識部により認識された周辺状況に応じて、前記自車両の目標軌道を生成する生成部と、
前記認識部により前記自車両が走行する自車線の一方に隣接し、前記自車線と進行方向が同じである第1隣接車線を走行する第1他車両が認識され、前記自車両が前記第1他車両の側方を通過すると予測されるとき、または、前記第1他車両が前記自車両の側方を通過すると予測されるとき、前記生成部により生成された目標軌道を車幅方向に前記第1他車両と離れる方向に補正するための補正量を算出する算出部と、
前記認識部により前記自車線の他方に隣接する第2隣接車線を走行する第2他車両が認識されるとき、前記第2他車両の走行状況に基づいて、前記目標軌道を補正するか否かを決定する決定部と、
前記決定部により前記目標軌道を補正すると決定されると、前記算出部により算出された補正量に基づいて前記目標軌道を補正する補正部と、を備えることを特徴とする走行制御装置。 - 請求項1に記載の走行制御装置において、
前記決定部は、前記第2他車両の走行状況に基づいて、前記補正部により補正された前記目標軌道に沿って前記自車両が走行したときの前記自車両と前記第2他車両との車幅方向および進行方向の距離を予測し、予測した前記自車両と前記第2他車両との車幅方向の距離が第1所定値以上、または、予測した前記自車両と前記第2他車両との進行方向の距離が第2所定値以上であるとき、前記目標軌道を補正すると決定し、予測した前記自車両と前記第2他車両との車幅方向の距離が前記第1所定値未満、かつ、予測した前記自車両と前記第2他車両との進行方向の距離が前記第2所定値未満になるとき、前記目標軌道を補正しないと決定することを特徴とする走行制御装置。 - 請求項2に記載の走行制御装置において、
前記決定部は、前記第2隣接車線が前記自車線の対向車線であり、前記自車線と前記第2隣接車線との間に分離帯が設けられているとき、予測した前記自車両と前記第2他車両との車幅方向の距離が前記第1所定値未満、かつ、予測した前記自車両と前記第2他車両との進行方向の距離が前記第2所定値未満になるときでも、前記目標軌道を補正すると決定することを特徴とする走行制御装置。 - 請求項2に記載の走行制御装置において、
前記決定部は、前記第2隣接車線が前記自車線の対向車線であって、前記認識部により前記第2他車両が認識されたときの前記自車両と前記第2他車両との車幅方向の距離が第3所定値以上、または、前記認識部により前記第2他車両が認識されたときの前記自車両と前記第2他車両との進行方向の距離が第4所定値以上であるとき、前記目標軌道を補正すると決定することを特徴とする走行制御装置。 - 請求項1から4のうちのいずれか1項に記載の走行制御装置において、
前記決定部は、前記自車両が第1所定時間先に到達する第1地点と、前記自車両が前記第1所定時間より短い第2所定時間先に到達する第2地点との間の区間を前記目標軌道の補正対象エリアに設定し、前記第2所定時間先における前記第1他車両の位置が前記補正対象エリアに含まれると予測され、且つ、前記自車両の前記第1他車両に対する相対速度が所定速度以上であるとき、前記目標軌道を補正すると決定することを特徴とする走行制御装置。 - 請求項5に記載の走行制御装置において、
前記所定速度が第1閾値であり、
前記決定部は、前記第2所定時間先における前記第1他車両の位置が前記補正対象エリアに含まれると予測され、且つ、前記自車両の前記第1他車両に対する相対速度が前記第1閾値以上であるときであっても、前記自車両の前記第1他車両との衝突余裕時間が第2閾値未満であるときには、前記目標軌道を補正しないと決定することを特徴とする走行制御装置。 - 請求項5または6に記載の走行制御装置において、
前記決定部はさらに、前記自車両の現在位置と前記第2地点との間の区間を前記目標軌道の補正禁止エリアに設定し、前記第2所定時間先における前記第1他車両の位置が前記補正禁止エリアに含まれると予測されるとき、前記目標軌道を補正しないと決定することを特徴とする走行制御装置。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US17/578,348 US20220234576A1 (en) | 2021-01-25 | 2022-01-18 | Travel control apparatus |
CN202210080321.1A CN114889601A (zh) | 2021-01-25 | 2022-01-24 | 行驶控制装置 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021009538 | 2021-01-25 | ||
JP2021009538 | 2021-01-25 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2022113644A true JP2022113644A (ja) | 2022-08-04 |
Family
ID=82658267
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021203418A Pending JP2022113644A (ja) | 2021-01-25 | 2021-12-15 | 走行制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2022113644A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102023115962A1 (de) | 2022-07-15 | 2024-01-18 | Tdk Corporation | Magnetsensor und motorzusammenbau |
-
2021
- 2021-12-15 JP JP2021203418A patent/JP2022113644A/ja active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102023115962A1 (de) | 2022-07-15 | 2024-01-18 | Tdk Corporation | Magnetsensor und motorzusammenbau |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3822142A1 (en) | Confidence levels along the same predicted trajectory of an obstacle | |
US11130492B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
US11498563B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
CN110356402B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
US11225249B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
US20160325750A1 (en) | Travel control apparatus | |
JP6327424B2 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
US20190278285A1 (en) | Vehicle control device, vehicle control method, and storage medium | |
US11390284B2 (en) | Vehicle controller, vehicle control method, and storage medium | |
US11505193B2 (en) | Vehicle control apparatus, vehicle control method, and storage medium | |
US20220250619A1 (en) | Traveling assist apparatus | |
WO2020031238A1 (ja) | 車両制御方法及び車両制御装置 | |
US11661064B2 (en) | Travel control apparatus and travel control method | |
JP2022113644A (ja) | 走行制御装置 | |
US20220234576A1 (en) | Travel control apparatus | |
RU2771332C1 (ru) | Способ управления транспортным средством и устройство управления транспортным средством | |
CN114194186B (zh) | 车辆行驶控制装置 | |
CN114987529A (zh) | 地图生成装置 | |
JP2021109576A (ja) | 車両の走行支援方法および走行支援装置 | |
WO2023152944A1 (ja) | 運転支援装置 | |
JP2020040515A (ja) | 車両走行制御装置 | |
US20230311938A1 (en) | Vehicle control device, vehicle control method, and storage medium | |
US20230311886A1 (en) | Vehicle control device, vehicle control method, and storage medium | |
US20230316778A1 (en) | Vehicle control device, vehicle control method, and storage medium | |
US20230311939A1 (en) | Vehicle control device, vehicle control method, and storage medium |