JP7259032B2 - 車両制御装置 - Google Patents

Description

本発明は、車両制御装置に関する。

従来、車両の自動運転システムや駐車支援システムを実現するために、自車両が走行した経路と自車両周辺の立体物や白線等といった周辺環境情報を記憶し、以降、自車両が記憶した経路を目標経路として追従して走行するように車両を制御する車両制御装置が知られている（例えば、特許文献１を参照）。

自車両の周辺環境情報として、自車両周辺の静止物や移動物等の立体物に関する位置情報や道路上の白線、停止線などの路面標示（路面ペイント）や道路周辺に存在する信号機、速度標識などの外界周辺状況が挙げられる。

特開２０１８－８６９２８号公報

自車両が記憶した経路を目標経路として追従走行するよう制御するためには、自車位置を高精度で推定する必要がある。自車位置を推定する方法は車輪センサや舵角センサ、加速度センサ、ジャイロセンサ等の自車センサ情報を用いて自車位置を推定するデッドレコニングという方法や、ＧＰＳ（Ｇｌｏｂａｌ Ｐｏｓｉｔｉｏｎｉｎｇ Ｓｙｓｔｅｍ）を利用する方法や、予め経路周辺の環境を記憶しておき目標経路追従走行時にカメラやライダー等の外界認識センサによって取得した情報と予め記憶した情報を照合して自車位置を推定する方法などが知られている。

しかし、デッドレコニングによる自車位置推定では走行距離が長くなるほど誤差が積み上がっていくために精度が悪化し、ＧＰＳを利用した方法も自車両の周辺に建物などがある場合では建物が衛星からの電波を反射することが原因で精度が悪化する。

一方、予め経路周辺の環境を記憶しておき経路追従走行時にカメラやライダー等の外界認識センサによって取得した静止物情報と、予め記憶した経路周辺の静止物情報を照合して自車位置を推定する方法では、自車位置推定の精度は外界認識センサの精度に依存し、高性能なセンサを使用すれば自車位置を高精度で推定できる。なお、ここでの静止物とは外界認識センサで認識した時点で移動していない物体を指す。

しかし、記憶した経路の周辺環境が変化して記憶した静止物が目標経路追従走行時になくなってしまった場合には、自車位置が推定できなくなるという課題がある。また、検知した静止物が１個の場合は、検知した静止物を中心として自車両と検知した静止物との距離を半径とする円周上のどこに自車両が位置するか決定できないため、最低限２個の静止物を検知しないと検知した静止物と自車両の相対位置関係に基づいて自車位置を推定できないという課題がある。

本発明は、プロセッサとメモリを有し、車両の走行を制御する車両制御装置であって、前記車両の周辺環境情報を取得するセンサと、前記センサが取得した周辺環境情報から静止物を取得し、前記静止物の位置を算出し、走行経路上の前記車両の位置と、前記静止物の位置を対応付けて記憶する周辺環境記憶部と、前記記憶された走行経路上の位置に追従する指令を受け付けた場合には、前記センサが取得した周辺環境情報から静止物を検知し、２以上の前記静止物を検知した場合には、当該静止物に一致する前記自車位置推定用静止物を特定する記憶情報照合部と、前記特定された自車位置推定用静止物の位置から前記車両の位置を推定する自車位置推定部と、前記推定された車両の位置と、前記記憶された走行経路に基づいて自動運転を行う車両制御部と、を有し、前記周辺環境記憶部は、前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた場合には、前記走行経路上の各位置において３以上の前記静止物を自車位置推定用静止物として記憶し、前記記憶情報照合部は、前記記憶された前記自車位置推定用静止物のうち、前記検知された静止物に含まれない前記自車位置推定用静止物が存在する場合には、当該自車位置推定用静止物が存在する可能性を有する範囲で再度静止物の検知を実施して、検知の結果前記自車位置推定用静止物が検知されなかった場合には、当該自車位置推定用静止物を削除する。

したがって、本発明は、同時に３個以上の静止物を自車位置推定用静止物として記憶することで、走行経路に追従する走行時に、走行経路の周辺の環境が変化して、静止物が１個なくなってしまった場合でも、２個以上の静止物から自車位置を推定することができる。これにより、車両制御部は目標経路に追従して車両の走行を継続させることが可能となる。

本明細書において開示される主題の、少なくとも一つの実施の詳細は、添付されている図面と以下の記述の中で述べられる。開示される主題のその他の特徴、態様、効果は、以下の開示、図面、請求項により明らかにされる。

本発明の実施例１を示し、車両の構成の一例を示す図である。 本発明の実施例１を示し、運転支援システムの機能の一例を示すブロック図である。 本発明の実施例１を示し、運転支援システムを利用する走行環境の一例を示す平面図である。 本発明の実施例１を示し、車両制御装置が走行経路及び経路周辺環境を記憶する処理の一例を示すフローチャートである。 本発明の実施例１を示し、車両制御装置が記憶部に記憶した走行経路を目標経路として追従走行する処理の一例を示すフローチャートである。 本発明の実施例２を示し、車両制御装置が記憶部に記憶した走行経路を目標経路として追従走行する処理の一例を示すフローチャートである。 本発明の実施例３を示し、車両制御装置が記憶部に記憶した走行経路を目標経路として追従走行する処理の一例を示すフローチャートである。 本発明の実施例４を示し、車両制御装置が記憶部に記憶した走行経路を目標経路として追従走行する処理の一例を示すフローチャートである。 本発明の実施例５を示し、車両制御装置が記憶部に記憶した走行経路を目標経路として追従走行する処理の一例を示すフローチャートである。 本発明の実施例６を示し、車両制御装置が記憶部に記憶した走行経路を目標経路として追従走行する処理の一例を示すフローチャートである。 本発明の実施例７を示し、車両制御装置が走行経路及び経路周辺環境を記憶する処理の一例を示すフローチャートである。 本発明の実施例７を示し、車両制御装置が記憶部に記憶した走行経路を目標経路として追従走行する処理の一例を示すフローチャートである。 本発明の実施例８を示し、車両制御装置が記憶部に記憶した走行経路を目標経路として追従走行する処理の一例を示すフローチャートである。

以下、本発明の実施形態を添付図面に基づいて説明する。

図１は、本発明に係る車両の構成の一例を示す図である。図示の車両１は、走行用動力源としての、例えば筒内噴射式ガソリンエンジン１１と、該エンジン１１の駆動力を伝達可能な自動変速機１２と、プロペラシャフト１３と、ディファレンシャルギア１４と、ドライブシャフト１５と、４つの車輪１６及び車輪センサを含むブレーキ装置２０と、電動パワーステアリング２１を有する後輪駆動車である。

車両１には、後述する車両制御装置１８及び各種センサ１９類を含む装置と、アクチュエータと、機器類は、車内ＬＡＮやＣＡＮ通信を通じて信号やデータの授受を行えるようになっている。車両制御装置１８は後述するセンサ類から自車両の外部の情報を得て、自動駐車や、自動運転等の制御を実現するための指令値を、エンジン１１と、車輪センサを含むブレーキ装置２０と、電動パワーステアリング２１と、自動変速機１２へ送信する。車輪センサ５０は車輪の回転に応じてパルス波形を生成し、車両制御装置１８へ送信する。

車両１の前方、後方、側方には撮像センサ１７と、近距離測距センサ２４が配備されている。また、車両１の前方、後方に中距離測距センサ２２を配置する。また、車両１の前方に遠距離測距センサ２５を配置する。これらのセンサは自車両周囲の立体物や白線等の道路環境について検知し、車両制御装置１８へ供給する外界認識センサ３１（図２）として機能する。これらの取り付け位置、各種センサの数は図１に示す位置に限定されない。

なお、図示の車両１は、本発明を適用可能な車両の一例であり、本発明は適用可能な車両の構成を限定するものではない。例えば、前記自動変速機１２に代えて無段変速機（ＣＶＴ）を採用した車両でもよい。また、走行動力源であるエンジン１１に代えてモーターあるいは、エンジンとモーターを走行動力源とした車両でもよい。

図２は、本発明が適用された運転支援システムの機能の一例を示すブロック図である。図２に示す運転支援システムは、車両１に搭載されるものであり、外界認識センサ３１と、入力スイッチ部２７と、車輪センサ５０と、舵角センサ２８と、位置検出器２９と、表示器３７と、音声出力器３８と、通信装置３０と、車両の各種センサ／アクチュエータＥＣＵ３６、及びこれらを接続した車両制御装置１８、によって構成される。また、外界認識センサ３１は、撮像センサ１７と、近距離測距センサ２４と、中距離測距センサ２２、遠距離測距センサ２５によって構成される。

車両制御装置１８は、プロセッサ２と、メモリ３を含む。車両制御装置１８は、自車位置推定部３２と、周辺環境記憶部３３と、記憶情報照合部３４と、車両制御部３５の各プログラムをメモリ３へそれぞれロードしてプロセッサ２で実行する。車両制御部３５は、操舵制御部３９と加減速制御部４０とシフト制御部４１によって構成される。

プロセッサ２は、各機能部のプログラムに従って処理を実行することによって、所定の機能を提供する機能部として稼働する。例えば、プロセッサ２は、自車位置推定プログラムに従って処理を実行することで自車位置推定部３２として機能する。他のプログラムについても同様である。さらに、プロセッサ２は、各プログラムが実行する複数の処理のそれぞれの機能を提供する機能部としても稼働する。計算機及び計算機システムは、これらの機能部を含む装置及びシステムである。

撮像センサ１７は、例えば、カメラで構成することができる。撮像センサ１７は、自車両の周囲に取り付けられた撮像素子により、立体物や白線や標識の情報を撮像するために用いられる。また、図２に示す例では、カメラを１つとしているが、カメラが２つあるステレオカメラとしてもよい。撮像センサ１７による撮像データは、例えば、車両周辺を表示できる車両上方の仮想視点から見下ろした様子を表す俯瞰画像のように合成して処理することができる。撮像センサ１７による撮像データは、車両制御装置１８に入力される。

近距離測距センサ２４は、例えば、ソナーで構成することができる。近距離測距センサ２４は、車両1の周囲に向かって超音波を送波し、その反射波を受信することで自車両近傍の立体物との距離を検知するために用いられる。近距離測距センサ２４による測距データは車両制御装置１８に入力される。

中距離測距センサ２２は、例えば、ミリ波レーダーで構成することができる。中距離測距センサは、車両１の周囲に向かってミリ波と呼ばれる高周波を送波し、その反射波を受信することで立体物との距離を探知するために用いられる。中距離測距センサ２２による測距データは車両制御装置１８に入力される。

遠距離測距センサ２５は、例えば、ミリ波レーダーで構成することができる。遠距離測距センサ２５は、車両１の前方に向かってミリ波と呼ばれる高周波を送波し、その反射波を受信することで遠方の立体物との距離を検知するために用いられる。また、遠距離測距センサ２５は、ミリ波レーダーに限定せず、ステレオカメラなどで構成することもできる。遠距離測距センサ２５による測距データは車両制御装置１８に入力される。

入力スイッチ部２７は、例えば、運転席の周辺に設けられた専用の機械式スイッチである。また、表示器３７をタッチパネルで構成した場合、入力スイッチ部２７は、ＧＵＩ（Graphical User Interface）スイッチなどであってもよい。入力スイッチ部２７は、車両１の周辺環境を記憶させる指示や、車両を自動制御させる指示をユーザー操作によって受け付ける。

車輪センサ５０は、車両１の各車輪１６に取り付けられて車輪１６の回転速度を検出する車輪速センサと、車輪速センサにより検出された検出値を統合して車速信号を生成するコントローラとを含む。車輪センサ５０による車速信号データは車両制御装置１８に入力される。なお、後述する実施例１から実施例６及び実施例８においては、車輪センサ５０を省略することが可能である。

舵角センサ２８は、車両１のステアリングシャフト（図示省略）に取り付けられ、操舵の向き、操舵角を検出するセンサと、センサにより検出された値から舵角信号を生成するコントローラとを含む。舵角センサ２８による舵角信号データは車両制御装置１８に入力される。なお、舵角センサ２８は省略することが可能である。

位置検出器２９は、車両１の前方の方位を測定する方位センサや、衛星からの電波に基づいて車両の位置を測定するＧＰＳ（Ｇｌｏｂａｌ Ｐｏｓｉｔｉｏｎｉｎｇ Ｓｙｓｔｅｍ）のためのＧＰＳ受信機で構成される。なお、後述する本発明の実施例１から実施例７においては、位置検出器２９を省略することが可能である。

表示器３７は、例えば、液晶ディスプレイによって構成され、表示器３７の表示画面には、後述する撮像センサ１７が撮像した画像から生成された俯瞰画像を表示したり、車両制御装置１８からの画像信号の画像を表示する。なお、表示器３７は、入力装置として機能するタッチパネルを含んでいてもよい。

音声出力器３８は、例えば、スピーカーによって構成され、車両１の車室内の適切な場所に配置され、ユーザーへの音声案内や警告音の出力に利用される。

通信装置３０は、外部からの通信を授受する装置であり、例えば、車両１の周辺の道路情報として路面情報（レーンマーカー位置、停止線位置、横断歩道、などの路面ペイント種別と位置など）と、立体物情報（標識、信号機、地物、など道路の周辺に存在する立体物）を取得する。

後述するように、これらの情報は、道路インフラに設置されたセンサによって検知した情報や、外部のデータセンタに記憶された道路周辺情報（路面情報や立体物情報など）や、他車両が検知した道路周辺情報（路面情報や立体物情報など）を通信装置３０を用いて取得することも可能である。さらに、事前に記憶している走行位置周辺の道路情報を通信装置３０を用いて最新の情報に変更することも可能である。

各種センサ／アクチュエータＥＣＵ３６は、周知又は公知のものでよく、例えば、駆動力を操作するアクセルペダルや制動力を操作するブレーキペダル、パーキングブレーキ、車両の進路方向を操作するステアリング、車両の進行方向を操作するシフトレバー等の機械要素や信号変換装置を示す。

車両制御部３５は、低速自動運転を実施する際に各種センサ／アクチュエータＥＣＵ３６を制御する目標値を演算し、制御指示を出力する。

本発明の実施例１を図３、図４、図５を用いて説明する。

図３は、運転支援システムを有する車両１の走行環境の一例を示す平面図である。図３では、車両１が、日常的に利用する経路を通って保管場所まで走行し、駐車位置１０１で停止するシーンを示している。

ユーザー（運転者）が自身で車両１を運転している場合、記憶開始位置１０２にて、周辺環境情報の記憶開始を指示すると、車両制御装置１８は、以降の車両１の走行経路１０９、及び前記走行経路周辺の環境情報を周辺環境記憶部３３に記憶する。記憶の対象は、具体的には、図３において、道路脇に存在する電柱１０３や、信号機１０４、横断歩道１０５、標識１０７、路面標示１０６、白線１０８など、外界認識センサ３１により認識された時点で運動していない静止物（立体物情報や路面情報）とする。また、ユーザーが、自身の運転操作により駐車を開始する場合に、駐車開始位置の記憶を指示すると、車両制御装置１８は、記憶開始位置１０２の位置を記憶する。

上記周辺環境情報の記憶が完了した状態で、次に車両１が同じ走行経路１０９を通って駐車位置１０１まで走行する場合、記憶開始位置１０２に到達すると、車両制御装置１８は、ユーザーに対し、自動走行が可能である旨を通知する。ここでユーザーが自動走行開始を指示すると、車両制御装置１８が操舵及び車速を制御することにより、車両１は、記憶された走行経路１０９を追従しながら自動走行を行う。

ここで、走行経路及び経路周辺環境を記憶する処理について図４で説明する。

車両１がユーザーの運転操作により走行している場合、ユーザーが入力スイッチ部２７にて所定の操作を行うと、車両制御装置１８は、走行経路及び経路周辺環境の記憶を開始する。

図４は、車両１がユーザーの運転により走行しながら周辺環境情報を記憶する際、車両制御装置１８により実行される処理の一例を示すフローチャートである。この処理は入力スイッチ部２７から周辺環境情報の記憶を開始する所定の指令を受け付けた場合に実行される。

走行経路及び経路周辺環境の記憶を開始すると、車両制御装置１８の周辺環境記憶部３３は、ユーザーが入力スイッチ部２７にて所定の操作を行い記憶完了操作が実施されたか否かを判定する（ステップＳ２０１）。ユーザーが記憶完了操作を実施したか否かの判定処理は、時間的に連続で行ってもよいし、一定の周期で離散的に行ってもよい。

ユーザーが記憶完了操作を実施したと判定した場合は、記憶処理を終了する。その際、周辺環境記憶部３３は、表示器３７上に記憶に成功したことをユーザーに伝えるために所定のメッセージを表示してもよい。

ユーザーが記憶完了処理を実施していないと判定した場合、周辺環境記憶部３３は、外界認識センサ３１から車両１の周囲の周辺環境情報を取得し、周辺環境情報の中から静止物を検知する。そして、周辺環境記憶部３３は、外界認識センサ３１が静止物を３個以上検知しているか否かを判定する（ステップＳ２０２）。

周辺環境記憶部３３は、静止物を３個以上検知していない場合は、記憶処理を終了する。その際、周辺環境記憶部３３は、表示器３７上に記憶が失敗したことをユーザーに伝えるために所定のメッセージを表示してもよい。

静止物を３個以上検知した場合、周辺環境記憶部３３は、静止物の位置と特徴を周辺環境記憶部３３に記憶する（ステップＳ２０３）。以下、記憶した静止物を自車位置推定用静止物と呼ぶこととする。

位置の具体例として、記憶開始位置１０２を原点とした場合の静止物の座標値を位置として記憶する方法や、駐車位置１０１を原点とした場合の静止物の座標値を位置として記憶するなどの方法がある。なお、静止物の座標値は、自車位置推定部３２が車両の位置を推定している場合は、自車位置の推定値を原点とする静止物までの距離及び角度で静止物の位置を算出してもよい。

また、静止物の特徴の具体例としては、静止物の色、大きさ、外形、センサ値を用いて所定の計算式に代入して計算した値（例えば、特徴量）などが挙げられる。周辺環境記憶部３３は、外界認識センサ３１で検知した静止物の位置と特徴を記憶したら、現在までに走行した経路（走行経路１０９）を周辺環境記憶部３３に記憶する。車両制御装置１８は、上記ステップＳ２０１からステップＳ２０４までの処理を、記憶処理が終了するまで、一定の周期で実行する。

なお、走行経路１０９は、記憶開始位置１０２からの走行距離と、車両１の位置から自車位置推定用静止物までの距離又は方位から、記憶開始位置１０２を原点とする座標系で記憶する。なお、走行経路１０９は、上記に限定されるものではなく、走行経路１０９上の各位置における記憶開始位置１０２からの走行距離と、自車位置推定用静止物の位置情報の関係に基づく情報であればよい。

上記処理によって、車両制御装置１８は、入力スイッチ部２７（入力部）から周辺環境情報の記憶を開始する所定の指令を受け付けると、周辺環境記憶部３３が周期的に走行経路１０９上の位置と自車位置推定用静止物を記憶する。

周辺環境記憶部３３は、周期的に記憶した走行経路１０９上の各位置では、３個以上の静止物を検知して、静止物の位置と特徴を演算して自車位置推定用静止物として記憶する。

図４では、周辺環境記憶部３３が、ループ処理によって走行経路１０９上の位置と自車位置推定用静止物を記憶する例を示したが、これに限定されるものではなく、所定の間隔で走行経路１０９上の位置と自車位置推定用静止物を記憶してもよい。例えば、周辺環境記憶部３３が、所定の時間間隔や、所定の距離毎に走行経路１０９上の位置と自車位置推定用静止物を記憶するようにしてもよい。

また、上記では、ユーザーが入力スイッチ部２７で記憶完了操作を行った位置で、周辺環境記憶部３３が記憶処理を終了する例を示したが、ユーザー（運転者）が、パーキングブレーキ（又はパーキングレンジ）を操作した位置で周辺環境記憶部３３の記憶を終了させて駐車位置１０１としてもよい。

次に、車両制御装置１８の周辺環境記憶部３３が記憶した走行経路１０９を、目標経路として追従走行する処理について説明する。

周辺環境記憶部３３に、走行経路１０９と経路周辺の自車位置推定用静止物の情報が記憶されている場合、ユーザーが入力スイッチ部２７にて所定の操作を行うと、車両１は、記憶した走行経路１０９を目標経路として追従走行（自動運転）を開始する。

図５は、車両１が周辺環境記憶部３３に記憶された走行経路１０９を目標経路として追従走行する際に、車両制御装置１８の記憶情報照合部３４と車両制御部３５により実行される処理の一例を示すフローチャートである。

車両制御装置１８の記憶情報照合部３４は、目標経路追従走行を開始すると、外界認識センサ３１が静止物を２個以上検知しているか否かを判定する（ステップＳ２０５）。記憶情報照合部３４は、外界認識センサ３１が静止物を２個以上検知していない場合は、目標経路追従走行を終了する。目標経路追従走行を中止する際、記憶情報照合部３４は、表示器３７上に目標経路追従走行に失敗したことをユーザーに伝えるために所定のメッセージを表示してもよい。

記憶情報照合部３４は、外界認識センサ３１が静止物を２個以上検知した場合は、記憶情報照合部３４にて、検知した静止物の特徴に基づいて、検知した静止物が周辺環境記憶部３３に記憶された自車位置推定用静止物のうちのどの自車位置推定用静止物に該当するかを照合する（ステップＳ２０６）。

記憶情報照合部３４は、照合が完了したら、自車位置推定部３２にて検知した自車位置推定用静止物との相対位置関係を用いて自車両の位置（自車位置）を推定する（ステップＳ２０７）。

自車位置推定部３２が行う自車位置推定の具体的な方法としては、検知した静止物のそれぞれに対して検知した静止物を中心として、半径が検知された静止物と車両１との距離の円を描いて、各円の交点を算出し、得られた複数の交点の中から車両ヨー角が一致する点を自車位置として推定する手法を用いることができる。

あるいは、自車位置推定部３２が車両１から観測した静止物の方位と、各交点から観測した静止物の方位を比較し、車両１から観測した方位が近似又は一致する交点を自車位置として推定することができる。

なお、自車位置推定部３２が自車位置を推定する手法は、上記に限定されるものではなく、複数の自車位置推定用静止物の位置と、車両１から自車位置推定用静止物までの距離や角度から周知又は公知の手法で算出することができる。

車両制御装置１８の車両制御部３５は、自車位置推定部３２で自車位置を推定したら、車両１が駐車位置１０１に到達したか否かを判定する（ステップＳ２０８）。車両制御部３５は、車両１が駐車位置１０１に到達したと判定したら、目標経路追従走行を終了する。車両制御部３５は、目標経路追従走行を終了する際、表示器３７上に目標経路追従走行が成功したことをユーザーに伝えるために所定のメッセージを表示してもよい。

車両１が駐車位置１０１に到達していないと判定した場合、目標経路（走行経路１０９）と自車位置の関係に基づいて、車両制御部３５にて操舵制御及び加減速制御する（ステップＳ２０９）。

具体的には、車両制御部３５が、目標経路（走行経路１０９）と自車位置の車幅方向の誤差を小さくするように操舵制御し、自車位置と目標経路の終点との距離が長い場合には車速を増大し、自車位置と駐車位置１０１との距離が短い場合には車速を低下させるように加減速制御する。

なお、車両制御部３５による自動運転は、上記に限定されるものではなく、公知又は周知の手法を採用することができる。

車両制御部３５は、上記ステップＳ２０５からステップＳ２０９までの処理を、目標経路追従走行が終了するまで、一定の周期で実行する。

上記処理によって、車両制御装置１８は、入力スイッチ部２７（入力部）から走行経路１０９を目標経路として追従走行を行う指令を受け付けると、記憶情報照合部３４が、外界認識センサ３１から取得した周辺環境情報から２以上の静止物を検知し、周辺環境記憶部３３で記憶された自車位置推定用静止物と一致する静止物を特定する。そして、自車位置推定部３２が、特定された２以上の自車位置推定用静止物の位置から自車位置を推定し、車両制御部３５は、自車位置の推定値が目標経路に沿うように制御を実施する。

上記のように、実施例１の車両制御装置１８は、走行経路１０９と経路周辺の周辺環境情報を記憶する場合に、車両制御装置１８は、同時に３個以上の静止物を自車位置推定用静止物として記憶することで、目標経路追従走行時に走行経路１０９の周辺の環境が変化して、静止物が１個なくなってしまった場合でも、２個以上の静止物から自車位置を推定することができ、車両制御部３５は目標経路に追従して車両１を走行させることが可能となる。

次に、本発明の実施例２を、図６を用いて説明する。

図６は、第２の実施例において車両１が周辺環境記憶部３３に記憶した走行経路１０９を目標経路として追従走行する際、車両制御装置１８により実行される処理の一例を示すフローチャートである。

前記実施例１と実施例２の差異は、図６のステップ２１０以降の処理であり、実施例２の車両１の構成と、運転支援システムの構成と、走行経路１０９と経路周辺環境の記憶処理は前記実施例と同様である。

前記実施例１の図５のステップＳ２０６とＳ２０７の間に、ステップＳ２１０～Ｓ２１３の処理を加えたものが実施例２の図６である。以下では、前記実施例１と同一のステップについては重複する説明を省略する。

実施例２では、外界認識センサ３１で検知した静止物と、周辺環境記憶部３３に記憶した自車位置推定用静止物を記憶情報照合部３４が照合した後に、自車位置推定用静止物として記憶した静止物で、検知していない静止物が存在するか判定する（ステップＳ２１０）。具体的には、現時点で検知している静止物と記憶時に同時に記憶した自車位置推定用静止物で、現時点で検知していない静止物があるか判定する。

例えば、周辺環境情報の記憶時に停車していた他の車両は、追従走行時には移動してしまって検知できない等、周辺環境記憶部３３に保持されていた自車位置推定用静止物が消失する場合がある。

記憶情報照合部３４は、自車位置推定用静止物のうち検知されなかった静止物がある場合は、検知された静止物の位置に基づいて検知されなかった静止物が存在する可能性のある範囲で静止物を再度検知する（ステップＳ２１１）。検知されなかった静止物が存在する可能性のある範囲は、外界認識センサ３１の性能などに基づいて算出される。

具体的には、記憶情報照合部３４は、検知されなかった静止物が存在するはずの位置を中心として、所定の大きさ（又は半径）を有する領域を、検知されなかった静止物が存在する可能性のある範囲とするなどの方法が挙げられる。前記所定の大きさは、外界認識センサ３１の性能に基づいて設定される。

目標経路追従走行中に、ステップＳ２１１で算出した範囲内に静止物を検知しなかった場合、記憶情報照合部３４は、自車位置推定用静止物が存在しなくなったと判定し（Ｓ２１２）、検知できなかった自車位置推定用静止物の情報を周辺環境記憶部３３から削除する（ステップＳ２１３）。

実施例２では、不要となった情報を周辺環境記憶部３３から削除することで周辺環境記憶部３３の空き容量を拡大することができ、新たな情報を記憶することが可能となる。具体的には、新たに検知した自車位置推定用静止物の情報を記憶したり、既に記憶している自車位置推定用静止物について新たに特徴を追加して記憶するなどが挙げられる。不要となった情報を周辺環境記憶部３３から削除した後の処理は、前記実施例１と同様である。

次に、本発明の実施例３を図７を用いて説明する。

図７は実施例３において、車両１が周辺環境記憶部３３に記憶した走行経路１０９を目標経路として追従走行する際、車両制御装置１８により実行される処理の一例を示すフローチャートである。

前記実施例２との差異は、ステップＳ２１４からステップＳ２１５の処理を追加した点であり、実施例３の車両１の構成と、運転支援システムの構成、走行経路１０９と経路周辺環境の記憶処理は前記実施例２と同様である。

実施例２の図６のステップＳ２１３とＳ２０７の間に、ステップＳ２１４とＳ２１５を加えたものが実施例３である。以下の説明では、前記実施例２と同一のステップについては重複する説明を省略する。

実施例３では、検知されなかった自車位置推定用静止物の情報を周辺環境記憶部３３から削除した後に、記憶情報照合部３４は、周辺環境記憶部３３に記憶されていない静止物を検知したか否かを判定する（ステップＳ２１４）。

記憶情報照合部３４は、周辺環境記憶部３３に記憶されていない静止物を検知した場合は、新たな自車位置推定用静止物として周辺環境記憶部３３に位置と特徴を記憶する（ステップＳ２１５）。

上記のように周辺環境記憶部３３で検出できなかった自車位置推定用の静止物情報を削除した場合に、新たに検知した静止物を自車位置推定用静止物として記憶することで記憶した走行経路１０９の周辺環境の変化に対する運転支援システムのロバスト性を維持することができる。

次に、本発明の実施例４を図８を用いて説明する。

図８は、実施例４において車両１が周辺環境記憶部３３に記憶した走行経路１０９を目標経路として追従走行する際、車両制御装置１８により実行される処理の一例を示すフローチャートである。

実施例１と実施例４の差異は、図８のステップＳ２１４以降の処理であり、実施例４の車両１の構成と、運転支援システムの構成、走行経路１０９と経路周辺環境の記憶処理は前記実施例１と同様である。

図８は、前記実施例１の図５のステップＳ２０８以降に、ステップＳ２１４～Ｓ２１８の処理を追加したものである。以下の説明では、前記実施例１と同一のステップについては、重複する説明を省略する。

実施例４では、ステップＳ２０８で車両制御部３５は車両１が駐車位置１０１に到達していないと判定した場合、ステップＳ２１４へ進んで記憶情報照合部３４が外界認識センサ３１で周辺環境記憶部３３に記憶されていない新たな静止物を検知したか否かを判定する。

外界認識センサ３１が周辺環境記憶部３３に記憶していない静止物を検知していた場合は、記憶情報照合部３４が新たに検知した静止物を暫定的に周辺環境記憶部３３に記憶させる（ステップＳ２１６）。ここで、暫定的に記憶させた静止物を暫定記憶静止物と呼ぶこととする。なお、車両制御部３５は、暫定記憶静止物は自車位置推定の際には使用しない。また、記憶情報照合部３４は、暫定記憶静止物を記憶する領域を、周辺環境記憶部３３とは別に新たに暫定静止物記憶用の領域をメモリ３に確保して、当該領域に記憶してもよい。

記憶情報照合部３４は、新たに検知した静止物を暫定的に記憶した後、ステップＳ２０５で検知した静止物の中で、暫定記憶静止物として記憶された静止物を検知したか否かを判定する（ステップＳ２１７）。

記憶情報照合部３４は、暫定的に記憶している静止物を検知した場合は、当該暫定記憶静止物の検知回数を更新する（ステップＳ２１８）。

検知回数を更新した後のステップＳ２０９の処理は、実施例１と同様である。また、車両１が駐車位置１０１に到達したと車両制御部３５が判定した場合、記憶情報照合部３４は暫定記憶静止物で検知回数が所定回数に達した静止物があるか否かを判定する（ステップＳ２１９）。

記憶情報照合部３４は、暫定記憶静止物で検知回数が所定回数に達した静止物があった場合、該当する暫定記憶静止物を自車位置推定用静止物として周辺環境記憶部３３に記憶させ（ステップＳ２２０）、次回の目標経路追従走行時から自車位置推定に使用する。

また、記憶情報照合部３４は、暫定記憶静止物の特徴から、暫定記憶静止物が信号や電柱など、常時同じ場所に存在する物体である可能性が高いと判断できる場合は、前記所定回数を小さく設定してもよい。

具体的には、外界認識センサ３１で検知した静止物の外形から車輪を有している可能性が低いと判断できる場合などである。また、道路標識などのように規格化されており、パターンマッチングなどで高精度に識別可能な静止物を暫定的に記憶した場合は、所定回数を小さく設定してもよい。なお、外界認識センサ３１で検知した静止物の形状が所定の特徴（電柱、標識）を有する場合に、所定回数を小さく設定してもよい。

上記のように実施例４の車両制御装置１８は、目標経路追従走行時に新たに検知した静止物を周辺環境記憶部３３に自車位置推定用静止物として記憶することで、既に記憶した走行経路１０９の周辺環境の変化に対するシステムのロバスト性を向上させることができる。

また、車両制御装置１８は、新たに検知した静止物を記憶する際に、検知回数が所定回数以上という制限を設けることで、駐車車両などの移動可能な物体だった場合に自車位置推定用静止物として記憶してしまうことを防止できる。

次に、本発明の実施例５を図９を用いて説明する。

図９は実施例５において車両１が周辺環境記憶部３３に記憶した走行経路１０９を目標経路として追従走行する際、車両制御装置１８により実行される処理の一例を示すフローチャートである。

実施例１と実施例５の差異は、図９のステップＳ２１４以降の処理であり、実施例５の車両１の構成と、運転支援システムの構成、走行経路１０９と経路周辺環境の記憶処理は前記実施例１と同様である。

図９は、前記実施例１の図５のステップＳ２０８とＳ２０９の間に、ステップＳ２１４～Ｓ２１５、Ｓ２２１の処理を追加したものである。以下の説明では、前記実施例１と同一のステップについては、重複する説明を省略する。

実施例５では、ステップＳ２０８で車両制御部３５が、車両１が駐車位置１０１に到達していないと判定した場合、ステップＳ２１４へ進んで記憶情報照合部３４は外界認識センサ３１で周辺環境記憶部３３に記憶されていない静止物を検知したか否かを判定する（ステップＳ２１４）。

外界認識センサ３１が周辺環境記憶部３３に記憶していない静止物を検知していた場合は、記憶情報照合部３４が静止物の特徴量を算出し、特徴量が所定値以上か否かを判定する（ステップＳ２２１）。

具体的には、記憶情報照合部３４が、外界認識センサ３１で検知した静止物の外形から車輪を有している可能性を算出し、静止物が車輪を有していない可能性を特徴量として用いるなどが挙げられる。なお、静止物が車輪を有している可能性が高い場合には特徴量は小さくなり、静止物が車輪を有している可能性が低い場合には特徴量は大きくなる。

記憶情報照合部３４は、新たに検知した静止物の特徴量が所定値以上の場合は、周辺環境記憶部３３に自車位置推定用静止物として記憶する（ステップＳ２１５）。新たに検知した静止物を周辺環境記憶部３３に自車位置推定用静止物として記憶した後の処理は、実施例１と同様である。

上記のように車両制御装置１８は、新たに検知した静止物の特徴量に基づいて周辺環境記憶部３３に自車位置推定用静止物として記憶させることで記憶した経路の周辺環境の変化に対するシステムのロバスト性を向上さることができる。

また、車両制御装置１８は、新たに検知した静止物を記憶する際に、静止物の特徴量に条件を設けることで、駐車車両などの移動可能な物体だった場合に自車位置推定用静止物として記憶してしまうことを防止できる。

次に、本発明の実施例６を図１０を用いて説明する。

図１０は実施例６において車両１が周辺環境記憶部３３に記憶した走行経路１０９を目標経路として追従走行する際、車両制御装置１８により実行される処理の一例を示すフローチャートである。

実施例１と実施例６の差異は、図１０のステップＳ２２２以降の処理であり、実施例６の車両１の構成と、運転支援システムの構成、走行経路１０９と経路周辺環境の記憶処理は実施例１と同様である。

図９は、前記実施例１の図５のステップＳ２０８以降に、ステップＳ２２２～Ｓ２２４の処理を追加したものである。以下の説明では、前記実施例１と同一のステップについては、重複する説明を省略する。

実施例６では、ステップＳ２０８で車両制御部３５が、車両１が駐車位置１０１に到達したと判定した場合、ステップＳ２２２へ進んで記憶情報照合部３４は周辺環境記憶部３３に記憶された自車位置推定用静止物で、目標経路追従走行中に検知しなかった自車位置推定用静止物について、未検知回数を更新する（ステップＳ２２２）。

記憶情報照合部３４は、目標経路追従走行中に検知されなかった自車位置推定用静止物の未検知回数を更新した後、未検知回数が所定回数に達した自車位置推定用静止物があるか否かを判定する（ステップＳ２２３）。

記憶情報照合部３４は、未検知回数が所定回数に達した自車位置推定用静止物について、周辺環境記憶部３３から削除する（ステップＳ２２４）。

上記処理によって、未検知回数が所定回数に達した自車位置推定用静止物は実在しなくなったと判定でき、不要となった情報を周辺環境記憶部３３から削除することで周辺環境記憶部３３の空き容量を増大することができ、新たな情報を記憶することが可能となる。また、検知できなかった静止物を削除する際に、未検知回数が所定回数以上という制限を設けることで、天候や時間帯などの影響による外界認識センサ３１の性能低下で検知できなかった場合に、自車位置推定用静止物が削除されてしまうことを防止できる。

次に、本発明の実施例７を図１１と図１２を用いて説明する。

図１１は、実施例７において車両１がユーザーの運転により走行しながら周辺環境情報を記憶する際、車両制御装置１８により実行される処理の一例を示すフローチャートである。実施例７の車両１の構成と、運転支援システムの構成は実施例１と同様である。

図１１は、前記実施例１の図４のステップＳ２０２を、ステップＳ２０５に置き換えたものである。以下の説明では、前記実施例１と同一のステップについては、重複する説明を省略する。

ステップＳ２０５では、前記実施例１の３個以上に代わって２個以上の静止物を検知していれば、周辺環境記憶部３３はステップＳ２０３に進んで前記実施例１と同様の処理を行う。

図１２は、実施例７において車両１が記憶した走行経路１０９を目標として追従走行する際、車両制御装置１８により実行される処理の一例を示すフローチャートであり、実施例１との差異は、ステップＳ２２２以降の処理である。図１２は、前記実施例１の図５のステップＳ２０９以降に、ステップＳ２２５～Ｓ２２８の処理を追加したものである。

実施例７において、前記実施例１から実施例６とは異なり、車両１は車輪センサ５０を含んでいることが必須である。また、車両１は舵角センサ２８も有する方が望ましい。

実施例７では、車両制御部３５は、目標経路追従走行を開始してから所定時間が経過したか否かを判定する（ステップＳ２２５）。例えば、自車位置推定部３２は、目標経路追従走行を開始した直後に検知した静止物が１個のみの場合は自車位置を推定することができないが、目標経路追従走行を開始してから１度でも自車位置を推定することができていれば、目標経路追従走行時に検知した静止物が１個のみでも検知情報と直前の自車位置を用いることで自車位置を推定できる。

具体的には、自車位置推定部３２が、検知した静止物を中心として半径が自車位置と検知した静止物との間の距離とする円周上の点で、直前の自車位置推定値と最も距離が短い点を自車位置とするなどが挙げられる。また、車両制御部３５は、目標経路追従走行を開始してから所定時間が経過したか否かではなく、目標経路追従走行を開始してから所定距離以上走行したか否かで判定してもよい。

次に、記憶情報照合部３４は、目標経路追従走行を開始してから所定時間以上経過していた場合、静止物を１個以上検知しているか判定する（ステップＳ２２６）。

静止物を検知していない場合は、自車位置推定部３２にて、直前の自車位置（推定位置）を基準に、車輪センサ５０や舵角センサ２８などの値を用いてデッドレコニングにより自車位置を推定する（ステップＳ２２７）。

一方、静止物を１個以上検知していた場合は、記憶情報照合部３４にて、検知した静止物の特徴に基づいて、検知した静止物が周辺環境記憶部３３に記憶された自車位置推定用静止物のうちのどの自車位置推定用静止物に該当するか照合する（ステップＳ２０６）。

照合が完了したら、自車位置推定部３２にて、検知した静止物との相対位置関係を用いて自車位置を推定する（ステップＳ２０７）。

自車位置推定部３２は、検知した静止物との相対位置関係に基づいて自車位置を算出した後、前回の周期でステップＳ２２７のデッドレコニングによって自車位置を推定していた場合は、検知した静止物との相対関係に基づいて算出した自車位置と、前回の周期で推定した自車位置の差が所定値以内か判定する（ステップＳ２２８）。

車両制御部３５は、前記差が所定値を超えた場合は、車輪センサ５０や舵角センサ２８の故障もしくは、外界認識センサ３１の故障の可能性が高いため目標経路追従走行を終了する。目標経路追従走行を中止する際、車両制御部３５は、表示器３７上に目標経路追従走行に失敗したことを伝えるためのメッセージを表示してもよい。

車両制御部３５は、前記差が所定値以内だった場合は、ステップＳ２０８へ進んで前記実施例１と同様の処理を行う。

上記のように、車両制御部３５は、自車位置推定方法にデッドレコニングを用いることで、目標経路追従走行中に静止物を検知できない瞬間があっても自車位置を推定することができ目標経路追従走行を継続することができる。

次に、本発明の実施例８を図１３を用いて説明する。

実施例８は、前記実施例１から実施例７とは異なり、車両１は位置検出器２９を有することが必須である。

図１３は、実施例８において車両１が記憶した走行経路１０９を目標経路として追従走行する際、車両制御装置１８により実行される処理の一例を示すフローチャートである。

実施例７と実施例８の差異は、車両１及び運転支援システムがＧＰＳ情報（測位衛星による位置情報）を使用できることと、図１３のステップＳ２０５以降の処理であり、経路と経路周辺環境の記憶処理は同じである。

実施例８において、静止物を２個以上検知していた場合の処理は実施例１と同様である。図１３は、前記実施例１の図５のステップＳ２０５でＮＯの場合に、ステップＳ２２６～Ｓ２２９の処理を追加したものである。以下の説明では、前記実施例１と同一のステップについては、重複する説明を省略する。

記憶情報照合部３４は、検知した静止物が２個未満の場合は、静止物を１個以上検知しているか判定する（ステップＳ２２６）。記憶情報照合部３４は、検知した静止物が１個未満だった場合は、目標経路追従走行を終了する。

終了する際、記憶情報照合部３４は、表示器３７上に目標経路追従走行に失敗したことをユーザーに伝えるためのメッセージを表示してもよい。また、自車位置推定部３２は、前回の周期で自車位置を推定することができていた場合には、前回の周期で算出した自車位置を基準に車輪センサ５０や舵角センサ２８を用いたデッドレコニングによって自車位置を推定してもよい。自車位置を推定できた場合は、ステップＳ２０６へ進む。

記憶情報照合部３４は、静止物を一個以上検知していた場合は、記憶情報照合部３４にて検知した静止物の特徴に基づいて、検知した静止物が周辺環境記憶部３３に記憶された自車位置推定用静止物のうちのどの自車位置推定用静止物に該当するか照合する（ステップＳ２０６）。

照合が完了したら、自車位置推定部３２にて、検知した静止物との相対位置関係とＧＰＳ情報を用いて自車位置を推定する（ステップＳ２２９）。具体的には、自車位置推定部３２は、検知した静止物を中心として半径が検知した静止物と自車両の距離となる円周上の点で、ＧＰＳ情報による自車位置と最も距離が小さい点を自車位置とするなどの方法が挙げられる。自車位置を推定した後はステップＳ２０８に進み前記実施例１と同様の処理を行う。

上記のように、実施例８の車両制御装置１８は、自車位置推定方法にＧＰＳ情報を用いることで、目標経路追従走行中に静止物を同時に２個以上検知できない瞬間があっても、静止物を１個でも検知できていれば自車位置を推定することができ目標経路追従走行を継続することができる。

また、上記の実施例１から実施例８の処理を、目標経路の開始位置から経路長に対する所定の距離でのみ実行してもよいし、駐車位置１０１を含む目標経路の後半部分の所定の割合箇所のみ実行してもよい。駐車位置１０１に正確に到達するために実施例１から実施例８の構成を用いて精度の高い自車位置を算出する必要性が大きいのは、目標経路追従走行の開始地点又は、駐車位置１０１付近であり、複数の静止物体を自車位置推定用に記憶する箇所を限定することで、周辺環境記憶部３３で必要とされる記憶容量を小さくすることができる。

また、周辺環境記憶部３３は、撮像センサ１７、近距離測距センサ２４、中距離測距センサ２２、遠距離測距センサ２５によって手動操作にて走行した際に取得した周辺環境情報と、走行経路情報を記憶させておくことも可能であるが、走行経路１０９によっては記憶する情報が膨大になる可能性があるため、記憶容量が足りない場合がある。そのため、周辺環境記憶部３３に記憶する周辺環境情報は、通信装置３０によって、大容量のデータを記憶できる本制御装置の外部設備へデータを送信し、外部のデータセンタに蓄積させておくことも可能である。その際、周辺環境情報を記憶した運転者を特定する方法を用いる。

また、周辺環境記憶部３３は、手動操作にて走行した際に取得した周辺環境情報が存在しない場合は、通信装置３０を用いて、他車両が過去に走行した際に取得した周辺環境情報と自車位置情報を管理している外部のデータセンタや道路インフラ等から取得することが可能である。外部のデータセンタや道路インフラ等で周辺環境情報を共有することで、自車両以外にも車種の異なる他車両でも周辺環境情報を使用することで、自動走行することが可能となる。

＜結び＞
以上のように、上記実施例１～８の車両制御装置は、以下のような構成とすることができる。

（１）プロセッサ（２）とメモリ（３）を有し、車両（１）の走行を制御する車両制御装置（１８）であって、前記車両（１）の周辺環境情報を取得するセンサ（外界認識センサ３１）と、前記センサ（３１）が取得した周辺環境情報から静止物を取得し、前記静止物の位置を算出し、走行経路（１０９）上の前記車両（１）の位置と、前記静止物の位置を対応付けて記憶する周辺環境記憶部（３３）と、を有し、前記周辺環境記憶部（３３）は、前記周辺環境情報と走行経路（１０９）の記憶を開始する指令を受け付けた場合には、前記走行経路（１０９）上の各位置において３以上の前記静止物を自車位置推定用静止物として記憶する。

上記構成により、車両制御装置１８は、入力スイッチ部２７から周辺環境情報の記憶を開始する所定の指令を受け付けると、周辺環境記憶部３３が周期的に走行経路１０９上の位置と自車位置推定用静止物を記憶する。周辺環境記憶部３３は、周期的に記憶した走行経路１０９上の各位置では、３個以上の静止物を検知して、静止物の位置と特徴を演算して自車位置推定用静止物として記憶する。

（２）上記（１）に記載の車両制御装置（１８）であって、前記記憶された走行経路（１０９）上の位置に追従する指令を受け付けた場合には、前記センサ（３１）が取得した周辺環境情報から静止物を検知し、当該静止物に一致する前記自車位置推定用静止物を特定する記憶情報照合部（３４）と、前記特定された自車位置推定用静止物の位置から前記車両（１）の位置を推定する自車位置推定部（３２）と、前記推定された車両（１）の位置と、前記記憶された走行経路（１０９）に基づいて自動運転を行う車両制御部（３５）と、さらに有し、前記記憶情報照合部（３４）は、２以上の前記静止物を検知した場合に前記自車位置推定用静止物を特定する。

上記構成により、車両制御装置１８は、入力スイッチ部２７（入力部）から走行経路１０９を目標経路として追従走行を行う指令を受け付けると、記憶情報照合部３４が、外界認識センサ３１から取得した周辺環境情報から２以上の静止物を検知し、周辺環境記憶部３３で記憶された自車位置推定用静止物と一致する静止物を特定する。そして、自車位置推定部３２が、特定された２以上の自車位置推定用静止物の位置から自車位置を推定し、車両制御部３５は、自車位置の推定値が目標経路に沿うように制御を実施する。車両制御装置１８は、走行経路１０９と経路周辺の周辺環境情報を記憶する場合に、車両制御装置１８は、同時に３個以上の静止物を自車位置推定用静止物として記憶することで、目標経路追従走行時に走行経路１０９の周辺の環境が変化して、静止物が１個なくなってしまった場合でも、２個以上の静止物から自車位置を推定することができ、車両制御部３５は目標経路に追従して車両１を走行させることが可能となる。

（３）上記（２）に記載の車両制御装置（１８）であって、前記記憶情報照合部（３４）は、前記記憶された前記自車位置推定用静止物のうち、前記検知された静止物に含まれない前記自車位置推定用静止物が存在する場合には、当該自車位置推定用静止物が存在する可能性を有する範囲で再度静止物の検知を実施して、検知の結果前記自車位置推定用静止物が検知されなかった場合には、当該自車位置推定用静止物を削除する。

上記構成により、車両制御装置１８は、不要となった情報を周辺環境記憶部３３から削除することで周辺環境記憶部３３の空き容量を拡大することができ、新たな情報を記憶することが可能となる。

（４）上記（３）に記載の車両制御装置（１８）であって、前記記憶情報照合部（３４）は、前記自車位置推定用静止物を削除した場合に、前記自車位置推定用静止物として記憶されていない静止物を検知した場合には、新たな前記自車位置推定用静止物として記憶する。

上記構成により、上記のように周辺環境記憶部３３で検出できなかった自車位置推定用の静止物情報を削除した場合に、新たに検知した静止物を自車位置推定用静止物として記憶することで記憶した走行経路１０９の周辺環境の変化に対する運転支援システムのロバスト性を維持することができる。

（５）上記（２）に記載の車両制御装置（１８）であって、前記記憶情報照合部（３４）は、前記記憶された自車位置推定用静止物に一致しない静止物を所定回数以上検知した場合には、新たな自車位置推定用静止物として記憶する。

上記構成により、新たに検知した静止物を記憶する際に、検知回数が所定回数以上という制限を設けることで、駐車車両などの移動可能な物体だった場合に自車位置推定用静止物として記憶してしまうことを防止できる。

（６）上記（５）に記載の車両制御装置（１８）であって、前記記憶情報照合部（３４）は、前記記憶された自車位置推定用静止物に一致しない静止物の特徴量を算出し、前記特徴量が所定値以上のときは、前記所定回数を低減する。

上記構成により、車両制御装置１８は、新たに検知した静止物を記憶する際に、静止物の特徴量に条件を設けることで、駐車車両などの移動可能な物体だった場合に自車位置推定用静止物として記憶してしまうことを防止できる。

（７）上記（５）に記載の車両制御装置（１８）であって、前記記憶情報照合部（３４）は、前記記憶された自車位置推定用静止物に一致しない静止物の形状が所定の形状の場合には、前記所定回数を低減する。

上記構成により、車両制御装置１８は、新たに検知した静止物を記憶する際に、静止物の特徴に条件を設けることで、駐車車両などの移動可能な物体だった場合に自車位置推定用静止物として記憶してしまうことを防止できる。

（８）上記（２）に記載の車両制御装置（１８）であって、前記記憶情報照合部（３４）は、前記記憶された自車位置推定用静止物に一致しない静止物を検知した場合には、当該静止物の特徴量を算出し、前記特徴量が所定値以上の場合には新たに自車位置推定用静止物として記憶する。

上記構成により、車両制御装置１８は、新たに検知した静止物の特徴量に基づいて周辺環境記憶部３３に自車位置推定用静止物として記憶することで記憶した経路の周辺環境の変化に対するシステムのロバスト性を向上さることができる。

（９）上記（２）に記載の車両制御装置（１８）であって、前記周辺環境記憶部（３３）は、前記走行経路（１０９）上の各位置において３個の前記静止物を検知できない場合は、検知した静止物を自車位置推定用静止物として記憶し、前記自車位置推定部（３２）は、前記自車位置推定用静止物とデッドレコニングによって車両（１）の位置を推定する。

上記構成により、車両制御装置１８は、自車位置の推定方法にデッドレコニングを用いることで、目標経路の追従走行中に静止物を検知できない瞬間があっても自車位置を推定することができ目標経路の追従走行を継続することができる。

（１０）上記（２）に記載の車両制御装置（１８）であって、前記記憶情報照合部（３４）は、前記記憶された自車位置推定用静止物を所定回数検知しなかった場合には、当該自車位置推定用静止物を記憶から削除する。

上記構成により、未検知の回数が所定回数に達した自車位置推定用静止物は実在しなくなったと判定でき、不要となった自車位置推定用静止物の情報を周辺環境記憶部３３から削除することで周辺環境記憶部３３の空き容量を増大することができ、新たな情報を記憶することが可能となる。

（１１）上記（２）に記載の車両制御装置（１８）であって、前記記憶情報照合部（３４）は、前記検知された静止物が１個の場合には、当該静止物と一致する自車位置推定用静止物の位置を出力し、前記自車位置推定部（３２）は、測位衛星による位置情報を利用可能であって、前記自車位置推定用静止物の位置と測位衛星による位置情報から車両（１）の位置を推定する。

上記構成により、車両制御装置１８は、自車位置推定方法にＧＰＳ情報を用いることで、目標経路追従走行中に静止物を同時に２個以上検知できない瞬間があっても、静止物を１個でも検知できていれば自車位置を推定することができ目標経路追従走行を継続することができる。

（１２）上記（２）ないし（１１）のいずれかひとつに記載の車両制御装置（１８）であって、前記周辺環境記憶部（３３）は、前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた前記開始位置から前記走行経路（１０９）の所定の区間で、前記静止物を自車位置推定用静止物として記憶する。

上記構成により、車両制御装置１８は、複数の静止物を自車位置推定用に記憶する箇所を限定することで、周辺環境記憶部３３で必要とされる記憶容量を小さくすることができる。

（１３）上記（２）ないし（１１）のいずれかひとつに記載の車両制御装置（１８）であって、前記周辺環境記憶部（３３）は、前記走行経路（１０９）の終点を含む所定割合の区間で、前記静止物を自車位置推定用静止物として記憶する。

上記構成により、車両制御装置１８は、複数の静止物を自車位置推定用に記憶する箇所を限定することで、周辺環境記憶部３３で必要とされる記憶容量を小さくすることができる。

なお、本発明は上記した実施例に限定されるものではなく、様々な変形例が含まれる。例えば、上記した実施例は本発明を分かりやすく説明するために詳細に記載したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施例の構成の一部を他の実施例の構成に置き換えることが可能であり、また、ある実施例の構成に他の実施例の構成を加えることも可能である。また、各実施例の構成の一部について、他の構成の追加、削除、又は置換のいずれもが、単独で、又は組み合わせても適用可能である。

また、上記の各構成、機能、処理部、及び処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、及び機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリや、ハードディスク、ＳＳＤ（Ｓｏｌｉｄ Ｓｔａｔｅ Ｄｒｉｖｅ）等の記録装置、又は、ＩＣカード、ＳＤカード、ＤＶＤ等の記録媒体に置くことができる。

また、制御線や情報線は説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えてもよい。

１ 車両
１１ エンジン
１２ 自動変速機
１３ プロペラシャフト
１４ ディファレンシャルギア
１５ ドライブシャフト
１６ 車輪
１７ 撮像センサ
１８ 車両制御装置
１９ 各種センサ
２０ ブレーキ装置
２１ 電動パワーステアリング
２４ 近距離測距センサ
２２ 中距離測距センサ
２５ 遠距離測距センサ
２７ 入力スイッチ部
２９ 位置検出器
３０ 通信装置
３１ 外界認識センサ
３２ 自車位置推定部
３３ 周辺環境記憶部
３４ 記憶情報照合部
３５ 車両制御部
３６ 各種センサ／アクチュエータＥＣＵ
３７ 表示器
３８ 音声出力器
３９ 操舵制御部
４０ 加減速制御部
４１ シフト制御部
５０ 車輪センサ

Claims (11)

1. プロセッサとメモリを有し、車両の走行を制御する車両制御装置であって、
   前記車両の周辺環境情報を取得するセンサと、
   前記センサが取得した周辺環境情報から静止物を取得し、前記静止物の位置を算出し、走行経路上の前記車両の位置と、前記静止物の位置を対応付けて記憶する周辺環境記憶部と、
   前記記憶された走行経路上の位置に追従する指令を受け付けた場合には、前記センサが取得した周辺環境情報から静止物を検知し、２以上の前記静止物を検知した場合には、当該静止物に一致する自車位置推定用静止物を特定する記憶情報照合部と、
   前記特定された自車位置推定用静止物の位置から前記車両の位置を推定する自車位置推定部と、
   前記推定された車両の位置と、前記記憶された走行経路に基づいて自動運転を行う車両制御部と、を有し、
   前記周辺環境記憶部は、
   前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた場合には、前記走行経路上の各位置において３以上の前記静止物を自車位置推定用静止物として記憶し、
   前記記憶情報照合部は、
   前記記憶された前記自車位置推定用静止物のうち、前記検知された静止物に含まれない前記自車位置推定用静止物が存在する場合には、当該自車位置推定用静止物が存在する可能性を有する範囲で再度静止物の検知を実施し、
   検知の結果前記自車位置推定用静止物が検知されなかった場合には、当該自車位置推定用静止物を削除することを特徴とする車両制御装置。
2. 請求項１に記載の車両制御装置であって、
   前記記憶情報照合部は、
   前記自車位置推定用静止物を削除した場合には、前記自車位置推定用静止物として記憶されていない静止物を検知した場合には、新たな前記自車位置推定用静止物として記憶することを特徴とする車両制御装置。
3. プロセッサとメモリを有し、車両の走行を制御する車両制御装置であって、
   前記車両の周辺環境情報を取得するセンサと、
   前記センサが取得した周辺環境情報から静止物を取得し、前記静止物の位置を算出し、走行経路上の前記車両の位置と、前記静止物の位置を対応付けて記憶する周辺環境記憶部と、
   前記記憶された走行経路上の位置に追従する指令を受け付けた場合には、前記センサが取得した周辺環境情報から静止物を検知し、２以上の前記静止物を検知した場合には、当該静止物に一致する自車位置推定用静止物を特定する記憶情報照合部と、
   前記特定された自車位置推定用静止物の位置から前記車両の位置を推定する自車位置推定部と、
   前記推定された車両の位置と、前記記憶された走行経路に基づいて自動運転を行う車両制御部と、を有し、
   前記周辺環境記憶部は、
   前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた場合には、前記走行経路上の各位置において３以上の前記静止物を自車位置推定用静止物として記憶し、
   前記記憶情報照合部は、
   前記記憶された自車位置推定用静止物に一致しない静止物を所定回数以上検知した場合には、新たな自車位置推定用静止物として記憶することを特徴とする車両制御装置。
4. 請求項３に記載の車両制御装置であって、
   前記記憶情報照合部は、
   前記記憶された自車位置推定用静止物に一致しない静止物の特徴量を算出し、前記特徴量が所定値以上の場合には、前記所定回数を低減することを特徴とする車両制御装置。
5. 請求項３に記載の車両制御装置であって、
   前記記憶情報照合部は、
   前記記憶された自車位置推定用静止物に一致しない静止物の形状が所定の形状の場合には、前記所定回数を低減することを特徴とする車両制御装置。
6. プロセッサとメモリを有し、車両の走行を制御する車両制御装置であって、
   前記車両の周辺環境情報を取得するセンサと、
   前記センサが取得した周辺環境情報から静止物を取得し、前記静止物の位置を算出し、走行経路上の前記車両の位置と、前記静止物の位置を対応付けて記憶する周辺環境記憶部と、
   前記記憶された走行経路上の位置に追従する指令を受け付けた場合には、前記センサが取得した周辺環境情報から静止物を検知し、２以上の前記静止物を検知した場合には、当該静止物に一致する自車位置推定用静止物を特定する記憶情報照合部と、
   前記特定された自車位置推定用静止物の位置から前記車両の位置を推定する自車位置推定部と、
   前記推定された車両の位置と、前記記憶された走行経路に基づいて自動運転を行う車両制御部と、を有し、
   前記周辺環境記憶部は、
   前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた場合には、前記走行経路上の各位置において３以上の前記静止物を自車位置推定用静止物として記憶し、
   前記記憶情報照合部は、
   前記記憶された自車位置推定用静止物に一致しない静止物を検知した場合には、当該静止物の特徴量を算出し、前記特徴量が所定値以上の場合には新たに自車位置推定用静止物として記憶することを特徴とする車両制御装置。
7. プロセッサとメモリを有し、車両の走行を制御する車両制御装置であって、
   前記車両の周辺環境情報を取得するセンサと、
   前記センサが取得した周辺環境情報から静止物を取得し、前記静止物の位置を算出し、走行経路上の前記車両の位置と、前記静止物の位置を対応付けて記憶する周辺環境記憶部と、
   前記記憶された走行経路上の位置に追従する指令を受け付けた場合には、前記センサが取得した周辺環境情報から静止物を検知し、２以上の前記静止物を検知した場合には、当該静止物に一致する自車位置推定用静止物を特定する記憶情報照合部と、
   前記特定された自車位置推定用静止物の位置から前記車両の位置を推定する自車位置推定部と、
   前記推定された車両の位置と、前記記憶された走行経路に基づいて自動運転を行う車両制御部と、を有し、
   前記周辺環境記憶部は、
   前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた場合には、前記走行経路上の各位置において３以上の前記静止物を自車位置推定用静止物として記憶し、
   前記走行経路上の各位置において３個の前記静止物を検知できない場合には、検知した静止物を自車位置推定用静止物として記憶し、
   前記自車位置推定部は、
   前記自車位置推定用静止物とデッドレコニングによって車両の位置を推定することを特徴とする車両制御装置。
8. プロセッサとメモリを有し、車両の走行を制御する車両制御装置であって、
   前記車両の周辺環境情報を取得するセンサと、
   前記センサが取得した周辺環境情報から静止物を取得し、前記静止物の位置を算出し、走行経路上の前記車両の位置と、前記静止物の位置を対応付けて記憶する周辺環境記憶部と、
   前記記憶された走行経路上の位置に追従する指令を受け付けた場合には、前記センサが取得した周辺環境情報から静止物を検知し、２以上の前記静止物を検知した場合には、当該静止物に一致する自車位置推定用静止物を特定する記憶情報照合部と、
   前記特定された自車位置推定用静止物の位置から前記車両の位置を推定する自車位置推定部と、
   前記推定された車両の位置と、前記記憶された走行経路に基づいて自動運転を行う車両制御部と、を有し、
   前記周辺環境記憶部は、
   前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた場合には、前記走行経路上の各位置において３以上の前記静止物を自車位置推定用静止物として記憶し、
   前記記憶情報照合部は、
   前記記憶された自車位置推定用静止物を所定回数検知しなかった場合には、当該自車位置推定用静止物を記憶から削除することを特徴とする車両制御装置。
9. プロセッサとメモリを有し、車両の走行を制御する車両制御装置であって、
   前記車両の周辺環境情報を取得するセンサと、
   前記センサが取得した周辺環境情報から静止物を取得し、前記静止物の位置を算出し、走行経路上の前記車両の位置と、前記静止物の位置を対応付けて記憶する周辺環境記憶部と、
   前記記憶された走行経路上の位置に追従する指令を受け付けた場合には、前記センサが取得した周辺環境情報から静止物を検知し、２以上の前記静止物を検知した場合には、当該静止物に一致する自車位置推定用静止物を特定する記憶情報照合部と、
   前記特定された自車位置推定用静止物の位置から前記車両の位置を推定する自車位置推定部と、
   前記推定された車両の位置と、前記記憶された走行経路に基づいて自動運転を行う車両制御部と、を有し、
   前記周辺環境記憶部は、
   前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた場合には、前記走行経路上の各位置において３以上の前記静止物を自車位置推定用静止物として記憶し、
   前記記憶情報照合部は、
   前記検知された静止物が１個の場合には、当該静止物と一致する自車位置推定用静止物の位置を出力し、
   前記自車位置推定部は、
   測位衛星による位置情報を利用可能であって、前記自車位置推定用静止物の位置と測位衛星による位置情報から車両の位置を推定することを特徴とする車両制御装置。
10. 請求項１ないし請求項９のいずれかひとつに記載の車両制御装置であって、
    前記周辺環境記憶部は、
    前記周辺環境情報と走行経路の記憶を開始する指令を受け付けた開始位置から前記走行経路の所定の区間で、前記静止物を自車位置推定用静止物として記憶することを特徴とする車両制御装置。
11. 請求項１ないし請求項９のいずれかひとつに記載の車両制御装置であって、
    前記周辺環境記憶部は、
    前記走行経路の終点を含む所定割合の区間で、前記静止物を自車位置推定用静止物として記憶することを特徴とする車両制御装置。

Images