(19)【発行国】日本国特許庁(JP)
(12)【公報種別】公開特許公報(A)
(11)【公開番号】P2024025174
(43)【公開日】2024-02-26
(54)【発明の名称】車両制御装置、車両制御方法、およびプログラム
(51)【国際特許分類】
B60W 30/12 20200101AFI20240216BHJP
B60W 40/02 20060101ALI20240216BHJP
B60W 60/00 20200101ALI20240216BHJP
G08G 1/16 20060101ALI20240216BHJP
【FI】
B60W30/12
B60W40/02
B60W60/00
G08G1/16 C
【審査請求】有
【請求項の数】14
【出願形態】OL
(21)【出願番号】P 2022128410
(22)【出願日】2022-08-10
(11)【特許番号】
(45)【特許公報発行日】2024-01-30
(71)【出願人】
【識別番号】000005326
【氏名又は名称】本田技研工業株式会社
(74)【代理人】
【識別番号】100165179
【弁理士】
【氏名又は名称】田▲崎▼ 聡
(74)【代理人】
【識別番号】100126664
【弁理士】
【氏名又は名称】鈴木 慎吾
(74)【代理人】
【識別番号】100154852
【弁理士】
【氏名又は名称】酒井 太一
(74)【代理人】
【識別番号】100194087
【弁理士】
【氏名又は名称】渡辺 伸一
(72)【発明者】
【氏名】田村 貴生
(72)【発明者】
【氏名】田村 祥
【テーマコード(参考)】
3D241
5H181
【Fターム(参考)】
3D241BA12
3D241BA29
3D241DB01Z
3D241DC01Z
3D241DC41Z
5H181AA01
5H181AA05
5H181BB04
5H181BB05
5H181CC03
5H181CC04
5H181CC12
5H181CC14
5H181FF05
5H181FF22
(57)【要約】
【課題】走行車線の中心線に基づいた運転制御を好適に実行すること。
【解決手段】車両の周辺状況を認識する認識部と、前記周辺状況と地図情報に基づいて、前記車両の運転者の操作に依らずに前記車両の操舵および加減速を制御する運転制御部と、前記車両の運転モードを、第1の運転モードと、第2の運転モードとを含む複数の運転モードのいずれかに決定するモード決定部と、判定角度が第1閾値以上であるか否かと、判定距離が第2閾値以上であるか否かと、前記車両の前方領域が所定領域に該当しないか否かを判定する判定部と、を備え、前記モード決定部は、前記判定部によって、前記判定角度が前記第1閾値以上であり、かつ前記判定距離が前記第2閾値以上であり、かつ前記前方領域が前記所定領域に該当しないと判定された場合、前記第2の運転モードを、前記周辺状況に含まれるカメラ道路区画線に基づく前記第1の運転モードに変更する、車両制御装置。
【選択図】
図1
【特許請求の範囲】
【請求項1】
車両の周辺状況を認識する認識部と、
前記周辺状況と地図情報に基づいて、前記車両の運転者の操作に依らずに前記車両の操舵および加減速を制御する運転制御部と、
前記車両の運転モードを、第1の運転モードと、第2の運転モードとを含む複数の運転モードのいずれかに決定し、前記第2の運転モードは前記運転者に課されるタスクが前記第1の運転モードに比して軽度な運転モードであり、少なくとも前記第2の運転モードを含む前記複数の運転モードの一部は前記運転制御部により制御されるものであり、前記決定した運転モードに係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに前記車両の運転モードを変更するモード決定部と、
前記地図情報に含まれる地図道路区画線と地図道路中心線との間の角度に基づく判定角度が第1閾値以上であるか否かと、前記地図道路区画線と前記地図道路中心線との間の距離に基づく判定距離が第2閾値以上であるか否かと、前記車両の前方領域が所定領域に該当しないか否かを判定する判定部と、を備え、
前記モード決定部は、前記判定部によって、前記判定角度が前記第1閾値以上であり、かつ前記判定距離が前記第2閾値以上であり、かつ前記前方領域が前記所定領域に該当しないと判定された場合、前記第2の運転モードを、前記周辺状況に含まれるカメラ道路区画線に基づく前記第1の運転モードに変更する、
車両制御装置。
【請求項2】
前記判定部は、前記判定角度を、左側の前記地図道路区画線と前記地図道路中心線との間の角度の平均値と、右側の前記地図道路区画線と前記地図道路中心線との間の角度の平均値との合計値として定義する、
請求項1に記載の車両制御装置。
【請求項3】
前記判定部は、前記判定角度を、左側の前記地図道路区画線と前記地図道路中心線との間の角度のピーク値と、右側の前記地図道路区画線と前記地図道路中心線との間の角度のピーク値とのうちの少なくとも一方として定義する、
請求項1に記載の車両制御装置。
【請求項4】
前記モード決定部は、前記判定角度が、前記第1閾値以上かつ前記第1閾値より大きい第3閾値以下であるか否かを判定し、前記判定角度が、前記第1閾値以上かつ前記第3閾値以下であると判定された場合、前記カメラ道路区画線に基づく前記第2の運転モードを継続する、
請求項1から3のいずれか1項に記載の車両制御装置。
【請求項5】
前記モード決定部は、前記判定角度が、前記第1閾値以上かつ前記第3閾値以下であると判定された場合、前記地図道路区画線と前記カメラ道路区画線の少なくとも一部が一致するか否かを判定し、前記地図道路区画線と前記カメラ道路区画線の少なくとも一部が一致すると判定された場合、前記カメラ道路区画線に基づく前記第2の運転モードを継続する、
請求項4に記載の車両制御装置。
【請求項6】
前記モード決定部は、前記地図道路区画線と前記カメラ道路区画線の少なくとも一部が一致しないと判定された場合であっても、前記車両の前方に先行車両が存在する場合、前記先行車両の走行軌跡に少なくとも基づく前記第2の運転モードを継続する、
請求項5に記載の車両制御装置。
【請求項7】
前記判定部は、前記判定距離を、左側の前記地図道路区画線と前記地図道路中心線との間の距離と、右側の前記地図道路区画線と前記地図道路中心線との間の距離とのうちの少なくとも一方として定義する、
請求項1に記載の車両制御装置。
【請求項8】
前記判定部は、前記所定領域を、前記車両が走行する走行車線における、車線増加区間、車線減少区間、または走路曲率が所定値以上の区間として定義する、
請求項1に記載の車両制御装置。
【請求項9】
前記判定部は、前記地図情報に含まれる地図道路区画線および地図道路中心線を構成する点群に含まれる点の個数が所定数以上の場合、前記点群に基づいて、前記判定角度および前記判定距離を算出する、
請求項1に記載の車両制御装置。
【請求項10】
前記モード決定部は、前記第2の運転モードを、前記カメラ道路区画線に基づく前記第1の運転モードに変更した場合、前記カメラ道路区画線に基づく前記第1の運転モードを少なくとも第1所定期間継続させる、
請求項1に記載の車両制御装置。
【請求項11】
前記モード決定部は、前記カメラ道路区画線に基づく前記第1の運転モードを前記第1所定期間継続させた後に、前記判定角度が前記第1閾値未満であり、かつ前記判定距離が前記第2閾値未満であると判定された場合、前記カメラ道路区画線に基づく前記第1の運転モードを前記地図道路区画線に基づく前記第2の運転モードに復帰させる、
請求項1に記載の車両制御装置。
【請求項12】
前記モード決定部は、前記カメラ道路区画線に基づく前記第1の運転モードを第2所定期間継続させた後に、前記判定角度が前記第1閾値以上であるか、又は前記判定距離が前記第2閾値以上であると判定された場合、前記第1の運転モードを、前記車両の乗員による前記車両の手動運転に遷移させる、
請求項1に記載の車両制御装置。
【請求項13】
コンピュータが、
車両の周辺状況を認識し、
前記周辺状況と地図情報に基づいて、前記車両の運転者の操作に依らずに前記車両の操舵および加減速を制御し、
前記車両の運転モードを、第1の運転モードと、第2の運転モードとを含む複数の運転モードのいずれかに決定し、前記第2の運転モードは前記運転者に課されるタスクが前記第1の運転モードに比して軽度な運転モードであり、少なくとも前記第2の運転モードを含む前記複数の運転モードの一部が制御されるものであり、前記決定した運転モードに係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに前記車両の運転モードを変更し、
前記地図情報に含まれる地図道路区画線と地図道路中心線との間の判定角度が第1閾値以上であるか否かと、前記地図道路区画線と前記地図道路中心線との間の判定距離が第2閾値以上であるか否かと、前記車両の前方領域が所定領域に該当しないか否かを判定し、
前記判定角度が前記第1閾値以上であり、かつ前記判定距離が前記第2閾値以上であり、かつ前記前方領域が前記所定領域に該当しないと判定された場合、前記第2の運転モードを、前記周辺状況に含まれるカメラ道路区画線に基づく前記第1の運転モードに変更する、
車両制御方法。
【請求項14】
コンピュータに、
車両の周辺状況を認識させ、
前記周辺状況と地図情報に基づいて、前記車両の運転者の操作に依らずに前記車両の操舵および加減速を制御させ、
前記車両の運転モードを、第1の運転モードと、第2の運転モードとを含む複数の運転モードのいずれかに決定させ、前記第2の運転モードは前記運転者に課されるタスクが前記第1の運転モードに比して軽度な運転モードであり、少なくとも前記第2の運転モードを含む前記複数の運転モードの一部が制御されるものであり、前記決定した運転モードに係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに前記車両の運転モードを変更させ、
前記地図情報に含まれる地図道路区画線と地図道路中心線との間の判定角度が第1閾値以上であるか否かと、前記地図道路区画線と前記地図道路中心線との間の判定距離が第2閾値以上であるか否かと、前記車両の前方領域が所定領域に該当しないか否かを判定させ、
前記判定角度が前記第1閾値以上であり、かつ前記判定距離が前記第2閾値以上であり、かつ前記前方領域が前記所定領域に該当しないと判定された場合、前記第2の運転モードを、前記周辺状況に含まれるカメラ道路区画線に基づく前記第1の運転モードに変更させる、
プログラム。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、車両制御装置、車両制御方法、およびプログラムに関する。
【背景技術】
【0002】
従来、車両に搭載されたカメラによって撮像されたカメラ区画線情報と、地図区画線情報とに基づいて車両を制御する技術が知られている。例えば、特許文献1には、カメラ区画線情報と地図区画線情報とが一致している場合はカメラ区画線情報によりレーンキープ制御を行う一方、カメラ区画線情報と地図区画線情報とが一致していない場合は、前回のカメラ区画線情報と地図区画線情報によりレーンキープ制御を行うことが記載されている。
【先行技術文献】
【特許文献】
【0003】
【発明の概要】
【発明が解決しようとする課題】
【0004】
しかしながら、従来技術は、カメラ区画線情報と地図区画線情報との一致度合いを検証して車両の運転制御を実行するものの、走行車線の中心線を検証して運転制御を実施するものではなかった。その結果、走行車線の中心線に基づいた運転制御を好適に実行できない場合があった。
【0005】
本発明は、このような事情を考慮してなされたものであり、走行車線の中心線に基づいた運転制御を好適に実行することができる車両制御装置、車両制御方法、およびプログラムを提供することを目的の一つとする。
【課題を解決するための手段】
【0006】
この発明に係る車両制御装置、車両制御方法、およびプログラムは、以下の構成を採用した。
(1):この発明の一態様に係る車両制御装置は、車両の周辺状況を認識する認識部と、前記周辺状況と地図情報に基づいて、前記車両の運転者の操作に依らずに前記車両の操舵および加減速を制御する運転制御部と、前記車両の運転モードを、第1の運転モードと、第2の運転モードとを含む複数の運転モードのいずれかに決定し、前記第2の運転モードは前記運転者に課されるタスクが前記第1の運転モードに比して軽度な運転モードであり、少なくとも前記第2の運転モードを含む前記複数の運転モードの一部は前記運転制御部により制御されるものであり、前記決定した運転モードに係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに前記車両の運転モードを変更するモード決定部と、前記地図情報に含まれる地図道路区画線と地図道路中心線との間の角度に基づく判定角度が第1閾値以上であるか否かと、前記地図道路区画線と前記地図道路中心線との間の距離に基づく判定距離が第2閾値以上であるか否かと、前記車両の前方領域が所定領域に該当しないか否かを判定する判定部と、を備え、前記モード決定部は、前記判定部によって、前記判定角度が前記第1閾値以上であり、かつ前記判定距離が前記第2閾値以上であり、かつ前記前方領域が前記所定領域に該当しないと判定された場合、前記第2の運転モードを、前記周辺状況に含まれるカメラ道路区画線に基づく前記第1の運転モードに変更するものである。
【0007】
(2):上記(1)の態様において、前記判定部は、前記判定角度を、左側の前記地図道路区画線と前記地図道路中心線との間の角度の平均値と、右側の前記地図道路区画線と前記地図道路中心線との間の角度の平均値との合計値として定義するものである。
【0008】
(3):上記(1)の態様において、前記判定部は、前記判定角度を、左側の前記地図道路区画線と前記地図道路中心線との間の角度のピーク値と、右側の前記地図道路区画線と前記地図道路中心線との間の角度のピーク値とのうちの少なくとも一方として定義するものである。
【0009】
(4):上記(1)から(3)のいずれかの態様において、前記モード決定部は、前記判定角度が、前記第1閾値以上かつ前記第1閾値より大きい第3閾値以下であるか否かを判定し、前記判定角度が、前記第1閾値以上かつ前記第3閾値以下であると判定された場合、前記カメラ道路区画線に基づく前記第2の運転モードを継続するものである。
【0010】
(5):上記(4)の態様において、前記判定部は、前記判定角度が、前記第1閾値以上かつ前記第3閾値以下であると判定された場合、前記地図道路区画線と前記カメラ道路区画線の少なくとも一部が一致するか否かを判定し、前記モード決定部は、前記判定部によって、前記地図道路区画線と前記カメラ道路区画線の少なくとも一部が一致すると判定された場合、前記カメラ道路区画線に基づく前記第2の運転モードを継続するものである。
【0011】
(6):上記(5)の態様において、前記モード決定部は、前記地図道路区画線と前記カメラ道路区画線の少なくとも一部が一致しないと判定された場合であっても、前記車両の前方に先行車両が存在する場合、前記先行車両の走行軌跡に少なくとも基づく前記第2の運転モードを継続するものである。
【0012】
(7):上記(1)の態様において、前記判定部は、前記判定距離を、左側の前記地図道路区画線と前記地図道路中心線との間の距離と、右側の前記地図道路区画線と前記地図道路中心線との間の距離とのうちの少なくとも一方として定義するものである。
【0013】
(8):上記(1)の態様において、前記判定部は、前記所定領域を、前記車両が走行する走行車線における、車線増加区間、車線減少区間、または走路曲率が所定値以上の区間として定義するものである。
【0014】
(9):上記(1)の態様において、前記判定部は、前記地図情報に含まれる地図道路区画線および地図道路中心線を構成する点群に含まれる点の個数が所定数以上の場合、前記点群に基づいて、前記判定角度および前記判定距離を算出するものである。
【0015】
(10):上記(1)の態様において、前記モード決定部は、前記第2の運転モードを、前記カメラ道路区画線に基づく前記第1の運転モードに変更した場合、前記カメラ道路区画線に基づく前記第1の運転モードを少なくとも第1所定期間継続させるものである。
【0016】
(11):上記(1)の態様において、前記モード決定部は、前記カメラ道路区画線に基づく前記第1の運転モードを前記第1所定期間継続させた後に、前記判定角度が前記第1閾値未満であり、かつ前記判定距離が前記第2閾値未満であると判定された場合、前記カメラ道路区画線に基づく前記第1の運転モードを前記地図道路区画線に基づく前記第2の運転モードに復帰させるものである。
【0017】
(12):上記(1)の態様において、前記モード決定部は、前記カメラ道路区画線に基づく前記第1の運転モードを第2所定期間継続させた後に、前記判定角度が前記第1閾値以上であるか、又は前記判定距離が前記第2閾値以上であると判定された場合、前記第1の運転モードを、前記車両の乗員による前記車両の手動運転に遷移させるものである。
【0018】
(13):この発明の別の態様に係る車両制御方法は、コンピュータが、車両の周辺状況を認識し、前記周辺状況と地図情報に基づいて、前記車両の運転者の操作に依らずに前記車両の操舵および加減速を制御し、前記車両の運転モードを、第1の運転モードと、第2の運転モードとを含む複数の運転モードのいずれかに決定し、前記第2の運転モードは前記運転者に課されるタスクが前記第1の運転モードに比して軽度な運転モードであり、少なくとも前記第2の運転モードを含む前記複数の運転モードの一部が制御されるものであり、前記決定した運転モードに係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに前記車両の運転モードを変更し、前記地図情報に含まれる地図道路区画線と地図道路中心線との間の判定角度が第1閾値以上であるか否かと、前記地図道路区画線と前記地図道路中心線との間の判定距離が第2閾値以上であるか否かと、前記車両の前方領域が所定領域に該当しないか否かを判定し、前記判定角度が前記第1閾値以上であり、かつ前記判定距離が前記第2閾値以上であり、かつ前記前方領域が前記所定領域に該当しないと判定された場合、前記第2の運転モードを、前記周辺状況に含まれるカメラ道路区画線に基づく前記第1の運転モードに変更するものである。
【0019】
(14):この発明の別の態様に係るプログラムは、コンピュータに、車両の周辺状況を認識させ、前記周辺状況と地図情報に基づいて、前記車両の運転者の操作に依らずに前記車両の操舵および加減速を制御させ、前記車両の運転モードを、第1の運転モードと、第2の運転モードとを含む複数の運転モードのいずれかに決定させ、前記第2の運転モードは前記運転者に課されるタスクが前記第1の運転モードに比して軽度な運転モードであり、少なくとも前記第2の運転モードを含む前記複数の運転モードの一部が制御されるものであり、前記決定した運転モードに係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに前記車両の運転モードを変更させ、前記地図情報に含まれる地図道路区画線と地図道路中心線との間の判定角度が第1閾値以上であるか否かと、前記地図道路区画線と前記地図道路中心線との間の判定距離が第2閾値以上であるか否かと、前記車両の前方領域が所定領域に該当しないか否かを判定させ、前記判定角度が前記第1閾値以上であり、かつ前記判定距離が前記第2閾値以上であり、かつ前記前方領域が前記所定領域に該当しないと判定された場合、前記第2の運転モードを、前記周辺状況に含まれるカメラ道路区画線に基づく前記第1の運転モードに変更させるものである。
【発明の効果】
【0020】
(1)~(14)の態様によれば、走行車線の中心線に基づいた運転制御を好適に実行することができる。
【図面の簡単な説明】
【0021】
【
図1】実施形態に係る車両制御装置を利用した車両システムの構成図である。
【
図2】第1制御部および第2制御部の機能構成図である。
【
図3】運転モードと自車両の制御状態、およびタスクの対応関係の一例を示す図である。
【
図4】実施形態に係る車両制御装置の動作が実行される場面の一例を示す図である。
【
図5】判定部156によって実行される判定処理を説明するための図である。
【
図6】モード決定部150によって実行されるモード変更処理の一例を示す図である。
【
図7】実施形態に係る車両制御装置によって実行される処理の流れの一例を示すフローチャートである。
【
図8】実施形態に係る車両制御装置によって実行される処理の流れの別の例を示すフローチャートである。
【発明を実施するための形態】
【0022】
以下、図面を参照し、本発明の車両制御装置、車両制御方法、およびプログラムの実施形態について説明する。
【0023】
[全体構成]
図1は、実施形態に係る車両制御装置を利用した車両システム1の構成図である。車両システム1が搭載される車両は、例えば、二輪や三輪、四輪等の車両であり、その駆動源は、ディーゼルエンジンやガソリンエンジンなどの内燃機関、電動機、或いはこれらの組み合わせである。電動機は、内燃機関に連結された発電機による発電電力、或いは二次電池や燃料電池の放電電力を使用して動作する。
【0024】
車両システム1は、例えば、カメラ10と、レーダ装置12と、LIDAR(Light Detection and Ranging)14と、物体認識装置16と、通信装置20と、HMI(Human Machine Interface)30と、車両センサ40と、ナビゲーション装置50と、MPU(Map Positioning Unit)60と、ドライバモニタカメラ70と、運転操作子80と、自動運転制御装置100と、走行駆動力出力装置200と、ブレーキ装置210と、ステアリング装置220とを備える。これらの装置や機器は、CAN(Controller Area Network)通信線等の多重通信線やシリアル通信線、無線通信網等によって互いに接続される。なお、
図1に示す構成はあくまで一例であり、構成の一部が省略されてもよいし、更に別の構成が追加されてもよい。
【0025】
カメラ10は、例えば、CCD(Charge Coupled Device)やCMOS(Complementary Metal Oxide Semiconductor)等の固体撮像素子を利用したデジタルカメラである。カメラ10は、車両システム1が搭載される車両(以下、自車両M)の任意の箇所に取り付けられる。前方を撮像する場合、カメラ10は、フロントウインドシールド上部やルームミラー裏面等に取り付けられる。カメラ10は、例えば、周期的に繰り返し自車両Mの周辺を撮像する。カメラ10は、ステレオカメラであってもよい。
【0026】
レーダ装置12は、自車両Mの周辺にミリ波などの電波を放射すると共に、物体によって反射された電波(反射波)を検出して少なくとも物体の位置(距離および方位)を検出する。レーダ装置12は、自車両Mの任意の箇所に取り付けられる。レーダ装置12は、FM-CW(Frequency Modulated Continuous Wave)方式によって物体の位置および速度を検出してもよい。
【0027】
LIDAR14は、自車両Mの周辺に光(或いは光に近い波長の電磁波)を照射し、散乱光を測定する。LIDAR14は、発光から受光までの時間に基づいて、対象までの距離を検出する。照射される光は、例えば、パルス状のレーザー光である。LIDAR14は、自車両Mの任意の箇所に取り付けられる。
【0028】
物体認識装置16は、カメラ10、レーダ装置12、およびLIDAR14のうち一部または全部による検出結果に対してセンサフュージョン処理を行って、物体の位置、種類、速度などを認識する。物体認識装置16は、認識結果を自動運転制御装置100に出力する。物体認識装置16は、カメラ10、レーダ装置12、およびLIDAR14の検出結果をそのまま自動運転制御装置100に出力してよい。車両システム1から物体認識装置16が省略されてもよい。
【0029】
通信装置20は、例えば、セルラー網やWi-Fi網、Bluetooth(登録商標)、DSRC(Dedicated Short Range Communication)などを利用して、自車両Mの周辺に存在する他車両と通信し、或いは無線基地局を介して各種サーバ装置と通信する。
【0030】
HMI30は、自車両Mの乗員に対して各種情報を提示すると共に、乗員による入力操作を受け付ける。HMI30は、各種表示装置、スピーカ、ブザー、タッチパネル、スイッチ、キーなどを含む。
【0031】
車両センサ40は、自車両Mの速度を検出する車速センサ、加速度を検出する加速度センサ、鉛直軸回りの角速度を検出するヨーレートセンサ、自車両Mの向きを検出する方位センサ等を含む。
【0032】
ナビゲーション装置50は、例えば、GNSS(Global Navigation Satellite System)受信機51と、ナビHMI52と、経路決定部53とを備える。ナビゲーション装置50は、HDD(Hard Disk Drive)やフラッシュメモリなどの記憶装置に第1地図情報54を保持している。GNSS受信機51は、GNSS衛星から受信した信号に基づいて、自車両Mの位置を特定する。自車両Mの位置は、車両センサ40の出力を利用したINS(Inertial Navigation System)によって特定または補完されてもよい。ナビHMI52は、表示装置、スピーカ、タッチパネル、キーなどを含む。ナビHMI52は、前述したHMI30と一部または全部が共通化されてもよい。経路決定部53は、例えば、GNSS受信機51により特定された自車両Mの位置(或いは入力された任意の位置)から、ナビHMI52を用いて乗員により入力された目的地までの経路(以下、地図上経路)を、第1地図情報54を参照して決定する。第1地図情報54は、例えば、道路を示すリンクと、リンクによって接続されたノードとによって道路形状が表現された情報である。第1地図情報54は、道路の曲率やPOI(Point Of Interest)情報などを含んでもよい。地図上経路は、MPU60に出力される。ナビゲーション装置50は、地図上経路に基づいて、ナビHMI52を用いた経路案内を行ってもよい。ナビゲーション装置50は、例えば、乗員の保有するスマートフォンやタブレット端末等の端末装置の機能によって実現されてもよい。ナビゲーション装置50は、通信装置20を介してナビゲーションサーバに現在位置と目的地を送信し、ナビゲーションサーバから地図上経路と同等の経路を取得してもよい。
【0033】
MPU60は、例えば、推奨車線決定部61を含み、HDDやフラッシュメモリなどの記憶装置に第2地図情報62を保持している。推奨車線決定部61は、ナビゲーション装置50から提供された地図上経路を複数のブロックに分割し(例えば、車両進行方向に関して100[m]毎に分割し)、第2地図情報62を参照してブロックごとに推奨車線を決定する。推奨車線決定部61は、左から何番目の車線を走行するといった決定を行う。推奨車線決定部61は、地図上経路に分岐箇所が存在する場合、自車両Mが、分岐先に進行するための合理的な経路を走行できるように、推奨車線を決定する。
【0034】
第2地図情報62は、第1地図情報54よりも高精度な地図情報である。第2地図情報62は、例えば、車線の中央の情報あるいは車線の境界の情報等を含んでいる。特に、本実施形態において、第2地図情報62は、車線における左右の道路区画線(以下、「地図道路区画線」と称する場合がある)および車線の中心線(以下、「地図道路中心線」と称する場合がある)に関する情報を含む。また、第2地図情報62には、道路情報、交通規制情報、住所情報(住所・郵便番号)、施設情報、電話番号情報、後述するモードAまたはモードBが禁止される禁止区間の情報などが含まれてよい。第2地図情報62は、通信装置20が他装置と通信することにより、随時、アップデートされてよい。
【0035】
ドライバモニタカメラ70は、例えば、CCDやCMOS等の固体撮像素子を利用したデジタルカメラである。ドライバモニタカメラ70は、自車両Mの運転席に着座した乗員(以下、運転者)の頭部を正面から(顔面を撮像する向きで)撮像可能な位置および向きで、自車両Mにおける任意の箇所に取り付けられる。例えば、ドライバモニタカメラ70は、自車両Mのインストルメントパネルの中央部に設けられたディスプレイ装置の上部に取り付けられる。
【0036】
運転操作子80は、例えば、ステアリングホイール82の他、アクセルペダル、ブレーキペダル、シフトレバー、その他の操作子を含む。運転操作子80には、操作量あるいは操作の有無を検出するセンサが取り付けられており、その検出結果は、自動運転制御装置100、もしくは、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220のうち一部または全部に出力される。ステアリングホイール82は、「運転者による操舵操作を受け付ける操作子」の一例である。操作子は、必ずしも環状である必要は無く、異形ステアやジョイスティック、ボタンなどの形態であってもよい。ステアリングホイール82には、ステアリング把持センサ84が取り付けられている。ステアリング把持センサ84は、静電容量センサなどにより実現され、運転者がステアリングホイール82を把持している(力を加えられる状態で接していることをいう)か否かを検知可能な信号を自動運転制御装置100に出力する。
【0037】
自動運転制御装置100は、例えば、第1制御部120と、第2制御部160とを備える。第1制御部120と第2制御部160は、それぞれ、例えば、CPU(Central Processing Unit)などのハードウェアプロセッサがプログラム(ソフトウェア)を実行することにより実現される。また、これらの構成要素のうち一部または全部は、LSI(Large Scale Integration)やASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)、GPU(Graphics Processing Unit)などのハードウェア(回路部;circuitryを含む)によって実現されてもよいし、ソフトウェアとハードウェアの協働によって実現されてもよい。プログラムは、予め自動運転制御装置100のHDDやフラッシュメモリなどの記憶装置(非一過性の記憶媒体を備える記憶装置)に格納されていてもよいし、DVDやCD-ROMなどの着脱可能な記憶媒体に格納されており、記憶媒体(非一過性の記憶媒体)がドライブ装置に装着されることで自動運転制御装置100のHDDやフラッシュメモリにインストールされてもよい。自動運転制御装置100は「車両制御装置」の一例であり、行動計画生成部140と第2制御部160を合わせたものが「運転制御部」の一例である。
【0038】
図2は、第1制御部120および第2制御部160の機能構成図である。第1制御部120は、例えば、認識部130と、行動計画生成部140と、モード決定部150とを備える。第1制御部120は、例えば、AI(Artificial Intelligence;人工知能)による機能と、予め与えられたモデルによる機能とを並行して実現する。例えば、「交差点を認識する」機能は、ディープラーニング等による交差点の認識と、予め与えられた条件(パターンマッチング可能な信号、道路標示などがある)に基づく認識とが並行して実行され、双方に対してスコア付けして総合的に評価することで実現されてよい。これによって、自動運転の信頼性が担保される。
【0039】
認識部130は、カメラ10、レーダ装置12、およびLIDAR14から物体認識装置16を介して入力された情報に基づいて、自車両Mの周辺にある物体の位置、および速度、加速度等の状態を認識する。物体の位置は、例えば、自車両Mの代表点(重心や駆動軸中心など)を原点とした絶対座標上の位置として認識され、制御に使用される。物体の位置は、その物体の重心やコーナー等の代表点で表されてもよいし、領域で表されてもよい。物体の「状態」とは、物体の加速度やジャーク、あるいは「行動状態」(例えば車線変更をしている、またはしようとしているか否か)を含んでもよい。
【0040】
また、認識部130は、例えば、自車両Mが走行している車線(走行車線)を認識する。例えば、認識部130は、第2地図情報62から得られる道路区画線のパターン(例えば実線と破線の配列)と、カメラ10によって撮像された画像から認識される自車両Mの周辺の道路区画線のパターンとを比較することで、走行車線を認識する。なお、認識部130は、道路区画線に限らず、道路区画線や路肩、縁石、中央分離帯、ガードレールなどを含む走路境界(道路境界)を認識することで、走行車線を認識してもよい。特に、本実施形態において、認識部130は、カメラ10によって撮像された画像に基づいて、車線における左右の道路区画線(以下、「カメラ道路区画線」と称する場合がある)および車線の中心線(以下、「カメラ道路中心線」と称する場合がある)を認識するものとする。カメラ道路中心線は、左右のカメラ道路区画線の中心線として認識されるものである。この認識において、ナビゲーション装置50から取得される自車両Mの位置やINSによる処理結果が加味されてもよい。また、認識部130は、一時停止線、障害物、赤信号、料金所、その他の道路事象を認識する。
【0041】
認識部130は、走行車線を認識する際に、走行車線に対する自車両Mの位置や姿勢を認識する。認識部130は、例えば、自車両Mの基準点の車線中央からの乖離、および自車両Mの進行方向の車線中央を連ねた線に対してなす角度を、走行車線に対する自車両Mの相対位置および姿勢として認識してもよい。これに代えて、認識部130は、走行車線のいずれかの側端部(道路区画線または道路境界)に対する自車両Mの基準点の位置などを、走行車線に対する自車両Mの相対位置として認識してもよい。
【0042】
行動計画生成部140は、原則的には推奨車線決定部61により決定された推奨車線を走行し、更に、自車両Mの周辺状況に対応できるように、自車両Mが自動的に(運転者の操作に依らずに)将来走行する目標軌道を生成する。目標軌道は、例えば、速度要素を含んでいる。例えば、目標軌道は、自車両Mの到達すべき地点(軌道点)を順に並べたものとして表現される。軌道点は、道なり距離で所定の走行距離(例えば数[m]程度)ごとの自車両Mの到達すべき地点であり、それとは別に、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとの目標速度および目標加速度が、目標軌道の一部として生成される。また、軌道点は、所定のサンプリング時間ごとの、そのサンプリング時刻における自車両Mの到達すべき位置であってもよい。この場合、目標速度や目標加速度の情報は軌道点の間隔で表現される。
【0043】
行動計画生成部140は、目標軌道を生成するにあたり、自動運転のイベントを設定してよい。自動運転のイベントには、定速走行イベント、低速追従走行イベント、車線変更イベント、分岐イベント、合流イベント、テイクオーバーイベントなどがある。行動計画生成部140は、起動させたイベントに応じた目標軌道を生成する。
【0044】
モード決定部150は、自車両Mの運転モードを、運転者に課されるタスクが異なる複数の運転モードのいずれかに決定する。モード決定部150は、例えば、運転者状態判定部152と、モード変更処理部154と、判定部156とを備える。これらの個別の機能については後述する。
【0045】
図3は、運転モードと自車両Mの制御状態、およびタスクの対応関係の一例を示す図である。自車両Mの運転モードには、例えば、モードAからモードEの5つのモードがある。制御状態すなわち自車両Mの運転制御の自動化度合いは、モードAが最も高く、次いでモードB、モードC、モードDの順に低くなり、モードEが最も低い。この逆に、運転者に課されるタスクは、モードAが最も軽度であり、次いでモードB、モードC、モードDの順に重度となり、モードEが最も重度である。なお、モードDおよびEでは自動運転でない制御状態となるため、自動運転制御装置100としては自動運転に係る制御を終了し、運転支援または手動運転に移行させるまでが責務である。以下、それぞれの運転モードの内容について例示する。
【0046】
モードAでは、自動運転の状態となり、運転者には前方監視、ステアリングホイール82の把持(図ではステアリング把持)のいずれも課されない。但し、モードAであっても運転者は、自動運転制御装置100を中心としたシステムからの要求に応じて速やかに手動運転に移行できる体勢であることが要求される。なお、ここで言う自動運転とは、操舵、加減速のいずれも運転者の操作に依らずに制御されることをいう。前方とは、フロントウインドシールドを介して視認される自車両Mの進行方向の空間を意味する。モードAは、例えば、高速道路などの自動車専用道路において、所定速度(例えば50[km/h]程度)以下で自車両Mが走行しており、追従対象の前走車両が存在するなどの条件が満たされる場合に実行可能な運転モードであり、TJP(Traffic Jam Pilot)と称される場合もある。この条件が満たされなくなった場合、モード決定部150は、モードBに自車両Mの運転モードを変更する。
【0047】
モードBでは、運転支援の状態となり、運転者には自車両Mの前方を監視するタスク(以下、前方監視)が課されるが、ステアリングホイール82を把持するタスクは課されない。モードCでは、運転支援の状態となり、運転者には前方監視のタスクと、ステアリングホイール82を把持するタスクが課される。モードDは、自車両Mの操舵と加減速のうち少なくとも一方に関して、ある程度の運転者による運転操作が必要な運転モードである。例えば、モードDでは、ACC(Adaptive Cruise Control)やLKAS(Lane Keeping Assist System)といった運転支援が行われる。モードEでは、操舵、加減速ともに運転者による運転操作が必要な手動運転の状態となる。モードD、モードEともに、当然ながら運転者には自車両Mの前方を監視するタスクが課される。
【0048】
自動運転制御装置100(および運転支援装置(不図示))は、運転モードに応じた自動車線変更を実行する。自動車線変更には、システム要求による自動車線変更(1)と、運転者要求による自動車線変更(2)がある。自動車線変更(1)には、前走車両の速度が自車両の速度に比して基準以上に小さい場合に行われる、追い越しのための自動車線変更と、目的地に向けて進行するための自動車線変更(推奨車線が変更されたことによる自動車線変更)とがある。自動車線変更(2)は、速度や周辺車両との位置関係等に関する条件が満たされた場合において、運転者により方向指示器が操作された場合に、操作方向に向けて自車両Mを車線変更させるものである。
【0049】
自動運転制御装置100は、モードAにおいて、自動車線変更(1)および(2)のいずれも実行しない。自動運転制御装置100は、モードBおよびCにおいて、自動車線変更(1)および(2)のいずれも実行する。運転支援装置(不図示)は、モードDにおいて、自動車線変更(1)は実行せず自動車線変更(2)を実行する。モードEにおいて、自動車線変更(1)および(2)のいずれも実行されない。
【0050】
モード決定部150は、決定した運転モード(以下、現運転モード)に係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに自車両Mの運転モードを変更する。
【0051】
例えば、モードAにおいて運転者が、システムからの要求に応じて手動運転に移行できない体勢である場合(例えば許容エリア外の脇見を継続している場合や、運転困難となる予兆が検出された場合)、モード決定部150は、HMI30を用いて運転者に手動運転への移行を促し、運転者が応じなければ自車両Mを路肩に寄せて徐々に停止させ、自動運転を停止する、といった制御を行う。自動運転を停止した後は、自車両はモードDまたはEの状態になり、運転者の手動操作によって自車両Mを発進させることが可能となる。以下、「自動運転を停止」に関して同様である。モードBにおいて運転者が前方を監視していない場合、モード決定部150は、HMI30を用いて運転者に前方監視を促し、運転者が応じなければ自車両Mを路肩に寄せて徐々に停止させ、自動運転を停止する、といった制御を行う。モードCにおいて運転者が前方を監視していない場合、或いはステアリングホイール82を把持していない場合、モード決定部150は、HMI30を用いて運転者に前方監視を、および/またはステアリングホイール82を把持するように促し、運転者が応じなければ自車両Mを路肩に寄せて徐々に停止させ、自動運転を停止する、といった制御を行う。
【0052】
運転者状態判定部152は、上記のモード変更のために運転者の状態を監視し、運転者の状態がタスクに応じた状態であるか否かを判定する。例えば、運転者状態判定部152は、ドライバモニタカメラ70が撮像した画像を解析して姿勢推定処理を行い、運転者が、システムからの要求に応じて手動運転に移行できない体勢であるか否かを判定する。また、運転者状態判定部152は、ドライバモニタカメラ70が撮像した画像を解析して視線推定処理を行い、運転者が前方を監視しているか否かを判定する。
【0053】
モード変更処理部154は、モード変更のための各種処理を行う。例えば、モード変更処理部154は、行動計画生成部140に路肩停止のための目標軌道を生成するように指示したり、運転支援装置(不図示)に作動指示をしたり、運転者に行動を促すためにHMI30の制御をしたりする。判定部156の動作は後述する。
【0054】
第2制御部160は、行動計画生成部140によって生成された目標軌道を、予定の時刻通りに自車両Mが通過するように、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220を制御する。
【0055】
図2に戻り、第2制御部160は、例えば、取得部162と、速度制御部164と、操舵制御部166とを備える。取得部162は、行動計画生成部140により生成された目標軌道(軌道点)の情報を取得し、メモリ(不図示)に記憶させる。速度制御部164は、メモリに記憶された目標軌道に付随する速度要素に基づいて、走行駆動力出力装置200またはブレーキ装置210を制御する。操舵制御部166は、メモリに記憶された目標軌道の曲がり具合に応じて、ステアリング装置220を制御する。速度制御部164および操舵制御部166の処理は、例えば、フィードフォワード制御とフィードバック制御との組み合わせにより実現される。一例として、操舵制御部166は、自車両Mの前方の道路の曲率に応じたフィードフォワード制御と、目標軌道からの乖離に基づくフィードバック制御とを組み合わせて実行する。
【0056】
走行駆動力出力装置200は、車両が走行するための走行駆動力(トルク)を駆動輪に出力する。走行駆動力出力装置200は、例えば、内燃機関、電動機、および変速機などの組み合わせと、これらを制御するECU(Electronic Control Unit)とを備える。ECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って、上記の構成を制御する。
【0057】
ブレーキ装置210は、例えば、ブレーキキャリパーと、ブレーキキャリパーに油圧を伝達するシリンダと、シリンダに油圧を発生させる電動モータと、ブレーキECUとを備える。ブレーキECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って電動モータを制御し、制動操作に応じたブレーキトルクが各車輪に出力されるようにする。ブレーキ装置210は、運転操作子80に含まれるブレーキペダルの操作によって発生させた油圧を、マスターシリンダを介してシリンダに伝達する機構をバックアップとして備えてよい。なお、ブレーキ装置210は、上記説明した構成に限らず、第2制御部160から入力される情報に従ってアクチュエータを制御して、マスターシリンダの油圧をシリンダに伝達する電子制御式油圧ブレーキ装置であってもよい。
【0058】
ステアリング装置220は、例えば、ステアリングECUと、電動モータとを備える。電動モータは、例えば、ラックアンドピニオン機構に力を作用させて転舵輪の向きを変更する。ステアリングECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って、電動モータを駆動し、転舵輪の向きを変更させる。
【0059】
[車両制御装置の動作]
次に、実施形態に係る車両制御装置の動作について説明する。
図4は、実施形態に係る車両制御装置の動作が実行される場面の一例を示す図である。
図4に示す状況において、自車両Mの運転モードはモードBであり、かつ第2地図情報62に含まれる地図道路中心線を参照線として(すなわち、地図道路中心線に沿って)自車両Mは車線L1を走行中であるものとする。
図4中、符号LMLは左側地図道路区画線を示し、符号RMLは右側地図道路区画線を示し、符号CMLは地図道路中心線を示す。左側地図道路区画線LMLと、右側地図道路区画線RMLと、地図道路中心線CMLとは、第2地図情報62が事前に記憶するものである。
【0060】
図4に示す通り、左側地図道路区画線LMLと、右側地図道路区画線RMLと、地図道路中心線CMLのそれぞれは、所定間隔(例えば、1m)ごとに配置された点群として表現される。
図4中、符号LPは左側地図道路区画線LMLを構成する点群を表し、符号RPは左側地図道路区画線LMLを構成する点群を表し、符号CPは地図道路中心線CMLを構成する点群を表す。判定部156は、自車両Mの走行車線にある前方領域のうち、所定範囲(例えば、自車両Mの現時点における速度を基準にして数秒先の地点から、数十メートル先の地点までの範囲)に存在する点群LP、RP、CPを第2地図情報62から抽出し、以下で説明する判定処理を行う。
図4の状況においては、自車両Mの走行車線にある前方領域のうち、点群LP
1~LP
i、RP
1~RP
i、CP
1~CP
iが抽出されたものとする。
【0061】
図5は、判定部156によって実行される判定処理を説明するための図である。判定部156は、まず、左側地図道路区画線LMLについて、点LP
kと点LP
k+1(k=1~i)とを結ぶ直線と、点CP
kと点CP
k+1(k=1~i)とを結ぶ直線との間の角度θ
kL(k=1~i)を算出する。同様に、判定部156は、右側地図道路区画線RMLについて、点RP
kと点RP
k+1(k=1~i)とを結ぶ直線と、点CP
kと点CP
k+1(k=2~i)とを結ぶ直線との間の角度θ
kR(k=1~i)を算出する。すなわち、角度θ
kL(k=1~i)は、左側地図道路区画線LMLと地図道路中心線CMLとの間の点群に基づく角度乖離度を表し、角度θ
kR(k=1~i)は、右側地図道路区画線RMLと地図道路中心線CMLとの間の点群に基づく角度乖離度を表す。なお、本実施形態では、一例として、2つの点ごとに直線を導出し角度を算出しているが、例えば、点群のうちの3つ以上の点ごとに直線をフィッティングによって導出し、角度を算出してもよい。
【0062】
判定部156は、次に、左側地図道路区画線LMLについて算出した角度θkL(k=1~i)の平均値θavLと、右側地図道路区画線RMLについて算出した角度θkR(k=1~i)の平均値θavRをそれぞれ算出する。判定部156は、算出した平均値θavLと平均値θavRとの角度合計値Δθを算出する。角度合計値Δθは、「地図道路区画線と地図道路中心線との間の角度に基づく判定角度」の一例である。すなわち、角度合計値Δθは、左右の地図道路区画線LMLおよびRMLと、地図道路中心線MCLとの間の乖離度を表す指標値である。角度合計値Δθは、点群LPに基づいて算出された平均値θavLと、点群RPに基づいて算出された平均値θavRとの合計として定義されるため、外れ値の影響を除外して、地図道路区画線と地図道路中心線との間の角度乖離度を正確に表すことができる。
【0063】
判定部156は、さらに、左側地図道路区画線LMLについて算出した角度θkL(k=1~i)のうちの角度ピーク値(最大値)θL_peakを抽出するとともに、右側地図道路区画線RMLについて算出した角度θkR(k=1~i)のうちの角度ピーク値θR_peakを抽出しておく。角度ピーク値θL_peakおよびθR_peakも、「地図道路区画線と地図道路中心線との間の角度に基づく判定角度」の一例である。本実施形態において、角度合計値Δθおよび角度ピーク値θL_peakおよびθR_peakを「地図道路区画線と地図道路中心線との間の角度に基づく判定角度」として定義しているが、より一般的に、判定角度は、地図道路区画線と地図道路中心線に所定処理を施すことによって得られた角度乖離度を表す指標値であれば良い。
【0064】
判定部156は、次に、左側地図道路区画線LMLと地図道路中心線CMLとの間の左側距離ΔYLと、右側地図道路区画線RMLと地図道路中心線CMLとの間の右側距離ΔYRを算出する。より具体的には、例えば、判定部156は、左側地図道路区画線LMLを構成する点群LPk(k=1~i)に基づいて、ΔYL=min(dis|LPk-CPk|)(k=1~i、disはLPkとCPkとの間の距離を表す)と算出する。また、例えば、判定部156は、右側地図道路区画線RMLを構成する点群RPk(k=1~i)に基づいて、ΔYR=min(dis|RPk-CPk|)(k=1~i、disはRPkとCPkとの間の距離を表す)と算出する。左側距離ΔYL又は右側距離ΔYRは、「地図道路区画線と地図道路中心線との間の判定距離」の一例である。より一般的に、判定角度は、地図道路区画線と地図道路中心線に所定処理を施すことによって得られた距離乖離度を表す指標値であれば良い。
【0065】
[第1判定]
判定部156は、角度合計値Δθと、角度ピーク値θL_peakおよびθR_peakと、左側距離ΔYL及び右側距離ΔYRとを算出すると、以下の判定処理を行う。まず、判定部156は、角度合計値Δθが第1角度閾値ThA_1以上であるか否かを判定する(第1判定)。すなわち、第1判定は、地図道路区画線MLと地図道路中心線CMLとの間の角度乖離度が大きいか否かを判定するための処理である。第1角度閾値ThA_1は、「第1閾値」の一例である。
【0066】
[第2判定]
判定部156は、さらに、角度ピーク値θL_peakが第2角度閾値ThA_2以上であり、かつ左側距離ΔYLが距離閾値ThD以上であるか否かを判定するとともに(第2-1判定)、θR_peakが第2角度閾値ThA_2以上であり、かつ右側距離ΔYRが距離閾値ThD以上であるか否かを判定する(第2-2判定)。すなわち、第2-1判定は、左側地図道路区画線LMLと地図道路中心線CMLとが乖離しているか否かを判定するための処理であり、第2-2判定は、右側地図道路区画線RMLと地図道路中心線CMLとが乖離しているか否かを判定するための処理である。次に、判定部156は、第2-1判定と第2-2判定とのうちの少なくとも一方が肯定的な結果であるか否かを判定する(第2判定)。すなわち、第2判定は、左側地図道路区画線LMLと右側地図道路区画線RMLとのうちの少なくとも一方と地図道路中心線CMLとが乖離しているか否かを判定するための処理である。第2角度閾値ThA_1は「第1閾値」の一例であり、距離閾値ThDは「第2閾値」の一例である。
【0067】
なお、第2判定のうち、角度ピーク値θL_peakおよびθR_peakに関する判定は省略されてもよい。その場合、第2判定は、左側距離ΔYLが距離閾値ThD以上であるか、又は右側距離ΔYRが距離閾値ThD以上であるか否かを判定することとなる。
【0068】
[第3判定]
判定部156は、さらに、第2地図情報62に基づいて、自車両Mの走行車線にある前方領域のうち、所定範囲(上述した通り、例えば、自車両Mの現時点における速度を基準にして数秒先の地点から、数十メートル先の地点までの範囲)に、所定領域が存在しないか否かを判定する。ここで、所定領域は、例えば、車線増加区間、車線減少区間、または走路曲率が所定値以上の区間として定義される。自車両Mの前方に所定領域が存在する場合、近い将来、車線変更の実施やLKASの停止などが考えられるため、後述する運転モードの変更が適切ではない場合がある。第3判定は、自車両Mの前方領域が所定領域に該当せず、したがって後述する運転モードの変更が許容されることを確認するための処理である。
【0069】
[複合判定]
判定部156は、次に、第1判定と、第2判定と、第3判定の全てが肯定的な結果であるか否かを判定する。判定部156によって第1判定と、第2判定と、第3判定の全てが肯定的な結果であると判定された場合、これは地図道路中心線CMLに歪みが生じており、第2地図情報62に基づくモードBの運転モード(すなわち、第2地図情報62に含まれる地図道路中心線CMLを参照線とするモードBの運転モード)を変更する必要があることを意味する。そのため、以下で説明する通り、モード決定部150は、判定部156による判定結果に応じて、第2地図情報62に基づくモードBの運転モードを変更する。このように、第1判定と、第2判定と、第3判定は、第2地図情報62のみを参照して実行されるものであるため、地図道路中心線CMLの歪みを他の情報に依存することなく簡易的に検知することができる。
【0070】
[運転モードの変更]
モード決定部150は、判定部156によって第1判定と、第2判定と、第3判定の全てが肯定的な結果であると判定された場合、角度合計値Δθと、角度ピーク値θL_peakとθR_peakの少なくとも一方と、複数の閾値との大小関係に基づいて、変更先の運転モードを決定する。「角度ピーク値θL_peakとθR_peakの少なくとも一方」とは、上述した第2-1判定と第2-2判定のうち、肯定的な結果が得られた方の角度ピーク値を意味する。以下では、説明の簡潔性のため、第2-1判定(すなわち、角度ピーク値θL_peak)についてのみ肯定的な結果が得られたものと仮定するが、第2-1判定と第2-2判定の双方について肯定的な結果が得られた場合、角度ピーク値θL_peakとθR_peakの双方について、以下の判定処理が実行される。
【0071】
モード決定部150は、角度合計値Δθが第1角度閾値ThA_1以上かつ第3角度閾値ThA_3未満であり、かつ角度ピーク値θL_peakが第2角度閾値ThA_2以上かつ第4角度閾値ThA_4未満であるか否かを判定する。モード決定部150は、角度合計値Δθが第1角度閾値ThA_1以上かつ第3角度閾値ThA_3未満であり、かつ角度ピーク値θL_peakが第2角度閾値ThA_2以上かつ第4角度閾値ThA_4未満であると判定された場合、次に、地図道路区画線MLとカメラ道路区画線CLとの少なくとも一部が一致するか否かを判定する。
【0072】
地図道路区画線MLとカメラ道路区画線CLとの少なくとも一部が一致するか否かを判定するために、例えば、モード決定部150は、まず、左側のカメラ道路区画線CLおよび地図道路区画線MLと、右側のカメラ道路区画線CLおよび地図道路区画線MLのそれぞれについて、カメラ道路区画線CLと地図道路区画線MLとの間の距離が閾値以内であるか否かを判定する。判定部156は、例えば、カメラ道路区画線CLと地図道路区画線MLとの間の距離が左側と右側の少なくとも一方について閾値より小さい場合に、カメラ道路区画線CLと地図道路区画線MLとの少なくとも一部が一致していると判定する。また、例えば、モード決定部150は、左側のカメラ道路区画線CLおよび地図道路区画線MLと、右側のカメラ道路区画線CLおよび地図道路区画線MLのそれぞれについて、カメラ道路区画線CLと地図道路区画線MLとがなす角度が閾値以内であるか否かを判定し、カメラ道路区画線CLと地図道路区画線MLとがなす角度が左側と右側の少なくとも一方について閾値より小さい場合に、カメラ道路区画線CLと地図道路区画線MLとの少なくとも一部が一致していると判定してもよい。また、例えば、カメラ道路区画線CLがロスト(すなわち、消失)した場合、モード決定部150は、ロストしたカメラ道路区画線CLと地図道路区画線MLとは一致しないものと扱って判定してもよい。
【0073】
図6は、モード決定部150によって実行されるモード変更処理の一例を示す図である。
図6において、符号LCLは左側カメラ道路区画線を示し、符号RCLは右側カメラ道路区画線を示し、符号CCLはカメラ道路中心線を示す。地図道路区画線MLとカメラ道路区画線CLとの少なくとも一部が一致すると判定された場合、モード決定部150は、第2地図情報62に基づくモードBの運転モードを、カメラ画像情報に基づくモードBの運転モード(すなわち、カメラ道路中心線CCLを参照線とするモードBの運転モード)に変更する。一方、地図道路区画線MLとカメラ道路区画線CLとの少なくとも一部が一致しないと判定された場合、モード決定部150は、第2地図情報62に基づくモードBの運転モードを、カメラ画像情報に基づくモードCの運転モード(すなわち、カメラ道路中心線CCLを参照線とするモードCの運転モード)に変更する。
【0074】
図6に示す通り、運転モードが、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードに変更されると、行動計画生成部140は、自車両Mがカメラ道路中心線CCLに沿って走行するような目標軌道を生成し、第2制御部160は、生成した目標軌道に沿って車両Mを走行させる。すなわち、歪みが存在すると判定された地図道路中心線MCLに代えて、カメラ道路中心線CCLに沿って自車両Mを走行させることにより、走行車線の中心線に基づいた運転制御を好適に実行することができる。
【0075】
モード決定部150は、地図道路中心線MCLを参照線とするモードBの運転モードを、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードに変更すると、当該モードB又はモードCの運転モードを少なくとも第1所定期間、継続させる。これは、地図道路中心線MCLの歪みが解消された場合に即時、地図道路中心線MCLを参照線とするモードBの運転モードに復帰させると、運転モードにハンチングが発生し、自車両Mの乗員に不快感を与える可能性があるからである。
【0076】
そのため、モード決定部150は、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードを第1所定期間継続させた後に、判定部156は、上述した、地図道路中心線CMLの角度乖離に関する第1判定と、カメラ道路中心線CCLの距離乖離に関する第2判定とを再度実行する。モード決定部150は、角度合計値Δθが第1角度閾値ThA_1未満であり、かつ左側距離ΔYLが距離閾値ThD未満であり、かつ右側距離ΔYRが距離閾値ThD未満であると判定された場合、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードを、地図道路中心線MCLを参照線とするモードBの運転モードに復帰させる。
【0077】
また、モード決定部150は、地図道路中心線MCLを参照線とするモードBの運転モードを、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードに変更してから、第1所定期間よりも長い第2所定期間が経過した場合、上述した第1判定と第2判定とを再度実行する。モード決定部150は、角度合計値Δθが第1角度閾値ThA_1以上であるか、又は左側距離ΔYLが距離閾値ThD以上であるか、又は右側距離ΔYRが距離閾値ThD以上であると判定された場合、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードを、モードD又はモードE(手動運転)の運転モードに変更する。すなわち、地図道路中心線MCLに歪みがあると推定される期間が長く継続する場合、運転モードを、よりタスクが重度な運転モードに変更することによって、より状況に適した運転制御を実行することができる。
【0078】
一方、モード決定部150は、角度合計値Δθが第3角度閾値ThA_3以上であり、かつ角度ピーク値θL_peakが第4角度閾値ThA_4以上であると判定された場合、地図道路中心線MCLを参照線とするモードBの運転モードを、カメラ道路中心線CCLを参照線とするモードCの運転モードに変更する。すなわち、この場合、カメラ道路中心線CCLの歪みはより大きいものと想定されるため、モード決定部150は、地図道路中心線MCLを参照線とするモードBの運転モードを、カメラ道路中心線CCLを参照線とするモードBの運転モードに変更することなく、そのままカメラ道路中心線CCLを参照線とするモードCの運転モードにまで変更する(落とす)。
【0079】
この場合も同様に、モード決定部150は、カメラ道路中心線CCLを参照線とするモードCの運転モードを第1所定期間、継続させた後に、判定部156は、上述した、地図道路中心線CMLの角度乖離に関する第1判定と、カメラ道路中心線CCLの距離乖離に関する第2判定とを再度実行する。モード決定部150は、角度合計値Δθが第1角度閾値ThA_1未満であり、かつ左側距離ΔYLが距離閾値ThD未満であり、かつ右側距離ΔYRが距離閾値ThD未満であると判定された場合、カメラ道路中心線CCLを参照線とするモードCの運転モードを、地図道路中心線MCLを参照線とするモードBの運転モードに復帰させる。
【0080】
また、同様に、モード決定部150は、地図道路中心線MCLを参照線とするモードBの運転モードを、カメラ道路中心線CCLを参照線とするモードCの運転モードに変更してから、第2所定期間が経過した場合、上述した第1判定と第2判定とを再度実行する。モード決定部150は、角度合計値Δθが第1角度閾値ThA_1以上であるか、又は左側距離ΔYLが距離閾値ThD以上であるか、又は右側距離ΔYRが距離閾値ThD以上であると判定された場合、カメラ道路中心線CCLを参照線とするモードCの運転モードを、モードD又はモードEの運転モードに変更する。
【0081】
なお、上記の説明において、判定を行うために用いられる第1所定期間および第2所定期間は、それぞれ自車両Mの継続的な走行距離であっても良い。例えば、モード決定部150は、地図道路中心線MCLを参照線とするモードBの運転モードを、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードに変更すると、当該モードB又はモードCの運転モードを少なくとも自車両Mが継続的に第1所定距離、走行するまで継続させ、その後、上述した復帰のための再判定処理を実行しても良い。また、例えば、モード決定部150は、地図道路中心線MCLを参照線とするモードBの運転モードを、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードに変更してから、第1所定距離よりも長い第2所定距離、自車両Mを走行させ、その後、運転モードをモードD又はモードEに落とすか否かを判定するための処理を実行しても良い。
【0082】
さらに、上記の説明において、判定部156は、第2地図情報62から所定範囲における点群を取得し、取得した点群に基づいて角度合計値Δθや角度ピーク値を算出している。このとき、判定部156は、取得した点群の個数をカウントし、カウントした個数が所定数以上の場合にのみ、角度合計値Δθや角度ピーク値を算出して判定処理を行っても良い。カウントした個数が所定数未満の場合には、モード決定部150は、地図道路中心線MCLを参照線とするモードBの運転モードを、カメラ道路中心線CCLを参照線とするモードB又はモードCの運転モードに変更してもよいし、モードD又はモードEに落としても良い。
【0083】
次に、
図7および
図8を参照して、実施形態に係る車両制御装置によって実行される処理の流れについて説明する。
図7は、実施形態に係る車両制御装置によって実行される処理の流れの一例を示すフローチャートである。
図7に示す処理は、地図道路中心線CCLを参照線とするモードBの運転モードにて自車両Mが走行中、繰り返し実行されるものである。
【0084】
まず、判定部156は、第2地図情報62から、自車両Mの走行車線にある前方領域のうち、所定範囲における道路区画線および道路中心線を表す点群を取得する(ステップS100)。次に、判定部156は、取得した点群に基づいて、地図道路区画線と地図道路中心線との間の角度合計値Δθ、角度ピーク値θL_peakおよびθR_peak、横距離ΔYL及びΔYRを算出する(ステップS102)。
【0085】
次に、判定部156は、算出した角度合計値Δθに基づいて第1判定を実行し、算出した角度ピーク値θL_peakおよびθR_peak並びに横距離ΔYL及びΔYRに基づいて第2判定を実行し、第2地図情報62に基づいて第3判定を実行する(ステップS104)。次に、判定部156は、第1判定と、第2判定と、第3判定の全てについて肯定的な結果が得られたか否かを判定する(ステップS106)。第1判定と、第2判定と、第3判定の全てについて肯定的な結果が得られなかった場合、判定部156は、処理をステップS100に戻す。
【0086】
第1判定と、第2判定と、第3判定の全てについて肯定的な結果が得られた場合、モード決定部150は、算出した角度合計値が第1角度閾値ThA_1以上第3角度閾値ThA_3未満であり、かつ算出した角度ピーク値が第2角度閾値ThA_2以上第4角度閾値ThA_4未満であるか否かを判定する(ステップS108)。算出した角度合計値が第1角度閾値ThA_1以上第3角度閾値ThA_3未満であり、かつ算出した角度ピーク値が第2角度閾値ThA_2以上第4角度閾値ThA_4未満であると判定された場合、次に、モード決定部150は、カメラ道路区画線と地図道路区画線との少なくとも一部が一致するか否かを判定する(ステップS110)。
【0087】
カメラ道路区画線と地図道路区画線との少なくとも一部が一致すると判定された場合、モード決定部150は、地図道路中心線MCLに基づくモードBの運転モードを、カメラ道路中心線CCLに基づくモードBの運転モードに変更する(ステップS112)。一方、ステップS108において算出した角度合計値が第1角度閾値ThA_1以上第3角度閾値ThA_3未満であり、かつ算出した角度ピーク値が第2角度閾値ThA_2以上第4角度閾値ThA_4未満ではないと判定されるか、又はステップS110においてカメラ道路区画線と地図道路区画線とが一致しないと判定された場合、モード決定部150は、地図道路中心線MCLに基づくモードBの運転モードを、カメラ道路中心線CCLに基づくモードCの運転モードに変更する(ステップS114)。これにより、本フローチャートの処理が終了する。
【0088】
なお、上記のフローチャートの処理において、ステップS110は省略されてもよく、その場合、ステップS108において肯定的な結果が得られた場合、ステップS112の処理が実行されることとなる。
【0089】
さらに、上記の説明において、ステップS108又はステップS110において否定的に判定された場合、モード決定部150は、ステップS114において、地図道路中心線MCLに基づくモードBの運転モードを、カメラ道路中心線CCLに基づくモードCの運転モードに変更している。しかし、本発明はそのような構成に限定されず、ステップS108又はステップS110において否定的に判定された場合であっても、モード決定部150は、自車両Mの進行方向に関して所定距離以内に先行車両が存在する際には、当該先行車両の走行軌跡を参照線として、モードBの運転モードを継続させても良い。また、例えば、モード決定部150は、当該先行車両の走行軌跡と、カメラ道路中心線CCLとの間の中心線をさらに算出し、算出された中心線を参照線として、モードBの運転モードを継続させても良い。
【0090】
図8は、実施形態に係る車両制御装置によって実行される処理の流れの別の例を示すフローチャートである。
図8に示すフローチャートの処理は、
図7に示すステップS112又はステップS114の処理が実行された後に、実行されるものである。
【0091】
まず、モード決定部150は、カメラ道路中心線CCLに基づくモードB又はモードCの運転モードを第1所定期間、継続する(ステップS200)。次に、判定部156は、ステップS100と同様に、第2地図情報62から、自車両Mの走行車線にある前方領域のうち、所定範囲における道路区画線および道路中心線を表す点群を取得する(ステップS202)。次に、判定部156は、取得した点群に基づいて、地図道路区画線と地図道路中心線との間の角度合計値Δθ並びに角度ピーク値θL_peakおよびθR_peakを算出する(ステップS204)。
【0092】
次に、モード決定部150は、角度合計値Δθが第1角度閾値ThA_1未満であり、かつ角度ピーク値θL_peakおよびθR_peakが第2角度閾値ThA_2未満であるか否かを判定する(ステップS206)。角度合計値Δθが第1角度閾値ThA_1未満であり、かつ角度ピーク値θL_peakおよびθR_peakが第2角度閾値ThA_2未満であると判定された場合、モード決定部150は、カメラ道路中心線CCLに基づくモードB又はモードCの運転モードを、地図道路中心線MCLに基づくモードBの運転モードに復帰させる(ステップS208)。
【0093】
一方、角度合計値Δθが第1角度閾値ThA_1未満であり、かつ角度ピーク値θL_peakおよびθR_peakが第2角度閾値ThA_2未満ではないと判定された場合、モード決定部150は、次に、運転モードをカメラ道路中心線に基づくモードB又はモードCに変更してから第2所定期間が経過したか否かを判定する(ステップS210)。第2所定期間が経過していないと判定された場合、モード決定部150は、処理をステップS202に戻す。一方、第2所定期間が経過したと判定された場合、モード決定部150は、運転モードをモードE、すなわち、手動運転に変更する(ステップS310)。これにより、本フローチャートの処理が終了する。
【0094】
以上の通り説明した本実施形態によれば、自車両Mが地図道路中心線MCLに基づくモードBの運転モードで走行中に、第1判定、第2判定、第3判定を組み合わせた複合判定によって地図道路中心線MCLの歪みが検知された場合、地図道路中心線MCLに基づくモードBの運転モードを、カメラ道路中心線CCLに基づくモードB又はモードCの運転モードに変更する。これにより、走行車線の中心線に基づいた運転制御を好適に実行することができる。
【0095】
上記説明した実施形態は、以下のように表現することができる。
コンピュータによって読み込み可能な命令(computer-readable instructions)を格納する記憶媒体(storage medium)と、
前記記憶媒体に接続されたプロセッサと、を備え、
前記プロセッサは、前記コンピュータによって読み込み可能な命令を実行することにより(the processor executing the computer-readable instructions to:)
車両の周辺状況を認識し、
前記周辺状況と地図情報に基づいて、前記車両の運転者の操作に依らずに前記車両の操舵および加減速を制御し、
前記車両の運転モードを、第1の運転モードと、第2の運転モードとを含む複数の運転モードのいずれかに決定し、前記第2の運転モードは前記運転者に課されるタスクが前記第1の運転モードに比して軽度な運転モードであり、少なくとも前記第2の運転モードを含む前記複数の運転モードの一部が制御されるものであり、前記決定した運転モードに係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに前記車両の運転モードを変更し、
前記地図情報に含まれる地図道路区画線と地図道路中心線との間の判定角度が第1閾値以上であるか否かと、前記地図道路区画線と前記地図道路中心線との間の判定距離が第2閾値以上であるか否かと、前記車両の前方領域が所定領域に該当しないか否かを判定し、
前記判定角度が前記第1閾値以上であり、かつ前記判定距離が前記第2閾値以上であり、かつ前記前方領域が前記所定領域に該当しないと判定された場合、前記第2の運転モードを、前記周辺状況に含まれるカメラ道路区画線に基づく前記第1の運転モードに変更する、
ように構成されている、車両制御装置。
【0096】
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
【符号の説明】
【0097】
10 カメラ
12 レーダ装置
14 LIDAR
16 物体認識装置
70 ドライバモニタカメラ
82 ステアリングホイール
84 ステアリング把持センサ
100 自動運転制御装置
130 認識部
140 行動計画生成部
150 モード決定部
152 運転者状態判定部
154 モード変更処理部
156 判定部