(57)【特許請求の範囲】
【請求項１】
プロセッサに実行にさせる、車両の走行支援方法であって、
自車両の位置を推定し、
データベースから地図情報を取得し、
推定された前記自車両の位置及び前記地図情報に基づき、前記自車両が走行する自車走行経路を生成し、
前記自車走行経路の信頼度を示す第１信頼度を演算し、
前記自車両の前方を走行する先行車を検出し、
前記先行車が走行する先行車走行経路を生成し、
前記先行車走行経路の形状に基づき、前記先行車走行経路の信頼度を示す第２信頼度を演算し、
前記第１信頼度と前記第２信頼度に基づき、前記自車走行経路と前記先行車走行経路とを統合するための統合割合を演算し、
前記自車両の目標走行経路の境界が、前記自車走行経路の境界と前記先行車走行経路の境界との間になるように、演算された前記統合割合に応じて前記自車両の目標走行経路を演算し、
前記目標走行経路に基づいて前記自車両を制御する走行支援方法。
【請求項２】
前記自車両の位置の推定精度が低いほど、前記第１信頼度を低くする請求項１に記載の走行支援方法。
【請求項３】
前記地図情報で表される地図の地図精度が低いほど、前記第１信頼度を低くする請求項１又は２に記載の走行支援方法。
【請求項４】
前記自車両の位置の推定精度、及び、前記地図情報で表される地図の地図精度をそれぞれ演算し、
前記推定精度と前記地図精度のうち、いずれか低い方の精度に基づき前記第１信頼度を演算する請求項１記載の走行支援方法。
【請求項５】
センサにより検出される前記先行車の検出データを用いて、前記先行車走行経路の単体信頼度を演算し、
前記自車走行経路と前記先行車走行経路とを比較して、前記先行車走行経路の比較信頼度を演算し、
前記単体信頼度と前記比較信頼度に基づき、前記第２信頼度を演算する請求項１〜４のいずれか一項に記載の走行支援方法。
【請求項６】
前記センサの検出の安定性を評価することで、前記センサの信頼度を示すセンサ信頼度を演算し、
前記センサの検出データを用いて、前記先行車走行経路に含まれる先行車走行軌跡を生成し、
前記先行車走行軌跡の長さで決まる、軌跡信頼度を演算し、
前記センサ信頼度及び前記軌跡信頼度に基づき、前記単体信頼度を演算する請求項５記載の走行支援方法。
【請求項７】
前記先行車走行軌跡の長さが短いほど、前記軌跡信頼度を低くする請求項６記載の走行支援方法。
【請求項８】
前記センサ信頼度と前記軌跡信頼度のうち、いずれか低い方の信頼度に基づき前記単体信頼度を演算する請求項６又は７記載の走行支援方法。
【請求項９】
前記自車走行経路の曲率と前記先行車走行経路の曲率との曲率差を演算し、前記曲率差が大きいほど前記比較信頼度を低くする請求項５〜８のいずれか一項に記載の走行支援方法。
【請求項１０】
前記曲率差が同じ場合に、前記自車両の車速が大きいほど前記比較信頼度が低くなる相関関係を用いて、前記自車両の車速及び前記曲率差に基づき、前記比較信頼度を演算する請求項９記載の走行支援方法。
【請求項１１】
前記自車走行経路上における横方向の前記自車両の位置と、前記先行車走行経路上における横方向の前記先行車の位置との偏差を演算し、前記偏差が大きいほど前記比較信頼度を低くする請求項５〜１０のいずれか一項に記載の走行支援方法。
【請求項１２】
前記自車走行経路の曲率と前記先行車走行経路の曲率との曲率差を演算し、前記曲率差と前記先行車走行経路の信頼度との相関性に基づき、前記第２信頼度を示す値を曲率信頼度として演算し、
前記自車走行経路上における横方向の前記自車両の位置と、前記先行車走行経路上における横方向の前記先行車の位置との偏差を演算し、前記偏差と前記先行車走行経路の信頼度との相関性に基づき、前記第２信頼度を示す値を横方向信頼度として演算し、
前記曲率信頼度及び前記横方向信頼度のうち、いずれか低い方の信頼度に基づき前記第２信頼度を演算する請求項５〜８のいずれか一項に記載の走行支援方法。
【請求項１３】
前記単体信頼度及び前記比較信頼度のうち、いずれか低い方の信頼度に基づき前記第２信頼度を演算する請求項５〜８のいずれか一項に記載の走行支援方法。
【請求項１４】
前記自車走行経路上における横方向の前記自車両の座標と、前記先行車走行経路上における横方向の前記先行車の座標をそれぞれ推定し、
前記統合割合で前記自車両の座標及び前記先行車の座標を統合させることで前記目標走行経路を演算する請求項１〜１３のいずれか一項に記載の走行支援方法。
【請求項１５】
前記第１信頼度及び前記第２信頼度が所定の信頼度閾値より高い場合には、前記先行車走行経路より前記自車走行経路の割合が大きくなるように前記目標走行経路を演算する請求項１〜１４のいずれか一項に記載の走行支援方法。
【請求項１６】
前記第１信頼度が所定の信頼度閾値より高く、前記第２信頼度が前記所定の信頼度より低い場合には、前記先行車走行経路より前記自車走行経路の割合が大きくなるように前記目標走行経路を演算する請求項１〜１４のいずれか一項に記載の走行支援方法。
【請求項１７】
前記第１信頼度が所定の信頼度閾値より低く、前記第２信頼度が前記所定の信頼度閾値より高い場合には、前記自車走行経路より前記先行車走行経路の割合が大きくなるように前記目標走行経路を演算する請求項１〜１４のいずれか一項に記載の走行支援方法。
【請求項１８】
前記自車両の目標走行経路を目標走路境界として演算し、
前記目標走路境界に基づいて目標走行軌跡を演算し、自車両の前記自車両を制御する請求項１〜１５のいずれか一項に記載の走行支援方法。
【請求項１９】
前記自車両の目標走行経路を目標走行領域として演算し、
前記目標走行領域に基づいて目標走行軌跡を演算し、自車両の前記自車両を制御する請求項１〜１５のいずれか一項に記載の走行支援方法。
【請求項２０】
プロセッサを有する走行支援装置であって、
前記プロセッサは、
自車両の位置を推定し、
データベースから地図情報を取得し、
推定された前記自車両の位置及び前記地図情報に基づき、前記自車両が走行する自車走行経路を生成し、
前記自車走行経路の信頼度を示す第１信頼度を演算し、
前記自車両の前方を走行する先行車を検出し、
前記先行車が走行する先行車走行経路を生成し、
前記先行車走行経路の形状に基づき、前記先行車走行経路の信頼度を示す第２信頼度を演算し、
前記第１信頼度と前記第２信頼度に基づき、前記自車走行経路と前記先行車走行経路とを統合するための統合割合を演算し、
前記自車両の目標走行経路の境界が、前記自車走行経路の境界と前記先行車走行経路の境界との間になるように、演算された前記統合割合に応じて前記自車両の目標走行経路を演算し、
前記目標走行経路に基づいて前記自車両を制御する走行支援装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、車両の走行を制御する走行支援方法および走行支援装置に関する。
【背景技術】
【０００２】
走行経路生成装置において、先行車両の走行軌跡を中心とし、先行車両の認識尤度が低いほど幅が大きくなる先行車両走行領域を設定し、自車両が走行する走行領域と先行車両走行領域との重複範囲内を通る自車両の走行経路を生成するものが知られている（たとえば特許文献１）。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２０１５−１９１５５３号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
しかしながら、上記従来技術において、例えば、先行車両の認識尤度が高い状態で、先行車が進路を変えた場合には、自車両は先行車に追随してふらついてしまうという問題がある。
【０００５】
本発明が解決しようとする課題は、自車両のふらつきを抑制できる走行支援方法及び走行支援装置を提供することである。
【課題を解決するための手段】
【０００６】
本発明は、推定された自車両の位置及び地図情報に基づき自車走行経路を生成し、自車走行経路の信頼度を示す第１信頼度を演算し、車載センサを用いて先行車を検出し、先行車走行経路を生成し、先行車走行経路の形状に基づき先行車走行経路の信頼度を示す第２信頼度を演算し、第１信頼度と第２信頼度に基づき、自車走行経路と先行車走行経路とを統合するための統合割合を演算し、統合割合で自車走行経路と先行車走行経路とを統合することで、自車両の目標走行経路を演算し、目標走行経路に基づいて自車両を制御することで、上記課題を解決する。
【発明の効果】
【０００７】
本発明によれば、先行車の走行経路と自車両の走行経路の違いを認識することができ、先行車を追随することによる、自車両のふらつきを抑制できる。
【図面の簡単な説明】
【０００８】
【図１】本発明の一実施の形態に係る走行支援装置を示すブロック図である。
【図２】図１の制御装置における走行支援処理のフローチャートを説明するためのブロック図である。
【図３】図２の制御処理（ステップＳ６００）のフローチャートを説明するためのブロック図である。
【図４】図３の制御処理（ステップＳ６１０）のフローチャートを説明するためのブロック図である。
【図５】自車位置の分散値と第１信頼度との関係を示すグラフである。
【図６】地図精度と第１信頼度との関係を示すグラフである。
【図７】図３の制御処理（ステップＳ６２０）のフローチャートを説明するためのブロック図である。
【図８】曲率差と曲率信頼度との関係を示すグラフである。
【図９】横位置偏差と横位置信頼度との関係を示すグラフである。
【図１０】図２の制御処理（ステップＳ６００）により、演算される統合後の走行経路を説明するための図である。
【図１１】第１信頼度及び第２信頼度に対して、自車走行経路と先行車走行経路の活用割合を説明するための表である。
【図１２】自車走行経路と先行車走行経路の活用割合と、統合後の走行経路との関係を説明するための図である。
【発明を実施するための形態】
【０００９】
以下、本発明の一実施の形態に係る車両の走行支援装置及び方法を図面に基づいて説明する。なお、本実施形態では、車両に搭載される走行支援装置を例示して本発明を説明する。
【００１０】
図１は、本発明の実施形態に係る車両の走行支援装置１００の構成を示す図である。図１に示すように、本実施形態に係る走行支援装置１００は、自車位置検出装置１１０と、地図データベース１２０と、車速センサ１３０と、測距センサ１４０と、カメラ１５０と、駆動機構１７０と、制御装置１８０と、ヨーレートセンサ１９０とを備える。これら装置は、相互に情報の授受を行うためにＣＡＮ（Controller Area Network）その他の車載ＬＡＮによって接続されている。
【００１１】
自車位置検出装置１１０は、ＧＰＳユニットを備え、複数の衛星通信から送信される電波をロケータ（ＧＰＳアンテナ）により検出して、自車両の位置情報を、周期的に取得するとともに、取得した自車両の位置情報と、ジャイロセンサから取得した角度変化情報と、車速センサから取得した車速とに基づいて、自車両の現在位置を検出する。また、自車位置検出装置１１０は、周知のマップマッチング技術を用いて、自車両の位置を検出することもできる。
【００１２】
地図データベース１２０には、地図情報が格納されている。地図データベース１２０が記憶する地図情報には、各地図座標における道路形状の情報、たとえばカーブ、坂道、交差点、インターチェンジ、狭路、直線路、路肩構造物、合流地点に関する属性が、地図座標に対応付けて記録されている。地図情報は、車両の自動運転制御に使用するための高精度地図である。
【００１３】
車速センサ１３０は、ドライブシャフトなどの駆動系の回転速度を計測し、これに基づいて自車両の走行速度（以下、車速ともいう）を検出する。車速センサ１３０により検出された自車両の車速情報は制御装置１８０に出力される。ヨーレートセンサ１９０は、車室内などの適宜箇所に装着され、自車両のヨーレート（旋回方向への回転角の変化速度）を検出し、検出された自車両のヨーレート情報は制御装置１８０に出力される。
【００１４】
測距センサ１４０は、自車両の周囲に存在する対象物を検出する。また、測距センサ１４０は、自車両と対象物との相対距離および相対速度を算出する。測距センサ１４０により検出された対象物の情報は制御装置１８０に送信される。なお、このような測距センサ１４０としては、レーザーレーダー、ミリ波レーダーなど（ＬＲＦ等）を用いることができる。
【００１５】
カメラ１５０は、自車両の周囲の道路や対象物を撮像する。本実施形態において、カメラ１５０は、自車両の前方を撮像する。カメラ１５０により撮像された画像情報は制御装置１８０に送信される。カメラ１５０は、自車両の前方を撮像するカメラ及び／又は自車両の側方を撮像するカメラである。
【００１６】
入力装置１６０は、ドライバーが操作可能な操作部材である。本実施形態において、ドライバーは入力装置１６０を操作することで、自動運転制御のオン／オフを設定することができる。なお、本実施形態に係る車両の自動運転制御では、自車両の前方に先行車が存在する場合には、自車両と先行車との車間距離をドライバーが設定した車間距離に維持して、自車両が先行車を追随するように、自車両を走行させる車間距離制御（先行車追随制御）が行われ、自車両の前方に先行車が存在しない場合には、ドライバーが設定した車速で自車両を走行させる速度制御が行われる。また、本実施形態において、ドライバーは入力装置１６０を操作することで、速度制御における自車両の設定車速（例えば、具体的な速度値）および車間距離制御における設定車間距離（たとえば、短、中、長の三段階）を設定することができる。
【００１７】
駆動機構１７０には、自車両を自動走行させるためのエンジン及び／又はモータ（動力系）、ブレーキ（制動系）およびステアリングアクチュエータ（操舵系）などが含まれる。本実施形態では、後述する自動運転制御が行われる際に、制御装置１８０により、駆動機構１７０の動作が制御される。
【００１８】
制御装置１８０は、プロセッサを有したコンピュータであって、自車両の走行を制御するためのプログラムを格納したＲＯＭ（Read Only Memory）と、このＲＯＭに格納されたプログラムを実行するＣＰＵ（Central Processing Unit）と、アクセス可能な記憶装置として機能するＲＡＭ（Random Access Memory）とから構成される。なお、動作回路としては、ＣＰＵ（Central Processing Unit）に代えて又はこれとともに、ＭＰＵ（Micro Processing Unit）、ＤＳＰ（Digital Signal Processor）、ＡＳＩＣ（Application Specific Integrated Circuit）、ＦＰＧＡ（Field Programmable Gate Array）などを用いることができる。
【００１９】
制御装置１８０は、ＲＯＭに格納されたプログラムをＣＰＵにより実行することにより、自車両の走行経路を生成する自車走行経路生成機能、先行車の走行経路を生成する先行車走行経路生成機能、自車走行経路と先行車走行経路とを統合する統合機能、自車両の走行を制御する走行制御機能（自動追従機能を含む）とを実現する。以下において、制御装置１８０が備える各機能について説明する。なお、制御装置１８０は、以下に説明する機能の他に、例えば自車位置を検出する推定する機能など、他の機能も有している。
【００２０】
制御装置１８０は、自車走行経路生成機能により、自車位置及び地図情報に基づき、自車走行経路を演算する。自車両の走行経路は、自車両の走行軌跡、走路境界、及び/又は走行領域で表される。制御装置１８０は、自車位置検出装置１１０により検出された自車両の位置情報と、地図情報に基づき、地図上における自車両の位置を推定する。制御装置１８０は、推定された自車両の位置を示す点（座標位置）の点列から、自車両の走行軌跡を生成する。なお、制御装置１８０は、カメラ１５０の撮像画像を用いて自車走行経路を演算してもよい。例えば、制御装置１８０は、自車両の側方及び／又は前方の撮像画像から車線を検出する。制御装置１８０は、検出された車線の境界線を走路境界として特定することで、自車走行経路を生成してもよい。
【００２１】
制御装置１８０は、先行車走行経路生成機能により、先行車走行経路を生成する。先行車走行軌跡は、先行車の走行軌跡、走路境界、及び/又は走行領域で表される。御装置１８０は、カメラ１５０の撮像画像及び／又は測距センサ１４０の検出データを用いて、自車両の前方を走行する先行車を検出する。制御装置１８０は、検出された先行車の位置を推定し、推定される位置の点列から、先行車の走行軌跡を生成する。また制御装置１８０は、生成された先行車走行軌跡の形状を特定する。
【００２２】
制御装置１８０は、統合機能により、自車走行経路と先行車走行軌跡とを統合することで、目標走行経路を生成する。目標走行経路は、自車両が、自動運転制御により走行する時の目標となる経路である。目標走行経路は、目標走行軌跡、目標走路境界、目標走行領域で表される。制御装置１８０は、自車走行経路の信頼度と先行車走行経路の信頼度を演算する。自車走行経路の信頼度は、生成された自車走行経路の正確性を示す値である。例えば、自車走行経路の生成に使用した地図情報の精度が低い場合には、地図情報を用いた演算処理により生成された自車走行経路の信頼度は低くなる。自車走行経路の信頼度は、実際の走行経路に対する、演算で求められた走行経路の一致度に相当する。先行車走路経路の信頼度は、生成された先行車走行経路自体の正確性に加えて、自車走行経路に対する先行車走行経路との違いを値で表している。例えば、カメラの精度が低く、先行車の認識精度が低い場合には、カメラの検出データに基づき生成される先行車走行軌跡の演算精度は低くなる。このような精度低下は、先行車走行経路自体の正確性に影響する。また、例えば、自車両が自動運転制御にて先行車を追従して走行している場合に、先行車が車線変更した場合には、先行車の走行経路は自車両の走行経路から外れる。このように経路が相違した場合には、先行車走行軌跡の信頼度は低くなる。制御装置１８０は、先行車走行経路の形状から、自車両走行経路と先行車走行経路との違いを特定する。例えば、自車両が直線状の車線を走行している時に、先行車が右左折又は車線変更等をした場合には、先行車の走行経路は直線形状にはならない。すなわち、制御装置１８０は、先行車走行経路の形状に基づき、先行車走行経路の信頼度を演算する。なお、自車走行経路の信頼度及び先行車走行経路の信頼度の演算方法は後述する。なお、以下の説明において、自車走行経路の信頼度を「第１信頼度」とも称し、先行車走行経路の信頼度を「第２信頼度」とも称する。
【００２３】
制御装置１８０は、第１信頼度及び第２信頼度に基づき、自車走行経路と先行車走行経路とを統合するための統合割合を演算する。統合割合は、目標走行経路の演算にあたって、自車走行経路と先行車走行経路のどちらに重みをつけるかを値で示したものである。統合割合は、自車走行経路と先行車走行経路の重みづけに相当する。そして、制御装置１８０は、演算された統合割合で自車走行経路と先行車走行経路とを統合することで、自車両の目標走行経路を演算する。
【００２４】
制御装置１８０は、走行制御機能により、駆動機構１７０を制御することで、自車両が目標走行経路を走行するように、自車両の走行の全部または一部を自動で行う自動運転制御を実行する。たとえば、本実施形態における走行制御機能は、自車両の前方に先行車が存在する場合には、エンジンやブレーキなどの駆動機構１７０の動作を制御することで、車間距離設定機能により設定された車間距離だけ先行車から離れて自車両を走行させる車間距離制御を実行する。また、制御装置１８０は、自車両の前方に先行車が存在する場合に、エンジン、ブレーキ、ステアリングアクチュエータなどの駆動機構１７０の動作を制御することで、自車両と先行車との車間距離を、車間距離設定機能により設定された車間距離にして、先行車が走行した走行軌跡を自車両が追従走行するように、自車両を走行させる自動追従制御を実行する。さらに、制御装置１８０は、自車両の前方に先行車が存在しない場合には、エンジンやブレーキなどの駆動機構１７０の動作を制御することで、ドライバーが設定した所定の設定速度で自車両を走行させる速度走行制御を実行する。なお、走行制御機能による自動運転制御は、各国の交通法規を遵守した上で実行される。
【００２５】
次に、車両の走行を支援するための制御処理を説明する。図２は、本実施形態の制御処理のフローを示すブロック図である。なお、以下に説明する走行制御処理は、制御装置１８０により実行される。また、以下に説明する走行制御処理は、イグニッションスイッチ又はパワースイッチがオンになった場合に開始し、イグニッションスイッチ又はパワースイッチがオフとなるまで所定の周期で（たとえば１０ミリ秒ごとに）繰り返し実行される。
【００２６】
また以下においては、ドライバーにより自動運転制御が入力（オン）されている場面を例示して説明する。すなわち、ドライバーが入力装置１６０を介して自動運転制御をオンに設定し、これにより、自車両の前方に先行車が存在する場合には、ドライバーが設定した設定車間距離だけ先行車から離れた状態で、自車両を追従する自動追従制御が実行される。
【００２７】
ステップＳ１００にて、制御装置１８０は、自車位置検出装置１１０により検出された自車両の位置情報を取得し、地図データベース１２０から地図情報を取得する。制御装置１８０は、知事情報及び地図情報に基づき、地図上における自車両の位置を推定する。
【００２８】
ステップＳ２００にて、制御装置１８０は、推定された自車両の位置と地図情報に基づき、自車両が現在走行している走行経路を特定することで、自車走路境界を取得する。自車走路境界は、自車両が現在走行している車線の左右の境界線（車線境界線）に相当する。高精度地図が、車線境界線の情報を含む場合には、制御装置１８０は地図データベース１２０から走路境界を取得すればよい。なお、高精度地図が走路境界の情報を含んでいない場合には、制御装置１８０は、カメラ１５０の撮像画像の画像処理により、走路境界を取得してもよい。
【００２９】
ステップＳ３００にて、制御装置１８０は、カメラ１５０の撮像画像の画像処理により、先行車の情報を取得する。また制御装置１８０は、先行車の情報に基づき先行車の位置を推定する。制御装置１８０は、測距センサ１４０の検出データから先行車を取得してもよい。
【００３０】
ステップＳ４００にて、制御装置１８０は、取得された先行車の情報に基づき、先行車の走行軌跡を演算する。ステップＳ５００にて、制御装置１８０は、地図情報及び推定された先行車の位置と地図情報に基づき、先行車が現在走行している走行経路を生成することで、先行車走路境界を取得する。
【００３１】
ステップＳ６００にて、制御装置１８０は、自車走行経路（自車走路境界）の信頼度（第１信頼度）と先行車走行経路（先行車走路境界）の信頼度（第２信頼度）をそれぞれ演算し、演算された信頼度に基づき統合割合を演算し、演算された統合割合で自車走行経路と先行車走路経路とを統合する。なお、以下、ステップＳ６００の制御処理に含まれるフローを説明するにあたって、走行経路に含まれる走路境界を一例として説明するが、走路境界の代わりに例えば車線の中心線を用いてもよい。
【００３２】
ステップＳ６００の制御処理の詳細を、図３を参照して説明する。図３は、ステップＳ６００の制御処理のフローを説明するためのブロック図である。
【００３３】
ステップＳ６１０にて、制御装置１８０は自車両の走路境界に基づき第１信頼度を演算する。ステップＳ６２０にて、制御装置１８０は、先行車の走路境界に基づき第２信頼度を演算する。ステップＳ６３０にて、制御装置１８０は、自車両の走路境界、先行車の走路境界、第１信頼度、及び第２信頼度に基づき、自車走路境界と先行車走路境界を統合する。以下、ステップＳ６１０〜Ｓ６３０の各ステップにおける制御処理を説明する。
【００３４】
図４を参照して、ステップＳ６１０の制御処理を説明する。図４は、ステップＳ６１０の制御処理のフローを説明するためのブロック図である。制御装置１８０は、ステップＳ６１０の制御処理において、高精度地図に対する信頼度を演算している。高精度地図は、自動運転制御を実行するために使用される情報を含んでいる。高精度地図で示される、車線境界線等の地物の位置と、実際の地物の位置が相違している場合があるため、地図上の場所によって、地図の精度が変わる場合がある。制御装置１８０は、以下の制御フローにより、地図単体の信頼度を演算している。
【００３５】
ステップ６１１にて、制御装置１８０は、所定周期内で推定された自車両の位置、及び、自車両の姿勢に基づき、自車位置の分散値を演算する。制御装置１８０は、自車両の位置を周夫定周期で推定している。自車位置検出装置１１０の検出精度が高い場合には、推定された自車位置は、自車両の走行軌跡に沿うように並ぶ。一方、自車位置検出装置１１０の検出精度が低い場合には、推定された自車位置は、走行軌跡に対して広がる。制御装置１８０は、この広がりを、自車位置の分散値として演算している。すなわち、自車位置の分散値が高いほど、自車位置の推定精度は低くなる。また、制御装置１８０は、ヨーレートセンサ１９０の検出データを用いて、自車両の姿勢を検出する。例えば自車両がふらついた場合には、推定される自車位置が分散する。そのため、制御装置１８０は、自車位置検出装置１１０の検出精度と自車位置の分散値との相関性を高めるために、自車両の姿勢に応じて、自車位置の分散値を補正する。
【００３６】
制御装置１８０は、自車位置の分散値と第１信頼度との相関関係を示すマップを参照し、演算された分散値に対応する第１信頼度を演算する。図５は、自車位置の分散値と第１信頼度との関係を示すグラフである。図５に示すように、自車位置の分散度と第１信頼度との間には相関性がある。自車位置の分散値が大きいほど、自車位置の第１信頼度は低くなる。
【００３７】
ステップＳ６１２にて、制御装置１８０は、カメラ１５０等の車載センサの検出値及び地図情報に基づき、地図精度を演算する。制御装置１８０は、地図情報から、自車両の周辺部分の地図形状を特定する。地図形状は、例えば道路形状等から特定される。制御装置１８０は、カメラ１５０の撮像画像から、地図形状に対応する対象物を特定する。制御装置１８０は、撮像画像から、車線、ガードレール、交差点を示す白線などを検出することで、道路形状を特定する。例えば、交差点の内側など、境界が明記されていない箇所では、高精度地図の精度が低くなる。そして、制御装置１８０は、車載センサを用いて道路形状を特定できる場合には、車載センサの検出データから特定される道路形状と地図情報から特定される地図形状との一致度を演算する。そして、制御装置１８０は、一致度が高いほど地図精度を示す値が高くなるように、地図精度を演算する。
【００３８】
制御装置１８０は、地図精度と第１信頼度との相関性を示すマップを参照し、演算された地図精度に対応する第１信頼度を演算する。図６は、地図精度と第１信頼度との関係を示すグラフである。図６に示すように、地図精度と第１信頼度との間には相関性がある。地図精度が低いほど、自車位置の第１信頼度は低くなる。
【００３９】
ステップＳ６１３にて、制御装置１８０は、自車位置の分散値に基づき演算された第１信頼度と、地図精度に基づき演算された第１信頼度のうち、低い方の第１信頼度を選択する（セレクトロー）。
【００４０】
ステップ６１４にて、制御装置１８０は、選択された第１信頼度に対してレートリミッタ処理を実行する。制御装置１８０には、変化量の上限値が予め設定されている。制御装置１８０は、前回周期で演算された第１信頼値と今回周期で演算された第１信頼値との変化量を演算する。制御装置１８０は、演算された変化量と変化量の上限値とを比較する。演算された変化量が上限値以上である場合には、変化量を上限値に制限した値（前回周期で演算された第１信頼度に変化量の上限値を加算した値）を第１信頼度とする。一方、演算された変化量が上限値未満である場合には、制御装置１８０は、ステップＳ６１３の制御処理において選択した第１信頼値を、そのまま出力する。
【００４１】
次に、図７を参照して、ステップＳ６２０の制御処理を説明する。図７は、ステップＳ６２０の制御処理のフローを説明するためのブロック図である。制御装置１８０は、ステップＳ６２０の制御処理において、生成された先行車走路境界自体の信頼度（以下、単体信頼度とも称す）と、自車走路境界と先行車走路境界との比較で演算される信頼度（以下、比較信頼度とも称す）をそれぞれ演算している。そして、制御装置１８０は、単体信頼度と比較信頼度に基づき、第２信頼度を演算している。単体信頼度は、センサ信頼度と軌跡信頼度で表され、比較信頼度は、曲率信頼度と横位置信頼度で表される。なお、単体信頼度はセンサ信頼度と軌跡信頼度のうち少なくとも一方を含んでいればよい、比較信頼度は曲率信頼度と横位置信頼度のうち少なくとも一方を含んでいればよい。以下、具体的な制御フローを説明する。
【００４２】
ステップＳ６２１にて、制御装置１８０は、カメラ等の車載センサの検出データに基づき、センサ信頼度を演算する。センサ信頼度は、センサの検出の安定性に相当する。例えば、外乱の入力により、カメラの撮像画像から先行車を検出できない場合には、センサ信頼度は低くなる。
【００４３】
ステップＳ６２２にて、制御装置１８０は先行車走行軌跡の軌跡信頼度を演算する。軌跡信頼度は、ステップＳ４００及びステップＳ５００の演算処理で演算された先行車走路境界が目標走路境界の演算に適した経路であるか否かを表す評価値であって、先行車走行軌跡の長さで決まる。例えば、先行車がカットインで自車両の前方に進入し、短時間で、自車両の前方から抜け出た場合には、先行車走行軌跡は短くなる。このような場合には、軌跡信頼度は低くなる。制御装置１８０は、先行車走行軌跡の長さが短いほど軌跡信頼度が低くなるように、軌跡信頼度を演算する。
【００４４】
ステップＳ６２３にて、制御装置１８０は、センサ信頼度と軌跡信頼度のうち、低い方の信頼値を選択する。選択された信頼度が単体信頼度となる。
【００４５】
ステップＳ６２４にて、制御装置１８０は、自車走行軌跡の曲率と先行車走行軌跡の曲率との曲率差を演算し、曲率差に基づき曲率信頼度を演算する。曲率信頼度は、自車走行軌跡に対する先行車走行軌跡の違いを曲率で評価した評価値である。先行車と自車両が同一車線を走行している場合には、自車走路境界と先行車走路境界は近い経路になるため、自車走路境界の曲率と先行車走路境界の曲率との差は小さい。一方、先行車と自車両が同一車線を走行している状態から、先行車が車線変更を行った場合には、先行車走路境界は自車走路境界と異なる経路となり、曲率差は大きくなる。制御装置１８０は、曲率差が大きいほど曲率信頼度が低くなるように、曲率信頼度を演算する。自車両が自動追従機能で先行車を追従している状態で、先行車が車線変更した場合には、この車線変更は曲率差に表れる。そして、曲率差が大きい場合には曲率信頼度を低くすることで、自車両の目標経路が、車線変更を行う先行車の走行経路とならないようにしている。
【００４６】
制御装置１８０は、曲率差と曲率信頼度との相関性を示すマップを参照し、演算された曲率差に対応する曲率信頼度を演算する。図８は曲率差と曲率信頼度との相関性を示すグラフである。図８に示すように、曲率差と曲率信頼度との間には相関性がある。曲率差が大きいほど、曲率信頼度は低くなる。また制御装置１８０は、自車両の車速に応じて、マップを参照し、曲率差に対応する曲率信頼度を演算する。
【００４７】
図８のグラフにおいて、実線のグラフは、車速が小さい時の特性を示す。点線のグラフは、車速が大きい時の特定を示す。図８に示すように、曲率差と曲率信頼度との相関関係は、曲率差が同じ場合には、車速が大きいほど曲率信頼度が低くなるような関係となっている。例えば、先行車の車速が大きい状態で、先行車が車線変更を行った場合には、先行車走行軌跡の曲率は小さくなる。一方、先行車の車速が小さい状態で、先行車が車線変更を行った場合には、先行車走行軌跡の曲率は大きくなる。本実施形態では、曲率差と曲率信頼度との相関性を、車速に応じて変化させることで、先行車の車速に合わせて、比較信頼度を適切に演算している。
【００４８】
ステップＳ６２５にて、制御装置１８０は、自車走路境界上における横方向の自車両の位置と、先行車走路境界上における横方向の先行車の位置との偏差を演算する。横方向は、車両の車幅方向である。車両の位置は、走行経路の走路境界上及び／又は走路経路の中心線上であればよい。また車両の位置は、左右の走路境界のうち、一方の走路境界上であればよい。先行車と自車両が同一車線を走行している場合には、自車走路境界と先行車走路境界は近い経路になるため、横方向の位置の偏差は小さい。一方、先行車と自車両が同一車線を走行している状態から、先行車が車線変更を行った場合には、先行車走路境界は自車走路境界とは異なる経路となり、横方向の位置の偏差は大きくなる。制御装置１８０は、横方向の偏差が大きいほど横位置信頼度を低くする。横位置信頼度は、自車走路境界に対する先行車走路境界の違いを、横方向の位置で評価した評価値である。
【００４９】
制御装置１８０は、横方向の位置の偏差が大きいほど、横位置信頼度が低くなるように、横方向信頼度を演算する。自車両が自動追従機能で先行車を追従している状態で、先行車が車線変更した場合には、この車線変更は横方向の位置の偏差に表れる。そして、横方向の位置の偏差が大きい場合には横位置信頼度を低くすることで、自車両の目標経路が、車線変更を行う先行車の走行軌跡とならないようにしている。
【００５０】
制御装置１８０は、横方向の位置の偏差（以下、横位置偏差とも称する）と横位置信頼度との相関性を示すマップを参照し、演算された横位置偏差に対応する横位置信頼度を演算する。図９は横位置偏差と横位置信頼度との相関性を示すグラフである。図９に示すように、横位置偏差と横位置信頼度との間には相関性がある。横位置偏差が大きいほど、横位置信頼度は低くなる。また制御装置１８０は、自車両の車速に応じて、マップを参照し、横位置偏差に対応する横位置信頼度を演算する。
【００５１】
図９のグラフにおいて、実線のグラフは、車速が小さい時の特性を示す。点線のグラフは、車速が大きい時の特定を示す。図８に示すように、横位置偏差と横位置信頼度との相関関係は、横位置偏差が同じ場合には、車速が大きいほど横位置信頼度が低くなるような関係となっている。例えば、先行車の車速が大きい状態で、先行車が車線変更を行った場合には、先行車走行軌跡の横方向の変化量は小さくなる。一方、先行車の車速が小さい状態で、先行車が車線変更を行った場合には、先行車走行軌跡の横方向の変化量が大きくなる。本実施形態では、横位置偏差と横位置信頼度との相関性を、車速に応じて変化させることで、先行車の車速に合わせて、比較信頼度を適切に演算している。
【００５２】
ステップＳ６２６にて、制御装置１８０は、曲率信頼度と横位置信頼度のうち、低い方の信頼度を選択する。選択された信頼度が比較信頼度となる。
【００５３】
ステップＳ６２７にて、制御装置１８０は、単体信頼度と比較信頼度のうち、低い方の信頼度を選択する。選択された信頼度が第２信頼度となる。
【００５４】
ステップＳ６２８にて、制御装置１８０は、選択された第２信頼度に対してレートリミッタ処理を実行する。制御装置１８０には、変化量の上限値が予め設定されている。制御装置１８０は、前回周期で演算された第２信頼値と今回周期で演算された第２信頼値との変化量を演算する。制御装置１８０は、演算された変化量と変化量の上限値とを比較する。演算された変化量が上限値以上である場合には、変化量を上限値に制限した値（前回周期で演算さえた第２信頼度に変化量の上限値を加算した値）を第２信頼度とする。一方、演算された変化量が上限値未満である場合には、制御装置１８０は、ステップＳ６２７の制御処理において選択した第２信頼値を、そのまま出力する。
【００５５】
制御装置１８０は、上記の制御フローを実行することで、ステップＳ６００の制御処理を実行した後に、図２に示すステップＳ７００の制御処理を実行する。
【００５６】
ステップＳ７００にて、制御装置１８０は、第１信頼度及び第２信頼度に基づき目標走行経路を生成する。図１０を用いて、目標走行経路の制御処理について説明する。
【００５７】
制御装置１８０は、第１信頼度と第２信頼度に基づき統合割合を演算する。統合割合は、第１信頼度と第２信頼度とを加えた全体信頼度に対する第１信頼度の比率と、全体信頼度に対する第２信頼度の比率で表される。制御装置１８０は、自車走路境界の横方向座標と先行車走路境界の横方向の座標を、対応する統合割合で補正して、統合後の走路境界を算出する。
【００５８】
制御装置１８０は、下記式（１）を用いて、統合後の走路境界の横方向の座標を演算する。図１０に示すように、自車両の進行方向をｘ軸とし、車幅方向をｙ軸とする。ｙｉ、ｊは、統合後の走路境界上のｙ座標を示し、ｙａ＿ｉ、ｊは自車走路境界上のｙ座標を示し、ｙｂ＿ｉ、ｊは先行車走路境界上のｙ座標を示す。Ｒａ＿ｉ、ｊは第１信頼度を示し、Ｒｂ＿ｉ、ｊは第２信頼度を示す。ｉは検出順序を示し、ｊは左右を示す。なお、第１信頼度及び第２信頼度は、０から１の間で正規化されている。
【数１】
0006962469.tif 000002
【００５９】
上記式において、ｙ座標（ｙａ＿ｉ、ｊ）及びｙ座標（ｙｂ＿ｉ、ｊ）に乗算される係数が統合割合に相当する。例えば、第１信頼度と第２信頼度が共に０．５である場合には、統合後の走路境界のｙ座標は、自車走路境界のｙ座標と先行車走路境界のｙ座標との間の中点になる。また、第１信頼度と第２信頼度とを比較し、第１信頼度が第２信頼度より高い場合には、統合後の走路境界のｙ座標は、先行車走路境界のｙ座標よりも、自車走路境界のｙ座標に近くなる。
【００６０】
図１０の例では、検出順序（ｉ＝１）から検出順序（ｉ＝７）までは、第１信頼度と第２信頼度は共に０．５である。そして、検出順序（ｉ＝８）以降、第２信頼度がゼロになる。式（１）により演算された統合後の走路境界のｙ座標（ｙｉ、ｊ）は、検出順序（ｉ＝１）から検出順序（ｉ＝７）までは、自車走路境界のｙ座標（ｙａ＿ｉ、ｊ）と先行車走路境界のｙ座標（ｙｂ＿ｉ、ｊ）ｙ座標（ｙｂ＿ｉ、ｊ）との中点となる。検出順序（ｉ＝８）以降、統合後の走路境界のｙ座標（ｙｉ、ｊ）は自車走路境界のｙ座標（ｙａ＿ｉ、ｊ）と一致する。
【００６１】
また、制御装置１８０は、第２信頼度よりも第１信頼度に重みがつくように、統合割合を演算してもよい。図１１及び図１２を参照しつつ、統合割合の演算処理における重み付けと、自車走路境界、先行車走路境界、及び統合後走路境界の関係について説明する。
【００６２】
第１信頼度及び第２信頼度に対して、上方信頼度閾値及び下方信頼度閾値がそれぞれ設定されている。上方信頼度閾値は下方信頼度閾値より高い値に設定されている。図１１において、第１信頼度が上方信頼度閾値より高い状態を「高」として、第１信頼度が上方信頼度以下で下方信頼度以上である状態を「中」とし、第１信頼度が下方信頼度より低い状態を「低」としている。第２信頼度の「高」、「中」、「小」も同様である。なお、図１１の（ａ）〜（ｃ）は、図１２の（ａ）〜（ｃ）と対応している。
【００６３】
図１１に示すように、第１信頼度が「高」の状態で、第２信頼度が「高」の状態である場合には、統合割合は、自車走路境界の活用割合を１００％として、先行車走路境界の活用割合を０％にする。第１信頼度が「高」の状態で、第２信頼度が「低」の状態である場合には、統合割合は、自車走路境界の活用割合を１００％として、先行車走路境界の活用割合を０％にする。すなわち、第１信頼度が上方信頼度閾値より高く、第２信頼度が下方信頼度閾値より高い場合には、制御装置１８０は、第２信頼度より第１信頼度の割合が大きくなるように、統合割合を演算する。
【００６４】
第１信頼度が「高」の状態で、第２信頼度が「高」の状態である場合の走路境界は、図１２（ａ）に示される。図１２（ａ）に示すように、統合後の走路境界は、自車走路境界と一致する。自車走行経路の信頼度が高い場合には、先行車走行経路の信頼度の大きさに関わらず、自車走路経路の活用割合を大きくする。これにより、自車両が、先行車の車線内におけるふらつきや、定常的な位置偏差に追従することなく、自車両の車線内を安定して走行できる。
【００６５】
図１１に示すように、第１信頼度が「中」の状態で、第２信頼度が「高」の状態である場合には、統合割合は、自車走路境界の活用割合を５０％として、先行車走路境界の活用割合を５０％にする。第１信頼度が「中」の状態で、第２信頼度が「低」の状態である場合には、統合割合は、自車走路境界の活用割合を１００％として、先行車走路境界の活用割合を０％にする。すなわち、第１信頼度が下方信頼度閾値以上である場合には、制御装置１８０は、第１信頼度を含むように統合割合を演算する。
【００６６】
第１信頼度が「高」の状態で、第２信頼度が「中」の状態である場合の走路境界は、図１２（ｂ）に示される。図１２（ｂ）に示すように、統合後の走路境界は、自車走路境界の位置に対して、先行車走路境界側に少しずれる。すなわち、第１信頼度が下方信頼度閾値以上である場合には、自車走行経路を活用することで、自車両の車線内を安定して走行できる。
【００６７】
図１１に示すように、第１信頼度が「低」の状態で、第２信頼度が「高」の状態である場合には、統合割合は、自車走路境界の活用割合を０％として、先行車走路境界の活用割合を１００％にする。第１信頼度が「低」の状態で、第２信頼度が「低」の状態である場合には、統合割合は、自車走路境界の活用割合を０％として、先行車走路境界の活用割合を０％にする。すなわち、第１信頼度が下方信頼度閾値未満であり、第２信頼度が上方信頼度以上である場合には、制御装置１８０は、第１信頼度より第２信頼度の割合が大きくなるように、統合割合を演算する。
【００６８】
第１信頼度が「低」の状態で、第２信頼度が「高」の状態である場合の走路境界は、図１２（ｃ）に示される。図１２（ｃ）に示すように、統合後の走路境界は、先行車走路境界と一致する。自車走行経路の信頼度が低い場合には、先行車走行経路の信頼度が高いときに、先行車走路経路の活用割合を大きくする。これにより、自車両が車線内を安定して走行できる。
【００６９】
そして、ステップＳ７００にて、制御装置１８０は、地図情報と統合後の走路境界に基づき目標走路境界を演算することで、目標走行経路を生成する。
【００７０】
ステップＳ８００にて、制御装置１８０は、自車両が目標走行経路上を走行するように、駆動機構１７０の動作を制御する。
【００７１】
上記のように本実施形態では、推定された自車両の位置及び地図情報に基づき自車走行経路を生成し、自車走行経路の信頼度を示す第１信頼度を演算し、先行車を検出し、先行車走行経路を生成し、先行車走行経路の形状に基づき先行車走行経路の信頼度を示す第２信頼度を演算する。そして、第１信頼度と第２信頼度に基づき、自車走行経路と先行車走行経路とを統合するための統合割合を演算し、統合割合で自車走行経路と先行車走行経路とを統合することで、自車両の目標走行経路を演算し、目標走行経路に基づいて自車両を制御する。これにより、例えば、先行車の検出精度が低い場合、又は、先行車の走行経路の走行経路と異なる場合に、自車両が先行車の軌跡に対して追従して、自車両がふらついてしまうことを抑制できる。
【００７２】
また本実施形態では、自車両の位置の推定精度が低いほど、第１信頼度を低くする。位置の推定精度が低下した場合には、自車両の横方向の位置、又は、自車両の姿勢角に定常的な偏差が発生するおそれがある。本実施形態では、自車両の位置の推定精度が低い場合には第１信頼度を低くするために、定常的な偏差を抑制でき、自車両のふらつきを防止できる。
【００７３】
また本実施形態では、地図情報で表される地図の地図精度が低いほど第１信頼度を低くする。例えば、白線や縁石等により走路境界が決まらない場所（例：交差点内）、又は、道路工事等により地図と実際の形状が違う可能性がある場所では、地図精度が低くなる。本実施形態では、地図精度の低下により発生する、自車両のふらつきを抑制できる。
【００７４】
また本実施形態では、自車両の位置の推定精度、及び、地図精度をそれぞれ演算し、検出精度と地図精度のうち、いずれか低い方の精度に基づき第１信頼度を演算する。これにより、自車位置の推定精度及び地図精度のいずれか一方が低下した場合に、自車両がふらつくことを抑制できる。
【００７５】
また本実施形態では、センサにより検出される先行車の検出データを用いて、先行車走行経路の単体信頼度を演算し、自車走行経路と先行車走行経路とを比較して比較信頼度を演算し、単体信頼度と比較信頼度に基づき第２信頼度を演算する。これにより、先行車の検出状態と走行経路の形状の両方を、第２信頼度の演算に用いることで、先行車の検出精度が低い場合や、自車両の走行経路と先行車の走行経路が異なる場合に、自車両が先行車を追従して自車両がふらつくことを防止できる。
【００７６】
また本実施形態では、センサの検出の安定性を評価することでセンサ信頼度を演算し、センサの検出データを用いて、先行車走行経路に含まれる先行車走行軌跡を生成し、先行車走行軌跡の長さで決まる軌跡信頼度を演算し、センサ信頼度及び軌跡信頼度に基づき、単体信頼度を演算する。先行車の検出精度が低い場合には、先行車の走行軌跡が乱れることが多いが、本実施形態では、軌跡信頼度に基づき、第２信頼度を演算するため、自車両が先行車の走行軌跡に追従することで、自車がふらつくことを防止できる。
【００７７】
また本実施形態では、先行車走行軌跡の長さが短いほど、軌跡信頼度を低くする。これにより、先行車軌跡が短く、先行車の進路を正しく認識できない場合に、自車両が先行車の進路変更に追従して自車がふらついてしまうことを防止できる。
【００７８】
また本実施形態では、センサ信頼度と軌跡信頼度のうち、いずれか低い方の信頼度に基づき単体信頼度を演算する。これにより、先行車の検出精度が低い状態、又は、先行車の走行軌跡が短い状態のうち、いずれか一方の状態のときに、自車両がふらつくことを防止できる。
【００７９】
また本実施形態では、自車走行経路の曲率と先行車走行経路の曲率との曲率差を演算し、曲率差が大きいほど比較信頼度を低くする。これにより、先行車が車線変更した場合（特に、低速の先行車が車線変更した場合）に、自車両が先行車に追随して自車両がふらつくことを防止できる。
【００８０】
また本実施形態では、曲率差が同じ場合に、自車両の車速が大きいほど比較信頼度が低くなる相関関係を用いて、自車両の車速及び曲率差に基づき、比較信頼度を演算する。これにより、車速に応じて、先行車走行経路の信頼度の演算基準を変えることができる。その結果として先行車の進路変更を、先行車の車速の大きさに応じて適切に判別でき、自車両が先行車に追従して自車両がふらつくことを防止できる。
【００８１】
また本実施形態では、自車走行経路上における横方向の前記自車両の位置と、先行車走行経路上における横方向の先行車の位置との偏差を演算し、偏差が大きいほど比較信頼度を低くする。これにより、先行車走行経路と自車両走行経路の横方向の位置偏差が大きい場合には、自車両が先行車に追従して自車両がふらつくことを防止できる。
【００８２】
また本実施形態では、自車走行経路の曲率と先行車走行経路の曲率との曲率差を演算し、曲率差と先行車走行経路の信頼度との相関性に基づき曲率信頼度を演算し、自車走行経路上における横方向の自車両の位置と、先行車走行経路上における横方向の先行車の位置との偏差を演算し、偏差と先行車走行経路の信頼度との相関性に基づき横方向信頼度を演算し、曲率信頼度及び横方向信頼度のうち、いずれか低い方の信頼度に基づき第２信頼度を演算する。これにより、全車速域で先行車の走行経路の変更を認識でき、自車両が先行車に追従して自車がふらつくことを防止できる。
【００８３】
また本実施形態では、単体信頼度及び比較信頼度のうち、いずれか低い方の信頼度に基づき第２信頼度を演算する。これにより、先行車の検出精度の低下及び先行車の走行経路の変更のいずれか一方が発生した場合に、自車がふらつくことを防止できる。
【００８４】
また本実施形態では、自車走行経路上における横方向の自車両の座標と、先行車走行経路上における横方向の先行車の座標をそれぞれ推定し、統合割合で自車両の座標及び先行車の座標を統合させることで目標走行経路を演算する。目標走行経路を、自車走行経路と先行車走行経路の選択で切り替えた場合には、自車両の挙動が急変する可能性がある。本実施形態では、
目標走行経路が連続的に変わるため、自車両の挙動が急変することを防止できる。
【００８５】
また本実施形態では、第１信頼度及び第２信頼度が所定の信頼度閾値より高い場合には、先行車走行経路より自車走行経路の割合が大きくなるように目標走行経路を演算する。これにより、先行車走行経路の信頼度が高かったとしても、自車線走行経路の信頼度が高ければ、自車線走行経路の活用割合を多くすることで、自車両が先行車の車線内におけるふらつきや定常偏差に追従することなく、自車線内を安定して走行できる。
【００８６】
また本実施形態では、第１信頼度が所定の信頼度閾値より高く、第２信頼度が所定の信頼度より低い場合には、先行車走行経路より自車走行経路の割合が大きくなるように目標走行経路を演算する。これにより、先行車走行経路の信頼度が低いときに、自車走行経路の信頼度が高ければ、自車線走行経路を活用することで、自車線内を安定して走行できる。
【００８７】
また本実施形態では、第１信頼度が所定の信頼度閾値より低く、第２信頼度が所定の信頼度閾値より高い場合には、自車走行経路より先行車走行経路の割合が大きくなるように目標走行経路を演算する。これにより、先行車走行経路の信頼度が高いときに、自車走行経路の信頼度が低ければ、先行車走行経路を活用することで、自車線内を安定して走行できる。
【００８８】
なお本実施形態では、第１信頼度を演算する際には、自車位置の分散値、地図精度など、異なる要素に基づき信頼度を演算した上で、演算された値に対してセレクトローをとることで、第１信頼度を演算したが、必ずしもセレクトローをとる必要はない。例えば、異なる要素で演算された各種信頼度の平均値を第１信頼度として演算してもよい。第２信頼度についても、同様に、異なる要素で演算された各種信頼度のセレクトローをとる必要はなく、平均値としてもよい。
【００８９】
また、異なる要素で演算された各種信頼度の中から、全ての信頼度又は一部の信頼度を抽出し、抽出された信頼度に基づき統合割合を演算してもよい。例えば、抽出された信頼度の合計に対して、各信頼度の比率をそれぞれ演算することで、統合割合を演算してもよい。
【００９０】
尚、目標走路境界または目標走行領域を設定した後に、自車両の目標走行軌跡を算出するように、段階的に車両を走行させるための制御に用いる走行軌跡を算出するようにしてもよい。これにより、先行車の情報を用いて、自車両が走行することができる領域を算出した後に、自車両の走行軌跡を算出することができるため、先行車に追従してふらつくことを抑制しつつ、自車両の走路境界、走行領域の中で、走行環境に合った適切な走行軌跡を算出することができるようになる。
【００９１】
例えば、制御装置１８０は、先行車走行経路生成機能により、先行車走行経路を生成する。そして、制御装置１８０は、生成された先行車走行経路に沿う経路を、自車両の目標走行経路として設定し、設定された目標走行経路から、目標走路境界又は目標走行領域を演算する。制御装置１８０は、演算された目標走路境界又は目標走行領域に基づいて目標走行軌跡を演算し、演算された目標走行軌跡に沿うよう自車両を制御する。これにより、走路境界又は走行領域の中で、実際の道路環境に沿った目標走行軌跡を算出することができるようになる。具体的には、走路境界又は走行領域の中で任意に軌跡を引けるようになるため、先行車によるふらつきを抑制しつつ、例えば、乗員へ与える違和感を抑制するような走行軌跡を算出することができるようになる。
【００９２】
なお、本実施形態では、先行車走行経路を演算する際に、カメラなどの車載センサの検出データを用いたが、例えば、車車間通信や路車間通信を用いて、先行車の情報を取得し、取得された情報に基づき、先行車走行経を演算してもよい。また自車走行経路も同様に、車車間通信や路車間通信を用いて取得したデータに基づいて演算してもよい。
【００９３】
なお、先行車は自車両のすぐ前の車両に限らず、自車両から２台以上先の先行車でもよい。なお、２台以上先の先行車の情報が車載センサで取得できない場合には、車車間通信や路車間通信を用いて、必要なデータを取得すればよい。
【符号の説明】
【００９４】
１００…走行支援装置
１１０…自車位置検出装置
１２０…地図データベース
１３０…車速センサ
１４０…測距センサ
１５０…カメラ
１６０…入力装置
１７０…駆動機構
１８０…制御装置
１９０…ヨーレートセンサ
【図１】
0006962469.tif 000003
【図２】
0006962469.tif 000004
【図３】
0006962469.tif 000005
【図４】
0006962469.tif 000006
【図５】
0006962469.tif 000007
【図６】
0006962469.tif 000008
【図７】
0006962469.tif 000009
【図８】
0006962469.tif 000010
【図９】
0006962469.tif 000011
【図１０】
0006962469.tif 000012
【図１１】
0006962469.tif 000013
【図１２】
0006962469.tif 000014