(19)【発行国】日本国特許庁(JP)
(12)【公報種別】公開特許公報(A)
(11)【公開番号】P2024088122
(43)【公開日】2024-07-02
(54)【発明の名称】車両制御装置、車両制御方法、およびプログラム
(51)【国際特許分類】
B60W 30/12 20200101AFI20240625BHJP
B60W 40/06 20120101ALI20240625BHJP
G08G 1/16 20060101ALI20240625BHJP
G01C 21/30 20060101ALI20240625BHJP
【FI】
B60W30/12
B60W40/06
G08G1/16 C
G01C21/30
【審査請求】未請求
【請求項の数】8
【出願形態】OL
(21)【出願番号】P 2022203142
(22)【出願日】2022-12-20
(71)【出願人】
【識別番号】000005326
【氏名又は名称】本田技研工業株式会社
(74)【代理人】
【識別番号】100165179
【弁理士】
【氏名又は名称】田▲崎▼ 聡
(74)【代理人】
【識別番号】100126664
【弁理士】
【氏名又は名称】鈴木 慎吾
(74)【代理人】
【識別番号】100154852
【弁理士】
【氏名又は名称】酒井 太一
(74)【代理人】
【識別番号】100194087
【弁理士】
【氏名又は名称】渡辺 伸一
(72)【発明者】
【氏名】清水 崇博
(72)【発明者】
【氏名】田村 祥
【テーマコード(参考)】
2F129
3D241
5H181
【Fターム(参考)】
2F129AA03
2F129BB03
2F129BB20
2F129BB21
2F129BB22
2F129BB26
2F129BB33
2F129BB49
2F129BB66
2F129CC33
2F129EE02
2F129EE43
2F129EE52
2F129GG17
2F129HH02
2F129HH12
3D241BA02
3D241BA12
3D241BA26
3D241BA49
3D241BA60
3D241BB27
3D241BB45
3D241BB46
3D241BB48
3D241CC01
3D241CC08
3D241CC11
3D241CC17
3D241CE01
3D241CE02
3D241CE04
3D241CE05
3D241CE08
3D241DA13Z
3D241DA23Z
3D241DA39Z
3D241DA52Z
3D241DB01Z
3D241DB02Z
3D241DB05Z
3D241DB12Z
3D241DB14Z
3D241DC31Z
3D241DC34Z
3D241DC39Z
3D241DC43Z
3D241DC45Z
3D241DC50Z
3D241DC59Z
3D241DD02Z
3D241DD12Z
5H181AA01
5H181BB04
5H181BB20
5H181CC03
5H181CC04
5H181CC12
5H181CC14
5H181CC24
5H181FF04
5H181FF07
5H181FF22
5H181FF27
5H181FF32
5H181LL06
5H181LL09
(57)【要約】
【課題】より適切に車両の走行車線を決定すること。
【解決手段】実施形態の車両制御装置は、車両の周辺状況を検知した検知デバイスの出力に基づいて、前記車両の走行車線を区画する第1の区画線を認識する第1認識部と、前記車両の位置情報と地図情報とに基づいて、前記走行車線を区画する第2の区画線を認識する第2認識部と、前記車両の進行方向の道路勾配情報に基づいて前記第2の区画線を補正する補正部と、前記第1の区画線と前記補正部により補正された前記第2の区画線との比較結果に基づいて前記車両の走行車線を決定する車線決定部と、を備える。
【選択図】
図2
【特許請求の範囲】
【請求項1】
車両の周辺状況を検知した検知デバイスの出力に基づいて、前記車両の走行車線を区画する第1の区画線を認識する第1認識部と、
前記車両の位置情報と地図情報とに基づいて、前記走行車線を区画する第2の区画線を認識する第2認識部と、
前記車両の進行方向の道路勾配情報に基づいて前記第2の区画線を補正する補正部と、
前記第1の区画線と前記補正部により補正された前記第2の区画線との比較結果に基づいて前記車両の走行車線を決定する車線決定部と、
を備える車両制御装置。
【請求項2】
前記補正部は、前記地図情報に含まれる前記第2の区画線の道路勾配情報に基づいて前記第2の区画線の位置を補正する、
請求項1に記載の車両制御装置。
【請求項3】
前記補正部は、前記道路勾配情報に基づいて前記第2の区画線で区画された前記車両の走行車線に対して補正を行う、
請求項1に記載の車両制御装置。
【請求項4】
前記車線決定部により決定された走行車線に基づいて、前記車両の操舵または速度のうち、一方または双方を制御する運転制御を実行する運転制御部を更に備え、
前記運転制御は、第1の運転モードと、前記第1の運転モードよりも前記車両の運転者に課されるタスクが重度または前記第1の運転モードよりも前記運転者に対する運転支援の度合が小さい第2の運転モードとを含み、
前記運転制御部は、前記第1の運転モードを実行している状態において、前記第1の区画線と前記第2の区画線との乖離度合が閾値以上となる場合に、前記第1の運転モードから前記第2の運転モードへ切り替える、
請求項1に記載の車両制御装置。
【請求項5】
前記補正部は、前記道路勾配情報に含まれる勾配度合が閾値以上である場合に前記第2の区画線を補正する、
請求項1に記載の車両制御装置。
【請求項6】
前記補正部は、前記車両が勾配区間に存在し、且つ前記車両の進行方向の所定距離以内に勾配変化地点が存在しない場合に、前記第2の区画線の補正を抑制する、
請求項1に記載の車両制御装置。
【請求項7】
コンピュータが、
車両の周辺状況を検知した検知デバイスの出力に基づいて、前記車両の走行車線を区画する第1の区画線を認識し、
前記車両の位置情報と地図情報とに基づいて、前記走行車線を区画する第2の区画線を認識し、
前記車両の進行方向の道路勾配情報に基づいて前記第2の区画線を補正し、
前記第1の区画線と、補正した前記第2の区画線との比較結果に基づいて、前記車両の走行車線を決定する、
車両制御方法。
【請求項8】
コンピュータに、
車両の周辺状況を検知した検知デバイスの出力に基づいて、前記車両の走行車線を区画する第1の区画線を認識させ、
前記車両の位置情報と地図情報とに基づいて、前記走行車線を区画する第2の区画線を認識させ、
前記車両の進行方向の道路勾配情報に基づいて前記第2の区画線を補正させ、
前記第1の区画線と、補正された前記第2の区画線との比較結果に基づいて、前記車両の走行車線を決定させる、
プログラム。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、車両制御装置、車両制御方法、およびプログラムに関する。
【背景技術】
【0002】
近年、交通参加者の中でも脆弱な立場にある人々にも配慮した持続可能な輸送システムへのアクセスを提供する取り組みが活発化している。この実現に向けて運転支援技術に関する研究開発を通して交通の安全性や利便性をより一層改善する研究開発に注力している。これに関連して、マップ上に自車位置を表示する場合に走行中の道路勾配のばらつき状態に応じてマップマッチを行ったり、地物によるマッチングや、センサから得られた三次元点を基にマップとのマッチングを行い、車両の現在位置を求める技術が知られている(例えば、特許文献1~3参照)。
【先行技術文献】
【特許文献】
【0003】
【特許文献1】特開2015-190871号公報
【特許文献2】特開2021-82300号公報
【特許文献3】特開2020-95435号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
ところで、運転支援技術において、周辺状況を認識する検知デバイスにより認識された第1の道路区画線と、位置センサが検出した車両の位置を基準に地図情報から取得した第2の道路区画線との比較で乖離が発生している場合に、道路勾配が乖離に起因しているか否かを判定することができず、車両の走行車線を適切に決定できない場合があるといった課題があった。
【0005】
本発明の態様は、上記課題の解決のため、より適切に車両の走行車線を決定することができる車両制御装置、車両制御方法、およびプログラムを提供することを目的の一つとしたものである。そして、延いては持続可能な輸送システムの発展に寄与するものである。
【課題を解決するための手段】
【0006】
この発明に係る車両制御装置、車両制御方法、およびプログラムは、以下の構成を採用した。
(1):この発明の一態様に係る車両制御装置は、車両の周辺状況を検知した検知デバイスの出力に基づいて、前記車両の走行車線を区画する第1の区画線を認識する第1認識部と、前記車両の位置情報と地図情報とに基づいて、前記走行車線を区画する第2の区画線を認識する第2認識部と、前記車両の進行方向の道路勾配情報に基づいて前記第2の区画線を補正する補正部と、前記第1の区画線と前記補正部により補正された前記第2の区画線との比較結果に基づいて前記車両の走行車線を決定する車線決定部と、を備える車両制御装置である。
【0007】
(2):上記(1)の態様において、前記補正部は、前記地図情報に含まれる前記第2の区画線の道路勾配情報に基づいて前記第2の区画線の位置を補正するものである。
【0008】
(3):上記(1)の態様において、前記補正部は、前記道路勾配情報に基づいて前記第2の区画線で区画された前記車両の走行車線に対して補正を行うものである。
【0009】
(4):上記(1)の態様において、前記車線決定部により決定された走行車線に基づいて、前記車両の操舵または速度のうち、一方または双方を制御する運転制御を実行する運転制御部を更に備え、前記運転制御は、第1の運転モードと、前記第1の運転モードよりも前記車両の運転者に課されるタスクが重度または前記第1の運転モードよりも前記運転者に対する運転支援の度合が小さい第2の運転モードとを含み、前記運転制御部は、前記第1の運転モードを実行している状態において、前記前記第1の区画線と前記第2の区画線との乖離度合が閾値以上となる場合に、前記第1の運転モードから前記第2の運転モードへ切り替えるものである。
【0010】
(5):上記(1)の態様において、前記補正部は、前記道路勾配情報に含まれる勾配度合が閾値以上である場合に前記第2の区画線を補正するものである。
【0011】
(6):上記(1)の態様において、前記補正部は、前記車両が勾配区間に存在し、且つ前記車両の進行方向の所定距離以内に勾配変化地点が存在しない場合に、前記第2の区画線の補正を抑制するものである。
【0012】
(7):この発明の一態様に係る車両制御方法は、コンピュータが、車両の周辺状況を検知した検知デバイスの出力に基づいて、前記車両の走行車線を区画する第1の区画線を認識し、前記車両の位置情報と地図情報とに基づいて、前記走行車線を区画する第2の区画線を認識し、前記車両の進行方向の道路勾配情報に基づいて前記第2の区画線を補正し、前記第1の区画線と、補正した前記第2の区画線との比較結果に基づいて、前記車両の走行車線を決定する、車両制御方法である。
【0013】
(8):この発明の一態様に係るプログラムは、コンピュータに、車両の周辺状況を検知した検知デバイスの出力に基づいて、前記車両の走行車線を区画する第1の区画線を認識させ、前記車両の位置情報と地図情報とに基づいて、前記走行車線を区画する第2の区画線を認識させ、前記車両の進行方向の道路勾配情報に基づいて前記第2の区画線を補正させ、前記第1の区画線と、補正された前記第2の区画線との比較結果に基づいて、前記車両の走行車線を決定させる、プログラムである。
【発明の効果】
【0014】
上記(1)~(8)の態様によれば、より適切に車両の走行車線を決定することができる。
【図面の簡単な説明】
【0015】
【
図1】実施形態に係る車両制御装置を含む車両システム1の構成図である。
【
図2】第1制御部120および第2制御部160の機能構成図である。
【
図3】運転モードと車両Mの制御状態、およびタスクの対応関係の一例を示す図である。
【
図4】補正部136の処理の内容について説明するための図である。
【
図5】車両Mの進行方向に下り坂(下り勾配)がある場合の補正について説明するための図である。
【
図6】勾配区間がカーブ路である場合の補正について説明するための図である。
【
図7】判定部154の処理について説明するための図である。
【
図8】自動運転制御装置100により実行される処理の流れの一例を示すフローチャートである。
【発明を実施するための形態】
【0016】
以下、図面を参照し、本発明の車両制御装置、車両制御方法、およびプログラムの実施形態について説明する。以下では、一例として、車両制御装置が自動運転車両に適用された実施形態について説明する。自動運転とは、例えば、自動的に(運転者の操作に依らずに)車両の操舵または速度のうち、一方または双方を制御して運転制御を実行することである。運転制御には、例えば、LKAS(Lane Keeping Assistance System)や、ALC(Auto Lane Changing)、ACC(Adaptive Cruise Control System)、CMBS(Collision Mitigation Brake System)等といった種々の運転制御が含まれてよい。また、運転制御には、ADAS(Advanced Driver Assistance System)等の運転者に対する運転支援制御が含まれてよい。自動運転車両は、運転者の手動運転によって運転が制御されることがあってもよい。
【0017】
[全体構成]
図1は、実施形態に係る車両制御装置を含む車両システム1の構成図である。車両システム1が搭載される車両(以下、車両Mと称する)は、例えば、二輪や三輪、四輪等の車両であり、その駆動源は、ディーゼルエンジンやガソリンエンジン等の内燃機関、電動機、或いはこれらの組み合わせである。電動機は、内燃機関に連結された発電機による発電電力、或いは二次電池や燃料電池等のバッテリ(蓄電池)の放電電力を使用して動作する。
【0018】
車両システム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に示す構成はあくまで一例であり、構成の一部が省略されてもよいし、更に別の構成が追加されてもよい。自動運転制御装置100は、「車両制御装置」の一例である。カメラ10と、レーダ装置12と、LIDAR14と、物体認識装置16とを組み合わせたものが「検知デバイスDD」の一例である。検知デバイスDDは、車両Mの周辺状況を検知する。HMI30は、「出力部」の一例である。
【0019】
カメラ10は、例えば、CCD(Charge Coupled Device)やCMOS(Complementary Metal Oxide Semiconductor)等の固体撮像素子を利用したデジタルカメラである。カメラ10は、車両システム1が搭載される車両Mの任意の箇所に取り付けられる。前方を撮像する場合、カメラ10は、フロントウインドシールド上部やルームミラー裏面、車体の前頭部等に取り付けられる。後方を撮像する場合、カメラ10は、リアウインドシールド上部やバックドア等に取り付けられる。側方を撮像する場合、カメラ10は、ドアミラー等に取り付けられる。カメラ10は、例えば、周期的に繰り返し車両Mの周辺を撮像する。カメラ10は、ステレオカメラであってもよい。
【0020】
レーダ装置12は、車両Mの周辺にミリ波等の電波を放射すると共に、周辺の物体によって反射された電波(反射波)を検出して少なくとも物体の位置(距離および方位)を検出する。レーダ装置12は、車両Mの任意の箇所に取り付けられる。レーダ装置12は、FM-CW(Frequency Modulated Continuous Wave)方式によって物体の位置および速度を検出してもよい。
【0021】
LIDAR14は、車両Mの周辺に光を照射し、散乱光を測定する。LIDAR14は、発光から受光までの時間に基づいて、対象までの距離を検出する。照射される光は、例えば、パルス状のレーザー光である。LIDAR14は、車両Mの任意の箇所に取り付けられる。
【0022】
物体認識装置16は、カメラ10、レーダ装置12、およびLIDAR14のうち一部または全部による検出結果に対してセンサフュージョン処理を行って、車両Mの周辺の物体の位置、種類、速度等を認識する。物体には、例えば、他車両(例えば、車両Mから所定距離以内に存在する周辺車両)、歩行者、自転車、道路構造物等が含まれる。道路構造物には、例えば、道路標識や交通信号機、踏切、縁石、中央分離帯、ガードレール、フェンス等が含まれる。また、道路構造物には、例えば、路面に描画または貼付された道路区画線(以下、単に「区画線」と称する)や横断歩道、自転車横断帯、一時停止線等の路面標識が含まれてもよい。物体認識装置16は、認識結果を自動運転制御装置100に出力する。なお、物体認識装置16は、カメラ10、レーダ装置12、およびLIDAR14の検出結果をそのまま自動運転制御装置100に出力してよい。その場合、車両システム1(具体的には検知デバイスDD)の構成から物体認識装置16が省略されてもよい。また、物体認識装置16は、自動運転制御装置100に含まれていてもよい。
【0023】
通信装置20は、例えば、セルラー網やWi-Fi網、Bluetooth(登録商標)、DSRC(Dedicated Short Range Communication)、LAN(Local Area Network)、WAN(WiDe Area Network)、インターネット等のネットワークを利用して、例えば、車両Mの周辺に存在する他車両、車両Mを利用する利用者の端末装置、或いは各種サーバ装置と通信する。
【0024】
HMI30は、車両Mの乗員(運転者を含む)に対して各種情報を出力すると共に、乗員による入力操作を受け付ける。HMI30には、例えば、各種表示装置、タッチパネル、スイッチ、キー、スピーカ、ブザー、マイク等が含まれる。また、HMI30には、一又は複数の色で点灯または点滅可能なインジケータやランプ等の発光部が含まれてもよい。HMI30は、例えば、インストルメントパネルやステアリングホイール82等、乗員が視認可能な位置に設けられる。
【0025】
車両センサ40は、車両Mの速度を検出する車速センサ、加速度を検出する加速度センサ、ヨーレート(例えば、車両Mの重心点を通る鉛直軸回りの回転角速度)を検出するヨーレートセンサ、車両Mの向きを検出する方位センサ等を含む。また、車両センサ40は、車両Mの位置を検出する位置センサが設けられていてもよい。位置センサは、例えば、GPS(Global Positioning System)装置から位置情報(経度・緯度情報)を取得するセンサである。また、位置センサは、ナビゲーション装置50のGNSS(Global Navigation Satellite System)受信機51を用いて位置情報を取得するセンサであってもよい。また、車両センサ40は、車両Mの傾き(水平方向に対する前後方向の傾きや左右方向の傾き)を検出する傾きセンサが設けられていてもよい。車両センサ40により検出した結果は、自動運転制御装置100に出力される。
【0026】
ナビゲーション装置50は、例えば、GNSS受信機51と、ナビHMI52と、経路決定部53とを備える。ナビゲーション装置50は、HDD(Hard Disk Drive)やフラッシュメモリ等の記憶装置に第1地図情報54を保持している。GNSS受信機51は、GNSS衛星から受信した信号に基づいて、車両Mの位置を特定する。車両Mの位置は、車両センサ40の出力を利用したINS(Inertial Navigation System)によって特定または補完されてもよい。GNSS受信機51は、車両センサ40に設けられてもよい。上述の位置センサおよびGNSS受信機51は、「位置検出部」の一例である。ナビHMI52は、表示装置、スピーカ、タッチパネル、キー等を含む。ナビHMI52は、前述したHMI30と一部または全部が共通化されてもよい。経路決定部53は、例えば、GNSS受信機51により特定された車両Mの位置(或いは入力された任意の位置)から、ナビHMI52を用いて乗員により入力された目的地までの経路(以下、地図上経路)を、第1地図情報54を参照して決定する。第1地図情報54は、例えば、所定区間の道路を示すリンクと、リンクによって接続されたノードとによって道路形状が表現された情報である。第1地図情報54は、POI(Point Of Interest)情報等を含んでもよい。地図上経路は、MPU60に出力される。ナビゲーション装置50は、地図上経路に基づいて、ナビHMI52を用いた経路案内を行ってもよい。ナビゲーション装置50は、通信装置20を介してナビゲーションサーバに現在位置と目的地を送信し、ナビゲーションサーバから地図上経路と同等の経路を取得してもよい。ナビゲーション装置50は、決定した地図上経路を、MPU60に出力する。
【0027】
MPU60は、例えば、推奨車線決定部61を含み、HDDやフラッシュメモリ等の記憶装置に第2地図情報62を保持している。推奨車線決定部61は、ナビゲーション装置50から提供された地図上経路を複数のブロックに分割し(例えば、車両進行方向に関して100[m]毎に分割し)、第2地図情報62を参照してブロックごとに推奨車線を決定する。推奨車線決定部61は、例えば、左から何番目の車線を走行するといった決定を行う。車線は、区画線により区画されている。推奨車線決定部61は、地図上経路に分岐箇所が存在する場合、車両Mが、分岐先に進行するための合理的な経路を走行できるように、推奨車線を決定する。
【0028】
第2地図情報62は、第1地図情報54よりも高精度な地図情報である。第2地図情報62は、例えば、道路形状や道路構造物に関する情報等を含んでいる。道路形状には、第1地図情報54よりも更に詳細な道路形状として、例えば、分岐や合流、トンネル(入口、出口)、カーブ路(入口、出口)、道路または区画線の曲率(曲率半径)、道路勾配情報、車線数、幅員等が含まれる。道路勾配情報には、例えば、上りや下りの識別情報や勾配(傾斜)度合を示す情報(例えば、勾配角度)、勾配の開始地点や終了地点、勾配度合が変化する勾配変化地点(屈曲地点)等の情報が含まれる。なお、上記情報は、第1地図情報54に格納されていてもよい。道路構造物に関する情報には、道路構造物の種別、位置、道路の延伸方向に対する向き、大きさ、形状、色等の情報が含まれてよい。道路構造物の種別において、例えば、区画線を1つの種別としてもよく、区画線に属するレーンマークや縁石、中央分離帯等のそれぞれを異なる種別としてもよい。また、区画線の種別には、例えば、車線変更が可能であることを示す区画線と、車線変更が不可能であることを示す区画線とが含まれてもよい。区画線の種別は、例えば、リンクを基準とした道路または車線の区間ごとに設定されてもよく、1つのリンク内に複数の種別が設定されてもよい。また、第2地図情報62には、道路や建物の位置情報(緯度経度)、住所情報(住所・郵便番号)、施設情報、電話番号情報、後述するモードAまたはモードBが禁止される禁止区間の情報等が含まれてよい。なお、第2地図情報62は、例えば、各点が鉛直方向に投影したXY平面(Z=0)上の座標で表された二次元地図である。
【0029】
第2地図情報62は、通信装置20が外部装置と通信することにより、随時、アップデートされてよい。第1地図情報54および第2地図情報62は、地図情報として一体に設けられていてもよい。また、地図情報(第1地図情報54および第2地図情報62)は、記憶部180に記憶されていてもよい。
【0030】
ドライバモニタカメラ70は、例えば、CCDやCMOS等の固体撮像素子を利用したデジタルカメラである。ドライバモニタカメラ70は、車両Mの運転席に着座した運転者や助手席や後部座席に着座した他の乗員の頭部を正面から(顔面を撮像する向きで)撮像可能な位置および向きで、車両Mにおける任意の箇所に取り付けられる。例えば、ドライバモニタカメラ70は、車両Mのインストルメントパネルの中央部に設けられた表示装置の上部や、フロンドウインドシールドの上部、ルームミラー等に取り付けられる。ドライバモニタカメラ70は、例えば、周期的に繰り返し車室内を含む画像を撮像する。
【0031】
運転操作子80は、例えば、ステアリングホイール82の他、アクセルペダル、ブレーキペダル、シフトレバー、その他の操作子を含む。運転操作子80には、操作量あるいは操作の有無を検出するセンサが取り付けられており、その検出結果は、自動運転制御装置100、もしくは、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220のうち一部または全部に出力される。ステアリングホイール82は、「運転者による操舵操作を受け付ける操作子」の一例である。操作子は、必ずしも環状である必要は無く、異形ステアリングホイールやジョイスティック、ボタン等の形態であってもよい。ステアリングホイール82には、ステアリング把持センサ84が取り付けられている。ステアリング把持センサ84は、静電容量センサ等により実現され、運転者がステアリングホイール82を把持している(力を加えられる状態で接していることをいう)か否かを検知可能な信号を自動運転制御装置100に出力する。また、運転操作子80には、例えば、運転者の手動運転による操舵または速度の操作量を調整する反力装置が設けられていてもよい。
【0032】
自動運転制御装置100は、車両Mの周辺状況等に基づいて車両Mの操舵または速度のうち、一方または双方を制御する運転制御を実行する。例えば、第1制御部120と、第2制御部160と、HMI制御部170と、記憶部180とを備える。第1制御部120と、第2制御部160と、HMI制御部170とは、それぞれ、例えば、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の記憶装置にインストールされてもよい。HMI制御部170は、「出力制御部」の一例である。
【0033】
記憶部180は、上記の各種記憶装置、或いはEEPROM(Electrically Erasable Programmable Read Only Memory)、ROM(Read Only Memory)、またはRAM(Random Access Memory)等により実現されてもよい。記憶部180には、例えば、プログラム、その他の各種情報等が格納される。また、記憶部180には、地図情報(第1地図情報54、第2地図情報62)が格納されていてもよい。
【0034】
図2は、第1制御部120および第2制御部160の機能構成図である。第1制御部120は、例えば、認識部130と、行動計画生成部140と、モード決定部150とを備える。第1制御部120は、例えば、AI(Artificial Intelligence;人工知能)による機能と、予め与えられたモデルによる機能とを並行して実現する。例えば、「交差点を認識する」機能は、ディープラーニング等による交差点の認識と、予め与えられた条件(パターンマッチング可能な信号、道路標示等がある)に基づく認識とが並行して実行され、双方に対してスコア付けして総合的に評価することで実現されてよい。これによって、自動運転の信頼性が担保される。また、第1制御部120は、例えば、MPU60やHMI制御部170等からの指示に基づいて車両Mの自動運転に関する制御を実行する。認識部130と、行動計画生成部140と、第2制御部160とを合わせたものが「運転制御部」の一例である。運転制御部は、例えば、認識部130に認識さされた結果等に基づいて、車両Mの操舵または速度のうち、一方または双方を制御する運転制御を実行する。
【0035】
認識部130は、検知デバイスDDの認識の結果(カメラ10、レーダ装置12、およびLIDAR14から物体認識装置16を介して入力された情報)に基づいて、車両Mの周辺状況を認識する。例えば、認識部130は、車両M、および車両Mの周辺に存在する物体の種別や位置、速度、加速度等の状態を認識する。物体の種別は、例えば、物体が車両であるか、歩行者であるか等の種別であってもよく、車両ごとに識別するための種別であってもよい。物体の位置は、例えば、車両Mの代表点(重心や駆動軸中心等)を原点とした絶対座標系(以下、車両座標系)の位置として認識され、制御に使用される。物体の位置は、その物体の重心やコーナー、進行方向の先端部等の代表点で表されてもよいし、表現された領域で表されてもよい。速度には、例えば、走行する車線の進行方向(縦方向)に対する車両Mおよび他車両の速度(以下、縦速度と称する)と、車線の横方向に対する車両Mおよび他車両の速度(以下、横速度)とが含まれる。物体の「状態」とは、例えば、物体が他車両等の移動体である場合には、物体の加速度やジャーク、あるいは「行動状態」(例えば車線変更をしている、またはしようとしているか否か)を含んでもよい。
【0036】
また、認識部130は、例えば、第1認識部132と、第2認識部134と、補正部136とを備える。これらの機能の詳細については後述する。
【0037】
行動計画生成部140は、認識部130の認識の結果やモード決定部150により決定された運転モード等に基づいて、自動運転等の運転制御により車両Mを走行させる行動計画を生成する。例えば、行動計画生成部140は、原則的には推奨車線決定部61により決定された推奨車線を走行し、更に、認識部130による認識結果または地図情報から取得された車両Mの現在位置に基づく周辺の道路形状、区画線の認識結果等に基づいて、車両Mの周辺状況に対応できるように、車両Mが自動的に(運転者の操作に依らずに)将来走行する目標軌道を生成する。目標軌道は、例えば、速度要素を含んでいる。例えば、目標軌道は、車両Mの到達すべき地点(軌道点)を順に並べたものとして表現される。軌道点は、道なり距離で所定の走行距離(例えば数[m]程度)ごとの車両Mの到達すべき地点であり、それとは別に、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとの目標速度(および目標加速度)が、目標軌道の一部として生成される。また、軌道点は、所定のサンプリング時間ごとの、そのサンプリング時刻における車両Mの到達すべき位置であってもよい。この場合、目標速度(および目標加速度)の情報は軌道点の間隔で表現される。
【0038】
行動計画生成部140は、目標軌道を生成するにあたり、自動運転のイベントを設定してよい。イベントには、例えば、車両Mを一定の速度で同じ車線を走行させる定速走行イベント、車両Mの前方の所定距離以内(例えば100[m]以内)に存在し、車両Mに最も近い他車両(以下、前方車両と称する)に車両Mを追従させる追従走行イベント、車両Mを自車線から隣接車線へと車線変更させる車線変更イベント、道路の分岐地点で車両Mを目的地側の車線に分岐させる分岐イベント、合流地点で車両Mを本線に合流させる合流イベント、自動運転を終了して手動運転に切り替えるためのテイクオーバーイベント等が含まれる。行動計画生成部140は、起動させたイベントに応じた目標軌道を生成する。
【0039】
モード決定部150は、車両Mの運転モードを、運転者(乗員の一例)に課されるタスクが異なる複数の運転モードの何れかに決定する。モード決定部150は、例えば、運転者状態判定部152と、判定部154と、車線決定部156と、モード変更処理部158とを備える。
【0040】
図3は、運転モードと車両Mの制御状態、およびタスクの対応関係の一例を示す図である。車両Mの運転モードには、例えば、モードAからモードEの5つのモードがある。上記5つのモードにおいて、制御状態すなわち車両Mの運転制御の自動化度合いは、モードAが最も高く、次いでモードB、モードC、モードDの順に低くなり、モードEが最も低い。この逆に、運転者に課されるタスクは、モードAが最も軽度であり、次いでモードB、モードC、モードDの順に重度となり、モードEが最も重度である。なお、モードDおよびEでは自動運転でない制御状態となるため、自動運転制御装置100としては自動運転に係る制御を終了し、運転支援または手動運転に移行させるまでが責務である。以下、それぞれの運転モードの内容について例示する。
【0041】
モードAでは、自動運転の状態となり、運転者には車両Mの周辺監視、ステアリングホイール82の把持(図ではステアリング把持)の何れも課されない。周辺監視は、少なくとも車両Mの前方の監視が含まれる。但し、モードAであっても運転者は、自動運転制御装置100を中心としたシステムからの要求に応じて速やかに手動運転に移行できる体勢であることが要求される。なお、ここで言う自動運転とは、操舵、加減速の何れも運転者の操作に依らずに制御されることをいう。前方とは、フロントウインドシールドを介して視認される車両Mの進行方向の空間を意味する。モードAは、例えば、高速道路等の自動車専用道路において、所定速度(例えば50[km/h]程度)以下で車両Mが走行しており、追従対象の前走車両が存在する等の条件が満たされる場合に実行可能な運転モードであり、TJP(Traffic Jam Pilot)と称される場合もある。この条件が満たされなくなった場合、モード決定部150は、モードBに車両Mの運転モードを変更する。
【0042】
モードBでは、運転支援の状態となり、運転者には車両Mの前方を監視するタスク(以下、前方監視)が課されるが、ステアリングホイール82を把持するタスクは課されない。モードCでは、運転支援の状態となり、運転者には前方監視のタスクと、ステアリングホイール82を把持するタスクが課される。モードDは、車両Mの操舵と加減速のうち少なくとも一方に関して、ある程度の運転者による運転操作が必要な運転モードである。例えば、モードDでは、ACCやLKASといった運転支援が行われる。モードEでは、操舵、加減速ともに運転者による運転操作が必要な手動運転の状態となる。モードD、モードEともに、当然ながら運転者には車両Mの前方を監視するタスクが課される。実施形態において、例えば、モードAが「第1の運転モード」である場合には、モードB~モードEが「第2の運転モード」の一例となる。また、モードBが「第1の運転モード」である場合には、モードC~モードEが「第2の運転モード」の一例となる。つまり、第2の運転モードでの運転者に課されるタスクは、第1の運転モードよりも重度のタスクとなる。
【0043】
運転モードは
図3に例示したものに限らず、他の定義によって規定されてもよい。例えば、前方監視、ステアリング把持共に必要な運転モードの中に、ステアリングホイール82が把持されていると判定されるための閾値が緩いものと厳しいものがあってもよい。より具体的に、ある運転モードでは運転者の左右何れかの手がステアリングホイール82に触れていればよいが、それよりも運転者に課されるタスクが重い別の運転モードでは運転者が両手で閾値以上の強さでステアリングホイール82を掴んでいる必要があるというように運転モードが定義されてもよい。その他、運転者に課されるタスクの重度が異なる運転モードは如何様に定義されてもよい。
【0044】
また、運転モードの違いによって、車両Mの運転者に対する運転支援度合(言い換えると、自動運転の制御度合)が異なっていてもよい。例えば、第2の運転モードの場合には、第1の運転モードよりも運転者に対する運転支援度合(自動運転による制御度合)を小さくする。また、第2の運転モードであってもモードが異なる場合に、運転者に課されるタスクが重度になるモードほど運転支援度合を小さくしてもよい。運転支援度合を小さくするとは、例えば、操舵の最大支援量(例えば、最大トルク)を低下させることが含まれる。また、運転支援度合を小さくするとは、上記内容に代えて(または加えて)、速度支援において、支援可能な速度範囲(例えば速度上限値)を小さくすることが含まれてもよい。
【0045】
運転者状態判定部152は、乗員(運転者)が運転に適した状態であるか否かを判定する。例えば、運転者状態判定部152は、上記のモード変更のために乗員の状態を監視し、乗員の状態がタスクに応じた状態であるか否かを判定する。例えば、運転者状態判定部152は、ドライバモニタカメラ70が撮像した画像を解析して姿勢推定処理を行い、乗員が、システムからの要求に応じて手動運転に移行できない体勢であるか否かを判定する。また、運転者状態判定部152は、ドライバモニタカメラ70が撮像した画像を解析して視線推定処理を行い、乗員が車両Mの周辺(より具体的には、前方)を監視しているか否かを判定する。所定時間以上、タスクに応じた状態でないと判定した場合、運転者状態判定部152は、乗員がそのタスクの運転に適していない状態、または、運転モードに係るタスクが運転者により実行されていない状態であると判定する。また、タスクに応じた状態であると判定した場合、運転者状態判定部152は、乗員がそのタスクの運転に適した状態、または、運転モードに係るタスクが運転者により実行されている状態であると判定する。また、運転者状態判定部152は、乗員が、運転交代が可能な状態であるか否か判定してもよい。
【0046】
判定部154は、第1認識部132の認識結果と第2認識部134の認識結果とを比較(マッチング)し、比較結果(マッチング結果)に基づいて、それぞれの認識結果に乖離(差異)があるか否かを判定する。また、判定部154は、それぞれの認識結果の乖離度合を取得してもよい。判定部154の機能の詳細については後述する。
【0047】
モード変更処理部158は、運転者状態判定部152による判定結果や判定部154による判定結果等に基づいて、車両Mが実行する運転モードを決定したり、変更したりする。例えば、モード変更処理部158は、決定した運転モードに係るタスクが運転者により実行されない場合に、よりタスクが重度な運転モードに車両Mの運転モードを変更する。例えば、モードAにおいて運転者が、システムからの要求に応じて手動運転に移行できない体勢である場合(例えば許容エリア外の脇見を継続している場合や、運転困難となる予兆が検出された場合)、モード変更処理部158は、HMI30を用いて運転者に手動運転への移行を促し、運転者が応じなければ車両Mを路肩に寄せて徐々に停止させ、自動運転を停止する、といった制御を行う。自動運転を停止した後は、車両MはモードDまたはEの状態になり、運転者の手動操作によって車両Mを発進させることが可能となる。以下、「自動運転を停止」に関して同様である。モードBにおいて運転者が前方を監視していない場合、モード変更処理部158は、HMI30を用いて運転者に前方監視を促し、運転者が応じなければ車両Mを路肩に寄せて徐々に停止させ、自動運転を停止する、といった制御を行う。モードCにおいて運転者が前方を監視していない場合、或いはステアリングホイール82を把持していない場合、モード変更処理部158は、HMI30を用いて運転者に前方監視を、および/またはステアリングホイール82を把持するように促し、運転者が応じなければ車両Mを路肩に寄せて徐々に停止させ、自動運転を停止する、といった制御を行う。判定部154による判定結果等に基づく運転モードの変更については、後述する。
【0048】
第2制御部160は、行動計画生成部140によって生成された目標軌道を、予定の時刻通りに車両Mが通過するように、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220を制御する。第2制御部160は、例えば、取得部162と、速度制御部164と、操舵制御部166とを備える。取得部162は、行動計画生成部140により生成された目標軌道(軌道点)の情報を取得し、メモリ(不図示)に記憶させる。速度制御部164は、メモリに記憶された目標軌道に付随する速度要素に基づいて、走行駆動力出力装置200またはブレーキ装置210を制御する。操舵制御部166は、メモリに記憶された目標軌道の曲がり具合に応じて、ステアリング装置220を制御する。速度制御部164および操舵制御部166の処理は、例えば、フィードフォワード制御とフィードバック制御との組み合わせにより実現される。一例として、操舵制御部166は、車両Mの前方の道路の曲率半径(或いは曲率)に応じたフィードフォワード制御と、目標軌道からの乖離に基づくフィードバック制御とを組み合わせて実行する。
【0049】
HMI制御部170は、HMI30により乗員に所定の情報を通知する。所定の情報には、例えば、車両Mの状態に関する情報や運転制御に関する情報等の車両Mの走行に関連のある情報が含まれる。車両Mの状態に関する情報には、例えば、車両Mの速度、エンジン回転数、シフト位置等が含まれる。また、運転制御に関する情報には、運転制御部における制御内容が含まれ、例えば、自動運転による運転制御の実行の有無、自動運転を開始するか否かを問い合わせる情報、自動運転による運転制御の状況(例えば、実行中の運転モードやイベントの内容)、運転支援度合に関する情報、運転モードの切り替えに関する情報等が含まれる。また、所定の情報には、例えば、車両Mの現在位置や目的地、燃料の残量に関する情報が含まれてよい。また、所定の情報には、テレビ番組、DVD等の記憶媒体に記憶されたコンテンツ(例えば、映画)等の車両Mの走行制御に関連しない情報が含まれてもよい。
【0050】
例えば、HMI制御部170は、上述した所定の情報を含む画像を生成し、生成した画像をHMI30の表示装置に表示させもよく、所定の情報を示す音声を生成し、生成した音声をHMI30のスピーカから出力させてもよい。また、HMI制御部170は、HMI30に含まれるインジケータやランプ等の発光部を所定の色で、点灯または点滅させてもよい。また、HMI制御部170は、HMI30により受け付けられた情報を通信装置20、ナビゲーション装置50、第1制御部120等に出力してもよい。また、HMI制御部170は、HMI30に出力させる各種情報を、通信装置20を介して車両Mの乗員が利用する端末装置に送信してもよい。端末装置は、例えば、スマートフォンやタブレット端末である。
【0051】
走行駆動力出力装置200は、車両Mが走行するための走行駆動力(トルク)を駆動輪に出力する。走行駆動力出力装置200は、例えば、内燃機関、電動機、および変速機等の組み合わせと、これらを制御するECU(Electronic Control Unit)とを備える。ECUは、第2制御部160から入力される情報、或いは運転操作子80のアクセルペダルから入力される情報に従って、上記の構成を制御する。
【0052】
ブレーキ装置210は、例えば、ブレーキキャリパーと、ブレーキキャリパーに油圧を伝達するシリンダと、シリンダに油圧を発生させる電動モータと、ブレーキECUとを備える。ブレーキECUは、第2制御部160から入力される情報、或いは運転操作子80のブレーキペダルから入力される情報に従って電動モータを制御し、制動操作に応じたブレーキトルクが各車輪に出力されるようにする。ブレーキ装置210は、ブレーキペダルの操作によって発生させた油圧を、マスターシリンダを介してシリンダに伝達する機構をバックアップとして備えてよい。なお、ブレーキ装置210は、上記説明した構成に限らず、第2制御部160から入力される情報に従ってアクチュエータを制御して、マスターシリンダの油圧をシリンダに伝達する電子制御式油圧ブレーキ装置であってもよい。
【0053】
ステアリング装置220は、例えば、ステアリングECUと、電動モータとを備える。電動モータは、例えば、ラックアンドピニオン機構に力を作用させて転舵輪の向きを変更する。ステアリングECUは、第2制御部160から入力される情報、或いは運転操作子80のステアリングホイールから入力される情報に従って、電動モータを駆動し、転舵輪の向きを変更させる。
【0054】
[認識部]
以下、認識部130の第1認識部132、第2認識部134、および補正部136の機能の詳細について説明する。
【0055】
第1認識部132は、検知デバイスDDの出力に基づいて、車両Mの周辺の区画線を認識する。例えば、第1認識部132は、車両Mの走行車線を区画する左右の区画線LL1、RL1を認識する。区画線LL1、RL1は、「第1の区画線」の一例である。例えば、第1認識部132は、カメラ10により撮像された画像(以下、カメラ画像と称する)を解析し、画像において隣接画素との輝度差が大きいエッジ点を抽出し、エッジ点を連ねて画像平面における第1の区画線LL1、RL1を認識する。また、第1認識部132は、車両Mの代表点(例えば、重心または中心)の位置を基準とした第1の区画線LL1、RL1の位置を車両座標系に変換する。この変換により、第1の区画線LL1、RL1の位置は、車両Mが走行中の路面上(例えば、XY平面上(Z=0)または水平面上)に投影した座標系で表される。この座標系で表現される地図は、カメラ画像により認識された各点をカメラ10から視線方向に向かってXY平面上に投影した車両Mの位置からの距離を示す測距地図となる。なお、第1認識部132は、カメラ画像の解析結果に基づいて、第1の区画線LL1、RL1の曲率(または曲率半径)を認識してもよく、カメラ画像に含まれる道路標識の種類や内容を認識してもよい。
【0056】
第2認識部134は、例えば、位置検出部により検出された車両Mの位置に基づいて地図情報から車両Mの走行車線を区画する左右の区画線LL2、RL2を認識する。区画線LL2、RL2は、「第2の区画線」の一例である。例えば、第2認識部134は、位置検出部により検出された車両Mの位置情報を取得し、取得した位置情報に基づいて第2地図情報62を参照し、第2地図情報62から車両Mの位置に存在する車線を区画する第2の区画線LL2、RL2を認識する。また、第2認識部134は、第2地図情報62から、区画線LL2およびRL2のそれぞれの曲率(または曲率半径)や道路勾配情報を認識してもよい。
【0057】
補正部136は、車両の進行方向の道路勾配情報に基づいて、第2認識部134により認識された第3の区画線LL2、RL2を補正する。道路勾配情報は、地図情報(例えば、第2地図情報62)から取得する。
図4は、補正部136の処理の内容について説明するための図である。
図4の例において、車両Mは、車線L1を延伸方向(図中X軸方向)に速度VMで走行しているものとする。また、
図4の例では、車両Mの進行方向に勾配角度θ1の上り坂(上り勾配)が存在しているものとする。
図4の例において、点R1~R4は、カメラ画像を用いて第1認識部132により認識された車両L1を区画する第1の区画線上の点を示し、点M1~M4は、地図情報を用いて第2認識部134により認識された車線L1を区画する第2の区画線上の点を示す。
【0058】
図4の例において、例えば上り坂が開始する位置(勾配変化地点SP1)の手前を車両Mが走行している場合、車両Mの前方を撮像するカメラ10のカメラ画像から認識される勾配がない平坦な地点R1、R2では、地図精度(または地図違い)やカメラ性能等に問題がない場合に、地図情報から得られる第2の区画線上の地点M1、M2と一致することになる。しかしながら、車両Mから見て勾配変化地点SP1より先の勾配がある地点R3、R4では、カメラ画像から認識された地点R3、R4に対し、第1認識部132により座標変換された測距地図上に表される地点はカメラ10からの視線方向への投影によって地点R3#、R4#となるが、第2認識部134により地図情報から得られる地図では、鉛直方向への投影によって地点M3、M4となってしまう。このような状況で、第1の区画線と第2の区画線とが乖離した場合に、従来では地図精度やカメラ性能による乖離なのか、勾配による乖離なのかが判定できず、走行車線を適切に決定することができない場合があった。したがって、実施形態において、補正部136は、車両Mの進行方向の道路勾配情報に基づいて、車両Mの進行方向に勾配がある場合に、地図情報から得られる第2区画線LL2、RL2の位置を補正する。
【0059】
なお、道路勾配情報は、車両Mの位置情報に基づいて地図情報から第2の区画線LL2、RL2を取得した際に同時に取得される。道路勾配情報は、勾配変化があるごとに取得され、区画線ごとだけでなく、区画線により区画された車線ごとや、その車線を含む道路ごとに取得されてもよい。また、道路勾配情報は、カメラ10の撮像画像に含まれる勾配区間付近(所定距離以内)に設けられた道路標識MK1の画像を第1認識部132が認識することで取得されてもよい。また、道路勾配情報は、勾配区間に車両Mが存在する場合には、車両センサ40に含まれる傾斜センサから取得されてもよい。なお、例えば、補正部136は、地図情報から得られる道路勾配情報を優先し、地図情報から道路勾配情報が取得できない場合に、第1認識部132や車両センサから得られる道路勾配情報を取得する。地図情報から優先して道路勾配情報を取得することで、カメラ画像から勾配区間に設置された道路標識MK1が認識できない場合や、車両Mが勾配区間を走行していない場合(勾配変化地点SP1より手前を走行している場合)であっても、進行方向に存在する勾配区間の道路勾配情報を取得することができる。
【0060】
補正部136は、道路勾配情報に含まれる勾配度合に基づいて、第2の区画線を三次元の区画線に変換し、変換した三次元の区画線に基づいて測距地図を生成する。具体的には、補正部136は、例えば、二次元地図上の勾配区間の第2の区画線LL2、RL2を、勾配度合に基づいて三次元の区画線に変換し、変換した三次元の区画線上の各点を、車両Mからの距離を示す座標系に変換して測距地図を生成する。これにより、
図4の例において、地点R3、R4に対応する第2の区画線上の地点M3、M4は、勾配度合を示す勾配角度θ1に基づく座標変換によって地点M3#、M4#に位置付けられる。
【0061】
なお、補正部136は、上述した補正処理の他、予め決められた座標変換行列や関数等を用いて同様の結果となるように補正してもよく、第2の区画線LL2,RL2および勾配角度θ1を入力とし、変換後の第2の区画線LL2#、RL2#を出力とする学習済みモデルを用いて補正してもよい。学習済みモデルは、予め用意した第2の区画線および道路勾配情報と、真値(正解)データとを用いた機械学習(ニューラルネットワーク)や深層学習(ディープラーニング)等のAIによる機能によって生成されてもよく、通信装置20を介して接続可能な外部サーバから取得してもよい。
【0062】
補正部136は、勾配区間に含まれる第2の区画線LL2,RL2の各点に対して上述した補正を行い、第2の区画線LL2#、RL2#を生成する。例えば、車両Mの進行方向が上り坂である場合、地図情報から得られた勾配区間に含まれる第2の区画線は、上述した補正処理によって、勾配角度に応じて延伸方向に縮尺を大きくした(伸ばした)区画線となる。
【0063】
図5は、車両Mの進行方向に下り坂(下り勾配)がある場合の補正について説明するための図である。車両Mの進行方向が下り坂である場合であって、例えば下り坂が開始する位置(勾配変化地点SP2)の手前を車両Mが走行している場合、
図4と同様に勾配がない平坦な地点R1、R2では、地図精度(または地図違い)やカメラ性能等に問題がない場合に、地図情報から得られる第2の区画線上の地点M1、M2と一致することになる。しかしながら、車両Mから見て勾配変化地点SP2より先の勾配がある地点R3では、カメラ画像から認識された地点R3に対し、第1認識部132により座標変換された測距地図上に表される地点はカメラ10からの視線方向への投影によって地点R3#となるが、第2認識部134により地図情報から得られる地図では、鉛直方向への投影によって地点M3となってしまう。したがって、補正部136は、上り坂の場合と同様に道路勾配情報に基づいて、第2の区画線を三次元の区画線に変換し、変換した三次元の区画線に基づいて測距地図を生成る。これにより、
図5の例において、地点R3に対応する第2の区画線上の地点M3は、勾配度合を示す勾配角度θ2に基づく座標変換によって地点M3#に位置付けられる。補正部136は、勾配区間に含まれる第2の区画線LL2,RL2の各点に対して上述した補正を行い、第2の区画線LL2#、RL2#を生成する。例えば、車両Mの進行方向が下り坂である場合、地図情報から得られた勾配区間に含まれる第2の区画線は、上述した補正処理によって、勾配角度に応じて延伸方向に縮尺を小さくした(縮めた)区画線となる。
【0064】
なお、補正部136は、勾配角度θ1、θ2が閾値以上である場合に上述した補正処理を行い、閾値未満の場合に補正処理を抑制してもよい。これにより、補正部136による処理を減らすことができる。また、上り坂の場合と閾値と下り坂の場合の閾値は、同じ閾値でもよく、異なる閾値でもよい。
【0065】
また、補正部136は、第2の区画線LL2、RL2の補正を区画線ごとではなく、第2の区画線LL2、RL2により区画された車線(第2の区画線LL2、RL2を一対とする車線)単位で行ってもよい。更に補正部136は、複数車線を含む道路ごとに補正処理を行ってもよい。これにより、補正処理を簡略化することができ、処理負荷を軽減させることができる。なお、区画線ごとに補正するか、車線ごとに補正するか、または、道路ごとに補正するかについては、例えば、道路形状や車両Mの速度等に基づいて決定されてよい。
【0066】
また、補正部136は、勾配区間が、曲率が所定値以上(曲率半径が所定値未満と言い換えてもよい)のカーブ路である場合に、曲率に応じた第2の区画線の補正を行ってもよい。
図6は、勾配区間がカーブ路である場合の補正について説明するための図である。
図6の例では、車線L2を速度VMで走行する車両Mを示している。また、
図6に示す車線L2を区画する区画線は、第2認識部134により地図情報から取得した第2の区画線LL2、RL2であるものとする。また、車線L2のカーブ路は、補正を行う閾値以上の勾配角度を有する上り坂であるものとする。また、
図6に示す地点R1L~R3L、カメラ画像を用いて第1認識部132により認識された車両Mの左側の第1の区画線LL1上の点を示し、地点R1R~R3Rは、第1認識部132により認識された車両Mの右側の第1の区画線左側の第1の区画線LL1上の点を示している。
【0067】
図6に示すように、勾配区間の第1の区画線の認識地点R2L、R3L、R2R、およびR3Rは、第1認識部132による測距地図への座標変換(車両座標系への変換)によって、それぞれ地点R2L#、R3L#、R2R#、およびR3R#となる。そのため、勾配変化地点SP1より手前を走行している車両Mにおける第1の区画線LL1、RL1と第2の区画線LL2、RL2との比較において、勾配区間における乖離が大きくなる可能性がある。更に、曲率に応じて座標変換後の位置が異なるため乖離度合も大きくなる可能性がある。したがって、補正部136は、勾配区間にカーブ路がある場合には、進行方向の勾配度合および曲率の大きさに応じて、第2の区画線LL2、RL2の位置を補正して測距地図を生成する。
【0068】
なお、カーブ路の場合には、車線L2の左右の区画線の曲率が異なっていたり、バンク等の横方向(道路幅方向)に勾配している場合もあり得る。したがって、補正部136は、区画線ごとの曲率や、横方向(道路幅方向)の勾配度合にも対応させて、第2の区画線LL2、RL2の位置を補正してもよい。上述した第2の区画線の補正を行うことで、道路の勾配や曲率による影響がより少ない状態で、第1の区画線と第2の区画線とを比較することができ、モード決定部150において、より適切に車両の走行車線を決定することができる。
【0069】
[モード決定部]
次に、モード決定部150の機能の詳細について説明する。なお、以下では、主に判定部154、車線決定部156、および車線決定部156を中心として説明する。判定部154は、第1認識部132により認識された第1の区画線LL1、RL1と、第2認識部134により認識され、且つ、補正部136により補正された第2の区画線LL2#、RL2#との比較を行い、それぞれの区画線が乖離しているか否かを判定する。なお、勾配角度が閾値未満であり、補正部136による補正が行われていない場合には、第1の区画線LL1、RL1と、第2の区画線LL2、RL2について、同様の比較が行われる。
【0070】
図7は、判定部154の処理について説明するための図である。
図7の例では、車両Mが速度VMで車線L3の延伸方向(図中X軸方向)に走行しているものとする。また、
図7では、車両座標系の平面(XY平面)において第1認識部132により認識された第1の区画線LL1、RL1と、第2認識部134により認識され、且つ勾配度合に基づいて補正部136により補正された第2の区画線LL2#、RL2#とを示している。つまり、それぞれの区画線は2次元平面(XY平面)の測距地図として示されている。
図7に示す位置(X1,Y1)は、第1認識部132および第2認識部134により区画線を認識したときの車両Mの代表点を示す。
【0071】
判定部154は、XY平面において、位置(X1,Y1)を重畳させると共に、車両Mの向きが同じになるように重畳させて、左右それぞれ(区画線LL1と区画線LL2#、および、区画線RL1とRL2#)の乖離度合を取得する。乖離とは、例えば、横位置(図中Y軸方向)の乖離(例えば、図中の区画線LL1とLL2#との横ずれ量W1)でもよく、縦位置(図中X軸方向の距離の長短)の差分でもよく、その組み合わせでもよい。また、乖離とは、上記内容に代えて(または加えて)、区画線LL1とLL2#とがなす角度(乖離角度)、または区画線RL1とRL2#とがなす角度でもよい。また、乖離は、左右それぞれの横ずれ量や乖離角度を平均したものでもよい。判定部154は、横ずれ量W1や剥離角度が大きくなるほど、乖離度合を大きくする。
【0072】
判定部154は、区画線LL1とLL2#、および区画線RL1とRL2#とのそれぞれの乖離度合が閾値未満である場合に、第1の区画線と第2の区画線とが乖離していない(合致している)と判定し、閾値以上である場合に乖離している(合致していない)と判定する。また、判定部154は、乖離度合が閾値以上となる状態が所定時間以上継続する場合に、第1の区画線と第2の区画線とが乖離していると判定してもよい。これにより、乖離度合の判定結果が頻繁に切り替わることを抑制することができるため、判定結果に基づく運転制御をより安定化させることができる。このように、第1の区画線と補正された第2の区画線とを比較することで、道路勾配に起因する乖離(誤差)を抑制することができ、より正確に比較することができる。
【0073】
車線決定部156は、判定部154の判定結果に基づいて、車両Mの走行車線を決定する。例えば、判定部154により第1の区画線LL1、RL1と、第2の区画線LL2#、RL2#との乖離度合が閾値未満であると判定した場合(合致する場合)、車線決定部156は、第2の区画線により区画された車線を走行車線として決定する。また、第1の区画線と第2の区画線との乖離度合が閾値以上である場合(合致しない場合)、車線決定部156は、第1の区画線または第2の区画線のうち、第1の区画線により区画された車線を走行車線として決定する。なお、車線決定部156は、乖離度合が閾値以上である場合に、第2の区画線の情報を補間的に用いてもよい。
【0074】
行動計画生成部140は、実行する運転モードに基づき自動運転や運転支援が実行される場合に、車線決定部156により決定された走行車線を車両Mが走行するための目標軌道を生成し、生成した目標軌道を第2制御部160に出力して運転制御を実行させる。
【0075】
モード変更処理部158は、例えば、判定部154による判定結果に基づいて、運転モードを変更する。例えば、モード変更処理部158は、第1の区画線と第2の区画線の左右両方の区画線が共に合致し(乖離度合が閾値未満であり)、且つ第1の運転モードを実行可能な他の条件を満たす場合には、第2の運転モードから第1の運転モードに変更したり、第2の運転モードの中で運転者に課するタスクが軽度なモードに変更したり、実行中の第1の運転モードを継続させる。また、モード変更処理部158は、第1の運転モードを実行している状態において、第1の区画線と第2の区画線の少なくとも左右一方の乖離度合が閾値以上である場合に、第1の運転モードから第2の運転モード(例えば、モードC~モードE)へ切り替えるための処理を実行する。なお、モード変更処理部158は、乖離度合が閾値以上となる状態が所定時間以上継続するまで、第1の運転モードから第2の運転モードへの切り替えを抑制してもよい。これにより、乖離度合が閾値以上となるのが一時的である場合の運転モードの変更を抑制し、より安定性の高い運転制御を実現できる。また、モード変更処理部158は、乖離度合が閾値以上となる状態の継続時間に応じて、第2の運転モードに含まれる複数のモードを乗員に課されるタスクがより重度となるモードに段階的に切り替えてもよい。この場合、継続時間が大きくなるほど、より重度なタスクとなるモードに切り替わる。
【0076】
HMI制御部170は、第1の区画線と第2の区画線との乖離により第1の運転モードから第2の運転モードへ切り替わる場合に、運転モードが切り替わることに加えて、切り替わる理由を示す情報をHMI30に出力させてもよい。また、HMI制御部170は、運転モードが切り替わるための乗員に課されるタスク(例えば、前方監視やステアリングホイール82の把持)に関する情報等をHMI30に出力させてもよい。また、HMI制御部170は、第1の区画線と第2の区画線との乖離により第1の運転モードから第2の運転モードへ切り替わることによって、車両Mの運転者に対する運転支援度合が異なる場合に、運転支援度合に応じた支援状態に関する情報をHMI30に出力させてもよい。また、HMI制御部170は、運転モードの変更や支援状態の変更に応じて、HMI30に含まれるインジケータやランプ等の発光部の発光態様(表示態様)を異ならせてもよい。発光態様とは、例えば、点灯や点滅、点滅周期、発光色等の態様である。これにより、運転者に、運転支援状態の変化を明確に把握させることができる。
【0077】
[処理フロー]
次に、実施形態に係る自動運転制御装置100により実行される処理の流れについて説明する。
図8は、自動運転制御装置100により実行される処理の流れの一例を示すフローチャートである。なお、以下では、自動運転制御装置100により実行される処理のうち、第1認識部132および第2認識部134により認識された区画線の乖離度合に基づいて、走行車線を決定したり、車両Mの運転モードを切り替える処理を中心として説明する。また、車両Mは、第1の運転モード(例えば、モードA)による運転制御が実行されているものとする。また、以下の処理では、運転者状態判定部152による判定結果において、運転者の状態は、実行中のモードまたは切り替え後のモードに適した状態である(つまり、運転者状態判定部152の判定結果に基づいて、モードの切り替えが発生しない状況である)ものとする。
図8に示す処理は、所定のタイミングで繰り返し実行されてよい。
【0078】
図8の例において、第1認識部132は、検知デバイスDDの出力に基づいて車両Mの走行車線を区画する第1の区画線を認識する(ステップS100)。次に、第2認識部134は、位置検出部から得られる車両Mの位置情報に基づいて地図情報を参照し、車両Mの走行車線を区画する第2の区画線を認識する(ステップS110)。なお、ステップS100およびS110の処理は、逆の順序で行われてもよく、並行して行われてもよい。
【0079】
次に、補正部136は、車両Mの進行方向の道路勾配情報を取得し、取得した道路勾配情報に含まれる勾配度合が閾値以上であるか否かを判定する(ステップS120)。閾値以上であると判定した場合、補正部136は、座標変換等により第2の区画線を補正する(ステップS130)。
【0080】
ステップS130の処理後、またはステップS120の処理において、勾配度合が閾値以上ではないと判定された場合、判定部154は、第1の区画線と第2の区画線(補正部136により補正された場合には、補正された第2の区画線)とを比較し(ステップS140)、第1の区画線と第2の区画線との乖離度合が閾値以上であるか否かを判定する(ステップS150)。閾値以上ではない(閾値未満である)と判定した場合、車線決定部156は、第2の区画線に基づいて車両Mの走行車線を決定する(ステップS160)。次に、モード変更処理部158は、第1の運転モードを継続させて、決定された走行車線を走行させる処理を行う(ステップS170)。また、ステップS150の処理において、乖離度合が閾値以上であると判定した場合、車線決定部156は、第1の区画線に基づいて車両Mの走行車線を決定する(ステップS180)。次に、モード変更処理部158は、第1の運転モードから第2の運転モードに切り替えて、決定された走行車線を走行させる処理を行う(ステップS190)。これにより、本フローチャートの処理は、終了する。
【0081】
[変形例]
実施形態において、補正部136は、車両Mが勾配区間に存在する場合(勾配度合が変化する勾配変化地点を通過した場合)であって、且つ、車両Mの進行方向の所定距離以内に勾配変化地点が存在しない場合に、走行中の道路の勾配度合が閾値以上であっても、第2の区画線の補正を抑制してもよい。補正を抑制するとは、補正しないことや補正量を基準よりも小さくすることが含まれる。坂道を走行する車両Mの進行方向に勾配変化地点が存在しない場合には、道路勾配があっても車両Mから見ると平坦な路面であるため、このような場合に上述の補正処理を抑制することで、より適切な補正を行うことができる。
【0082】
また、補正部136は、車両Mの進行方向の道路勾配情報に基づいて、第2の区画線LL2、RL2に代えて(または加えて)、第1の区画線LL1、RL1を補正してもよい。
【0083】
以上説明した実施形態によれば、車両制御装置において、車両Mの周辺状況を検知した検知デバイスDDの出力に基づいて、車両Mの走行車線を区画する第1の区画線を認識する第1認識部132と、車両Mの位置情報と地図情報とに基づいて、走行車線を区画する第2の区画線を認識する第2認識部134と、車両Mの進行方向の道路勾配情報に基づいて第2の区画線を補正する補正部136と、第1の区画線と補正部136により補正された第2の区画線との比較結果に基づいて車両Mの走行車線を決定する車線決定部156と、を備えることにより、より適切に車両の走行車線を決定することができる。
【0084】
また、実施形態によれば、地図情報から得られた第2の区画線を道路勾配情報に基づき補正して、第1の区画線と比較することで、道路勾配変化に起因する乖離を抑制し、より適切な乖離判定を行うことができる。これにより、地図精度(または地図違い)やカメラ性能等による乖離を精度よく把握することができる。また、実施形態によれば、精度の高い乖離判定によって車線決定の正確性を向上させることができる。特に自動運転の分野においては、車両Mが将来走行する車線に対応した目標軌道が生成され、その目標軌道に沿った運転制御が実行されるため、車線決定の正確性を向上させることで、より適切な運転制御が実現できる。したがって、実施形態によれば、持続可能な輸送システムの発展に寄与することができる。
【0085】
上記説明した実施形態は、以下のように表現することができる。
コンピュータによって読み込み可能な命令(computer-readable instructions)を格納する記憶媒体(storage medium)と、
前記記憶媒体に接続されたプロセッサと、を備え、
前記プロセッサは、前記コンピュータによって読み込み可能な命令を実行することにより(the processor executing the computer-readable instructions to:)
車両の周辺状況を検知した検知デバイスの出力に基づいて、前記車両の走行車線を区画する第1の区画線を認識し、
前記車両の位置情報と地図情報とに基づいて、前記走行車線を区画する第2の区画線を認識し、
前記車両の進行方向の道路勾配情報に基づいて前記第2の区画線を補正し、
前記第1の区画線と、補正した前記第2の区画線との比較結果に基づいて、前記車両の走行車線を決定する、
車両制御装置。
【0086】
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
【符号の説明】
【0087】
1…車両システム、10…カメラ、12…レーダ装置、14…LIDAR、16…物体認識装置、20…通信装置、30…HMI、40…車両センサ、50…ナビゲーション装置、60…MPU、70…ドライバモニタカメラ、80…運転操作子、100…自動運転制御装置、120…第1制御部、130…認識部、132…第1認識部、134…第2認識部、136…補正部、140…行動計画生成部、150…モード決定部、152…運転者状態判定部、154…判定部、156…車線決定部、158…モード変更処理部、160…第2制御部、162…取得部、164…速度制御部、166…操舵制御部、170…HMI制御部、180…記憶部、200…走行駆動力出力装置、210…ブレーキ装置、220…ステアリング装置