以下、図面を参照し、本発明の車両制御装置、車両制御方法、およびプログラムの実施形態について説明する。自動運転車両が走行している経路において、停車中の他車両が存在する場合、他車両がこれから発進するのか否かを判定し、自動運転車両の制御を行うことが重要である。停車中の車両を認識する毎に一時停止等の制御を実行するとした場合、円滑な走行が妨げられる可能性がある。車両制御装置は、停車中の他車両の状態に基づいて発進するか否かを判定して自車両の走行を制御するものである。
[全体構成]
図1は、実施形態に係る車両制御装置を利用した車両システム1の構成図である。車両システム1が搭載される車両は、例えば、二輪や三輪、四輪等の車両であり、その駆動源は、ディーゼルエンジンやガソリンエンジンなどの内燃機関、電動機、或いはこれらの組み合わせである。電動機を備える場合、電動機は、内燃機関に連結された発電機による発電電力、或いは二次電池や燃料電池の放電電力を使用して動作する。
車両システム1は、例えば、カメラ10(撮像部の一例)と、レーダ装置12と、ファインダ14と、物体認識装置16と、通信装置20(通信部の一例)と、HMI(Human Machine Interface)30と、車両センサ40と、ナビゲーション装置50と、MPU(Map Positioning Unit)60と、運転操作子80と、自動運転制御装置100(車両制御装置の一例)と、走行駆動力出力装置200と、ブレーキ装置210と、ステアリング装置220とを備える。これらの装置や機器は、CAN(Controller Area Network)通信線等の多重通信線やシリアル通信線、無線通信網等によって互いに接続される。なお、図1に示す構成はあくまで一例であり、構成の一部が省略されてもよいし、更に別の構成が追加されてもよい。
カメラ10は、例えば、CCD(Charge Coupled Device)やCMOS(Complementary Metal Oxide Semiconductor)等の固体撮像素子を利用したデジタルカメラである。カメラ10は、車両システム1が搭載される車両(以下、自車両Mと称する)の任意の箇所に一つまたは複数が取り付けられる。前方を撮像する場合、カメラ10は、フロントウインドシールド上部やルームミラー裏面等に取り付けられる。カメラ10は、例えば、周期的に繰り返し自車両Mの周辺を撮像する。カメラ10は、ステレオカメラであってもよい。
レーダ装置12は、自車両Mの周辺にミリ波などの電波を放射すると共に、物体によって反射された電波(反射波)を検出して少なくとも物体の位置(距離および方位)を検出する。レーダ装置12は、自車両Mの任意の箇所に一つまたは複数が取り付けられる。レーダ装置12は、FM−CW(Frequency Modulated Continuous Wave)方式によって物体の位置および速度を検出してもよい。
ファインダ14は、LIDAR(Light Detection and Ranging)である。ファインダ14は、自車両Mの周辺に光を照射し、散乱光を測定する。ファインダ14は、発光から受光までの時間に基づいて、対象までの距離を検出する。照射される光は、例えば、パルス状のレーザー光である。ファインダ14は、自車両Mの任意の箇所に一つまたは複数が取り付けられる。
物体認識装置16は、カメラ10、レーダ装置12、およびファインダ14のうち一部または全部による検出結果に対してセンサフュージョン処理を行って、物体の位置、種類、速度などを認識する。物体認識装置16は、認識結果を自動運転制御装置100に出力する。また、物体認識装置16は、必要に応じて、カメラ10、レーダ装置12、およびファインダ14の検出結果をそのまま自動運転制御装置100に出力してよい。
通信装置20は、例えば、セルラー網やWi−Fi網、Bluetooth(登録商標)、DSRC(Dedicated Short Range Communication)などを利用して、自車両Mの周辺に存在する他車両と通信し、或いは無線基地局を介して各種サーバ装置と通信する。
HMI30は、自車両Mの乗員に対して各種情報を提示すると共に、乗員による入力操作を受け付ける。HMI30は、各種表示装置、スピーカ、ブザー、タッチパネル、スイッチ、キーなどを含む。
車両センサ40は、自車両Mの速度を検出する車速センサ、加速度を検出する加速度センサ、鉛直軸回りの角速度を検出するヨーレートセンサ、自車両Mの向きを検出する方位センサ等を含む。
ナビゲーション装置50は、例えば、GNSS(Global Navigation Satellite System)受信機51と、ナビHMI52と、経路決定部53とを備え、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)情報などを含んでもよい。経路決定部53により決定された地図上経路は、MPU60に出力される。また、ナビゲーション装置50は、経路決定部53により決定された地図上経路に基づいて、ナビHMI52を用いた経路案内を行ってもよい。なお、ナビゲーション装置50は、例えば、乗員の保有するスマートフォンやタブレット端末等の端末装置の機能によって実現されてもよい。また、ナビゲーション装置50は、通信装置20を介してナビゲーションサーバに現在位置と目的地を送信し、ナビゲーションサーバから返信された地図上経路を取得してもよい。
MPU60は、例えば、推奨車線決定部61として機能し、HDDやフラッシュメモリなどの記憶装置に第2地図情報62を保持している。推奨車線決定部61は、ナビゲーション装置50から提供された経路を複数のブロックに分割し(例えば、車両進行方向に関して100[m]毎に分割し)、第2地図情報62を参照してブロックごとに推奨車線を決定する。推奨車線決定部61は、左から何番目の車線を走行するといった決定を行う。推奨車線決定部61は、経路において分岐箇所や合流箇所などが存在する場合、自車両Mが、分岐先に進行するための合理的な経路を走行できるように、推奨車線を決定する。
第2地図情報62は、第1地図情報54よりも高精度な地図情報である。第2地図情報62は、例えば、車線の中央の情報あるいは車線の境界の情報等を含んでいる。また、第2地図情報62には、道路情報、交通規制情報、住所情報(住所・郵便番号)、施設情報、電話番号情報などが含まれてよい。第2地図情報62は、通信装置20を用いて他装置にアクセスすることにより、随時、アップデートされてよい。
運転操作子80は、例えば、アクセルペダル、ブレーキペダル、シフトレバー、ステアリングホイール、異形ステア、ジョイスティックその他の操作子を含む。運転操作子80には、操作量あるいは操作の有無を検出するセンサが取り付けられており、その検出結果は、自動運転制御装置100、もしくは、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220のうち一方または双方に出力される。
自動運転制御装置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を含む)によって実現されてもよいし、ソフトウェアとハードウェアの協働によって実現されてもよい。
図2は、第1制御部120および第2制御部160の機能構成図である。第1制御部120は、例えば、認識部130と、行動計画生成部140とを備える。第1制御部120は、例えば、AI(Artificial Intelligence;人口知能)による機能と、予め与えられたモデルによる機能とを並行して実現する。例えば、「交差点を認識する」機能は、ディープラーニング等による交差点の認識と、予め与えられた条件(パターンマッチング可能な信号、道路標示などがある)に基づく認識とが並行して実行され、双方に対してスコア付けして総合的に評価することで実現される。これによって、自動運転の信頼性が担保される。
まずは、認識部130および行動計画生成部140の基本的機能について説明する。認識部130は、カメラ10、レーダ装置12、ファインダ14から物体認識装置16を介して入力される情報に基づいて、自車両Mの周辺にある物体の位置、および速度、加速度等の状態を認識する。物体の位置は、例えば、自車両Mの代表点(重心や駆動軸中心など)を原点とした絶対座標上の位置として認識され、制御に使用される。物体の位置は、その物体の重心やコーナー等の代表点で表されてもよいし、表現された領域で表されてもよい。物体の「状態」とは、物体の加速度やジャーク、あるいは「行動状態」(例えば車線変更をしている、またはしようとしているか否か)を含んでもよい。また、認識部130は、カメラ10の撮像画像に基づいて、自車両Mがこれから通過するカーブの形状を認識する。認識部130は、カーブの形状をカメラ10の撮像画像から実平面に変換し、例えば、二次元の点列情報、或いはこれと同等なモデルを用いて表現した情報を、カーブの形状を示す情報として行動計画生成部140に出力する。
また、認識部130は、例えば、自車両Mが走行している車線(走行車線)を認識する。例えば、認識部130は、第2地図情報62から得られる道路区画線のパターン(例えば実線と破線の配列)と、カメラ10によって撮像された画像から認識される自車両Mの周辺の道路区画線のパターンとを比較することで、走行車線を認識する。なお、認識部130は、道路区画線に限らず、道路区画線や路肩、縁石、中央分離帯、ガードレールなどを含む走路境界(道路境界)を認識することで、走行車線を認識してもよい。この認識において、ナビゲーション装置50から取得される自車両Mの位置やINSによる処理結果が加味されてもよい。また、認識部130は、一時停止線、障害物、赤信号、料金所、他車両、その他の道路事象を認識する。
認識部130は、走行車線を認識する際に、走行車線に対する自車両Mの位置や姿勢を認識する。認識部130は、例えば、自車両Mの基準点の車線中央からの乖離、および自車両Mの進行方向の車線中央を連ねた線に対してなす角度を、走行車線に対する自車両Mの相対位置および姿勢として認識してもよい。また、これに代えて、認識部130は、走行車線のいずれかの側端部(道路区画線または道路境界)に対する自車両Mの基準点の位置などを、走行車線に対する自車両Mの相対位置として認識してもよい。
また、認識部130は、上記の認識処理において、認識精度を導出し、認識精度情報として行動計画生成部140に出力してもよい。例えば、認識部130は、一定期間において、道路区画線を認識できた頻度に基づいて、認識精度情報を生成する。
また、認識部130は、停車中の他車両の状態を認識し、他車両が発進するか否かを判定する。認識部130の他車両の認識については、後述する。
行動計画生成部140は、原則的には推奨車線決定部61により決定された推奨車線を走行し、更に、自車両Mの周辺状況に対応した自動運転が実行されるように、自車両Mが将来走行する目標軌道を生成する。目標軌道は、例えば、速度要素を含んでいる。例えば、目標軌道は、自車両Mの到達すべき地点(軌道点)を順に並べたものとして表現される。
第2制御部160は、例えば、取得部162と、速度制御部164と、操舵制御部166とを備える。取得部162は、行動計画生成部140により生成された目標軌道(軌道点)の情報を取得し、メモリ(不図示)に記憶させる。速度制御部164は、メモリに記憶された目標軌道に付随する速度要素に基づいて、走行駆動力出力装置200またはブレーキ装置210を制御する。操舵制御部166は、メモリに記憶された目標軌道の曲がり具合に応じて、ステアリング装置220を制御する。速度制御部164および操舵制御部166の処理は、例えば、フィードフォワード制御とフィードバック制御との組み合わせにより実現される。一例として、操舵制御部166は、自車両Mの前方の道路の曲率に応じたフィードフォワード制御と、目標軌道からの乖離に基づくフィードバック制御とを組み合わせて実行する。
なお、自動運転制御装置100において、行動計画生成部140、取得部162、速度制御部164、及び操舵制御部166を合わせたものが「運転制御部」の一例である。
走行駆動力出力装置200は、車両が走行するための走行駆動力(トルク)を駆動輪に出力する。走行駆動力出力装置200は、例えば、内燃機関、電動機、および変速機などの組み合わせと、これらを制御するECUとを備える。ECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って、上記の構成を制御する。
ブレーキ装置210は、例えば、ブレーキキャリパーと、ブレーキキャリパーに液圧を伝達するシリンダと、シリンダに液圧を発生させる電動モータと、ブレーキECUとを備える。ブレーキECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って電動モータを制御し、制動操作に応じたブレーキトルクが各車輪に出力されるようにする。ブレーキ装置210は、運転操作子80に含まれるブレーキペダルの操作によって発生させた液圧を、マスターシリンダを介してシリンダに伝達する機構をバックアップとして備えてよい。なお、ブレーキ装置210は、上記説明した構成に限らず、第2制御部160から入力される情報に従ってアクチュエータを制御して、マスターシリンダの液圧をシリンダに伝達する電子制御式液圧ブレーキ装置であってもよい。
ステアリング装置220は、例えば、ステアリングECUと、電動モータとを備える。電動モータは、例えば、ラックアンドピニオン機構に力を作用させて転舵輪の向きを変更する。ステアリングECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って、電動モータを駆動し、転舵輪の向きを変更させる。
[他車両の発進判定について]
次に、認識部130により認識される処理の内容について説明する。認識部130は、例えば、他車両認識部131と、発進判定部132とを備える。
他車両認識部131は、例えば、物体認識装置16により認識された認識結果に基づいて、自車両Mが走行する道路に面して存在する他車両mの存在の有無、およびその状態を認識する。発進判定部132は、他車両認識部131の認識結果に基づいて、他車両mが発進するか否かを判定する。
図3は、他車両認識部131が認識する他車両の一例を示す図である。他車両mは、自車両Mに対して直交する方向に停車している場合が図示されているが、他車両mは、自車両Mに対して縦列駐車されていてもよい。他車両認識部131は、例えば、道路に面して存在する車両を他車両mと認識する。
他車両認識部131は、道路でない駐車スペースに車体の大半を置いた状態で駐車している車両を他車両mとして認識してもよいし、路地などに停車している車両も含めて他車両mとして認識してもよい。
以下、より具体的な処理について説明する。他車両認識部131は、他車両mの車輪m4の回転角度、または自車両Mに対する車輪m4の相対角度、或いはそれらの変化量を認識する。他車両認識部131は、例えば、物体認識装置16が出力した他車両mの複数の画像を所定のサンプリング間隔で比較し、他車両mの車輪m4が回転しているか否かを認識する。
他車両認識部131は、ある時点において推定した回転角度と、所定時間後に推定した回転角度とを比較し、他車両mの車輪m4が回転しているか否かを認識する。各時点において推定される回転角度は、自車両Mの位置変化に伴う変化を打ち消すように補正がされている。
他車両認識部131は、例えば、ある時点の自車両Mの位置における認識された他車両mと自車両Mとの相対位置関係を示す三次元モデルを生成する。他車両認識部131は、例えば、ある程度進行した後に、自車両Mから見え方が変化した三次元空間上の他車両mのモデルにおける車輪m4と、カメラ10から取得された他車両mの車輪m4の画像とを比較し、画像における車両m4の見え方がモデルにおける車輪m4と異なる場合、車輪m4が回転したと認識する。
発進判定部132は、例えば、他車両認識部131により他車両mの車輪m4の回転または相対角度の変化が認識された場合に、他車両mが発進すると判定する。他車両mの車輪m4の回転角度、または自車両Mに対する車輪の相対角度が変化した場合、他車両mが発進し、車線Lに出てくる可能性が高いからである。
また、他車両認識部131は、他車両mのドアm2が開いていることを認識してもよい。他車両認識部131は、例えば、ディープラーニング等を利用した状態判定アルゴリズムを用いて、他車両mのドアm2が開いていることを認識する。他車両認識部131は、他車両mのフロントドア、リアドア等のいずれのドアm2が開いていることを認識してもよい。
発進判定部132は、例えば、他車両認識部131により他車両mのドアm2が開いていることが認識された場合、他車両mが発進しないと判定する。他車両mのドアm2が開いている状態では車両がまだ発進しない可能性が高いからである。
また、他車両認識部131は、他車両mのウィンカm1が点滅していることを認識してもよい。他車両認識部131は、例えば、物体認識装置16が出力した他車両mの複数の画像を所定のサンプリング間隔で比較し、他車両mのウィンカm1が点滅している状態と、消灯している状態とが繰り返されていることが認識された場合に、その点滅を認識する。ウィンカm1は、他車両mのフロントウィンカ、サイドウィンカ、テールウィンカ等のうちいずれかまたは全部である。
発進判定部132は、例えば、他車両認識部131により他車両mのウィンカm1が点灯していることが認識された場合に、他車両mが発進すると判定する。他車両mのウィンカm1が点滅していることは、他車両mが発進する可能性が高いからである。
また、他車両認識部131は、他車両mのブレーキランプm3の点灯を認識してもよい。しかし、他車両mのブレーキランプm3の位置関係により、ブレーキランプm3が直接認識できない場合、他車両認識部131は、他車両mのブレーキランプm3の周辺の構造物Hの色の変化を認識してもよい。
他車両認識部131は、他車両mの周辺の壁H1などの少なくとも一部の領域の色が、他車両mのブレーキランプm3の色に変化したことを認識することによってブレーキランプm3の点灯を認識してもよい。他車両認識部131は、例えば、物体認識装置16が出力した他車両mが撮像された画像を所定のサンプリング間隔で比較し、他車両mの周囲の構造物Hの壁H1の色がブレーキランプの色に変化し、且つ輝度が明るく変化したことに基づいてブレーキランプm3の点灯を認識してもよい。
発進判定部132は、例えば、他車両認識部131により構造物Hの少なくとも一部の色が、他車両mのブレーキランプm3の色が反射した色であることが認識された場合に、他車両mが発進すると判定する。他車両mのテールランプやハイマウントストップランプ等を含むブレーキランプm3が点灯することは、他車両mが発進前の状態である可能性が高いからである。
図4は、他車両mの車高の変化の一例を示す図である。他車両認識部131は、他車両mの車高を推定してもよい。他車両認識部131は、例えば、カメラ10により撮像された画像を解析し、他車両mの基準車高(h0)からの沈み込み量(h0−h1)を推定する。
他車両mの基準車高は、他車両mが住居敷地内に駐車されている場合、カメラ10により撮像された過去の画像に基づいて機械学習によって設定されてもよい。また、他車両mの基準車高は、通信装置20を介し、車両間通信により他車両mから取得してもよいし、認識された他車両mの車種の情報に基づいて、ネットワークから取得してもよい。そして、他車両認識部131は、取得した情報に基づいて他車両mの基準車高を設定してもよい。
発進判定部132は、例えば、他車両認識部131により推定された他車両mの基準車高からの沈み込み量が閾値以上である場合、他車両mが発進すると判定する。他車両mの基準車高からの沈み込み量が閾値以上である場合、車内に乗員が搭乗している状態であると推定され、他車両mが発進する確率が高くなるからである。
また、他車両認識部131は、他車両mに乗車している乗員の存在を認識してもよい。発進判定部132は、例えば、他車両認識部により他車両に乗車している乗員の存在を認識した場合に、他車両が発進すると判定する。他車両m中に乗員が乗車している場合、他車両mが発進する可能性が高いからである。
また、発進判定部132は、自車両Mに設けられたマイク15(図1参照)により集音された自車両Mの周辺の音の状態の変化に基づいて他車両mが発進すると判定してもよい。他車両認識部131は、例えば、マイク15により収集された自車両Mの周辺の音のデータから、他車両mにより発生させられたエンジン音を抽出する。
そして、他車両認識部131は、例えば、抽出されたエンジン音の音源の方向を認識する。他車両認識部131は、例えば、自車両Mの複数の位置に設けられたマイク15により収集されたエンジン音の受信時刻に基づいて、エンジン音の音源が存在する方向を推定する。発進判定部132は、例えば、マイク15により収集された音のうち、他車両mが存在する方向からエンジン音が抽出された場合、他車両mが発進すると判定する。他車両mからエンジン音が発せられた場合、他車両mが発進する確率が高くなるからである。
他車両認識部131は、他車両mのヘッドライトm5(図3参照)が点灯していることを認識してもよい。発進判定部132は、例えば、他車両認識部131により他車両mのヘッドライトが点灯していることが認識された場合に、他車両mが発進すると判定する。
他車両認識部131は、例えば、物体認識装置16が出力した他車両mが撮像された画像を所定のサンプリング間隔で比較し、他車両mのヘッドライトm5の画像の輝度が明るく変化したことに基づいて、ヘッドライトm5の点灯を認識してもよい。他車両mのヘッドライトm5が点灯した場合、他車両mが発進前の状態である可能性が高いからである。
また、発進判定部132は、例えば、他車両mと通信装置20を介して通信が行われた結果、他車両mから取得した情報に基づいて他車両mが発進すると判定する。自車両Mは、他車両mが通信可能な車両である場合、他車両mと通信し、他車両mの走行に関する情報を取得してもよい。他車両認識部131は、取得された情報に基づいて、他車両mの存在及び他車両mの状態を認識する。
他車両認識部131は、例えば、シートベルトの着用を促すためのシートベルトリマインダーを通知していることを示す情報や、他車両mが自動運転車両であることを示す情報を受信する。他車両認識部131は、取得された情報に基づいて、シートベルトリマインダーが通知されているか否かを認識する。
発進判定部132は、例えば、通信装置20により他車両mがシートベルトリマインダーを通知していることを示す情報が受信された場合に、他車両mが発進すると判定する。シートベルトリマインダーが通知された場合、他車両mが発進する確率が高くなるからである。
また、発進判定部132は、他車両mが駐車されている場所に基づいて判定基準を変更してもよい。例えば、他車両mが住居敷地内に駐車されている場合、いわゆるコインパーキングなどの駐車施設に駐車されている車両と比べて同一の車両が駐車している確率が高い。従って、他車両認識部131による他車両mの学習の精度が高くなることから、発進判定部132は、発進と判定する際の閾値や条件の数をより発進と判定され易いように調整してもよい。これにより、自動運転制御装置100は、住居敷地内に駐車されている他車両mの発進を早期に判定することができる。
行動計画生成部140は、発進判定部132により他車両mが発進すると判定された場合、以下に説明するように、他車両mを考慮した制御を行う。
(1)例えば、行動計画生成部140は、発進判定部132により他車両mが発進すると判定され、且つ、他車両mと自車両との距離が所定距離以上である場合、速度制御部164を制御して自車両Mを減速させ、徐行させる。所定距離は、例えば、他車両mが停車位置から車線Lに出た場合に、行動計画生成部140が他車両mの動作に応じた制御を実行可能な時間が十分に確保される距離である。所定距離は、例えば、カメラ10、レーダ装置12、ファインダ14の出力結果に基づいて、物体認識装置16により推定される。
(2)例えば、行動計画生成部140は、発進判定部132により他車両mが発進すると判定され、且つ、他車両mと自車両Mとの距離が所定距離未満である場合、速度制御部164及び操舵制御部166を制御して自車両Mに他車両mを迂回させる。行動計画生成部140は、例えば、自車両Mが走行する車線L内において自車両Mが他車両mから離間する軌道を生成し、自車両Mを走行させる。
(3)例えば、行動計画生成部140は、他車両認識部131により他車両の車輪の回転または前記相対角度の変化が認識された場合に、自車両を停止させる。
(4)例えば、行動計画生成部140は、通信装置20により他車両mが自動運転車両であることを示す情報が受信された場合に、通信装置20を介して他車両mと通信を行いながら互いの走行制御について調整を行ってもよい。自動運転車両である他車両mと自車両Mとは、互いの存在を認識した走行制御を行うからである。行動計画生成部140は、例えば、他車両mと通信を行い、他車両mから走行制御に関する通信結果が「譲る」旨の情報を受け取った場合、減速または迂回を行わずに自車両Mをそのまま走行させてもよい。「譲る」旨の情報とは、例えば、他車両mが自車両Mを認識し、自車両Mを優先して走行させると判断した結果、自車両Mに送信される情報である。
次に、自動運転制御装置100において実行される処理の流れについて説明する。図5は、自動運転制御装置100において実行される処理の流れの一例を示すフローチャートである。
他車両認識部131は、自車両Mが走行する道路に面して存在する他車両を認識する(ステップS100)。発進判定部132は、他車両認識部131により認識された他車両mの状態に基づいて他車両が発進するか否かを判定する(ステップS110)。発進判定部132が他車両mの状態に基づいて他車両が発進すると判定した場合、行動計画生成部140は、発進判定部132による判定結果に基づいて、速度制御部164及び操舵制御部166に自車両Mの操舵または加減速のうち一方または双方を制御させて自車両Mの走行について制御させる(ステップS130)。
次にステップS110において実行される他車両mが発進するか否か判定する処理について詳細に説明する。図6は、ステップS110において実行される処理の流れを示すフローチャートである。
他車両認識部131は、他車両mの車輪m4の回転または相対角度等の車輪の状態の変化を認識したか否かを判定する(ステップS111)。
発進判定部132は、他車両認識部131により他車両mの車輪m4の回転または相対角度の変化が認識された場合に、他車両mが発進すると判定する(ステップS128)。
他車両認識部131は、他車両mの車輪m4の回転または相対角度の変化が認識されない場合、他車両mのドアm2が開いているか否かを判定する(ステップS112)。
発進判定部132は、他車両認識部131が他車両mのドアm2が開いていると判定した場合、他車両mが発進しないと判定する(ステップS127)。
他車両認識部131により他車両mのドアm2が開いていないことが判定された場合、他車両mのウィンカm1が点灯しているか否かを判定する(ステップS113)。
発進判定部132は、他車両認識部131により他車両mのウィンカm1が点灯していることが認識された場合に、他車両mが発進すると判定する(ステップS128)。
他車両認識部131は、他車両mのウィンカm1が点灯していないことが判定されていない場合、ブレーキランプm3が点灯しているか否かを判定する(ステップS114)。発進判定部132は、他車両認識部131によりブレーキランプm3が点灯していると認識された場合に、他車両mが発進すると判定する(ステップS128)。
他車両認識部131は、ブレーキランプm3が点灯していないと判定した場合、他車両mの車高が低くなったか否かを判定する(ステップS115)。発進判定部132は、他車両認識部131により他車両mの車高が低くなったと判定された場合、他車両mが発進すると判定する(ステップS128)。
他車両認識部131は、他車両mの車高が低くなったと判定しない場合、他車両mに乗員が乗車しているか否かを判定する(ステップS116)。発進判定部132は、他車両認識部131により他車両mに乗員が乗車していると判定された場合に、他車両mが発進すると判定する(ステップS128)。
他車両認識部131は、他車両mに乗員が乗車していないと判定した場合、他車両mの方向からエンジン音が発生しているか否かを判定する(ステップS117)。
他車両認識部131は、他車両mの方向からエンジン音が発生していないと判定した場合、他車両mのヘッドライトm5が点灯しているか否かを判定する(ステップS118)。
他車両認識部131は、他車両mのヘッドライトm5が点灯していないと判定した場合、他車両mでシートベルトリマインダーが通知されているか否かを判定する(ステップS119)。発進判定部132は、他車両mでシートベルトリマインダーが通知されていないと判定した場合、他車両mが発進しないと判定する(ステップS127)。
以上説明したフローチャートにおいて、ステップS111からステップS119の各ステップの順序はこれに限らず、適宜入れ替えられてもよい。また、以上説明したフローチャートでは、条件が一つでも成立した場合に他車両mが発進すると判定するものとしたが、これに代えて複数条件が成立した場合に他車両mが発進すると判定するものとしても良い。
次にステップS130において実行される判定結果に応じて自車両Mを制御する処理について詳細に説明する。図7は、ステップS130において実行される処理の流れを示すフローチャートである。
発進判定部132は、他車両mが発進するか否かを判定する(ステップS131)。
発進判定部132は、他車両mが発進すると判定し場合、他車両認識部131は、他車両mが自動運転車両であるか否かを判定する(ステップS132)。
他車両認識部131により他車両mが自動運転車両であると判定された場合、他車両認識部131は、他車両mから走行制御に関する「譲る」旨の情報を受け取ったか否かを判定する(ステップS133)。
他車両認識部131が他車両mから走行制御に関する「譲る」旨の情報を受け取らなかったと判定された場合、または、ステップS132で否定的な判定となった場合、発進判定部132は、他車両mが車輪m4の状態に基づいて発進するか否かを判定する(ステップS134)。
発進判定部132により他車両mが車輪m4の状態に基づいて発進しないと判定された場合、行動計画生成部140は、物体認識装置16の推定結果に基づいて、自車両Mと他車両mとの距離が所定値以上であるか否かを判定する(ステップS135)。
行動計画生成部140は、自車両Mと他車両mとの距離が所定値以上であると判定された場合、速度制御部164を制御して自車両Mを徐行させる(ステップS137)。
行動計画生成部140は、発進判定部132により他車両mが発進すると判定され、且つ、他車両mと自車両Mとの距離が所定距離未満であると判定された場合、速度制御部164及び操舵制御部166を制御して自車両Mに他車両mを迂回させる(ステップS138)。
行動計画生成部140は、ステップS134で発進判定部132により他車両mが車輪m4の状態に基づいて発進すると判定された場合、速度制御部164及び操舵制御部166を制御して自車両Mを停止させる(ステップS136)。
行動計画生成部140は、ステップS131で発進判定部132により、他車両mが発進すると判定されない場合、速度制御部164及び操舵制御部166を制御して自車両Mをそのまま走行させる(ステップS139)。
以上説明したフローチャートにおいて、ステップS131からステップS135の各ステップの順序はこれに限らず、適宜入れ替えられてもよい。また、以上説明したフローチャートでは、ステップS134及びステップS136を省略してもよい。
以上説明した実施形態によれば、車両システム1は、停車中の他車両の状態に基づいて他車両が発進するか否かを判定し、自車両の走行を制御することができる。
以上説明した実施形態は、下記のように表現することができる。図8は、自動運転制御装置100において使用され得る複数の構成を示す図である。自動運転制御装置100は、通信コントローラ100−1、CPU100−2、ワーキングメモリとして使用されるRAM100−3、ブートプログラムなどを格納するROM100−4、フラッシュメモリやHDDなどの記憶装置100−5、ドライブ装置100−6などが、内部バスあるいは専用通信線によって相互に接続された構成となっている。
通信コントローラ100−1は、図1に示す自動運転制御装置100以外の構成要素との通信を行う。記憶装置100−5には、CPU100−2が実行するプログラム100−5aが格納されている。このプログラムは、DMA(Direct Memory Access)コントローラ(不図示)などによってRAM100−3に展開されて、CPU100−2によって実行される。これによって、認識部130、行動計画生成部140、取得部162、速度制御部164、操舵制御部166のうち一部または全部が実現される。
上記説明した実施形態は、以下のように表現することができる。
ハードウェアプロセッサと、
記憶装置と、
前記記憶装置に格納されたプログラムを実行するハードウェアプロセッサと、を備え、
前記ハードウェアプロセッサは、前記プログラムを実行することにより、
自車両が走行する道路に面して存在する他車両を認識し、
認識された他車両の状態に基づいて前記他車両が発進するか否かを判定し、
判定結果に基づいて、前記自車両の操舵または加減速のうち一方または双方を制御して前記自車両を走行させる、
ように構成されている、車両制御装置。
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。