(57)【要約】【課題】ドライバに合ったモデルパラメータを学習することができるようにする。【解決手段】情報取得部２６が、車両の走行状態を示すセンサ情報を取得する。そして、パラメータ学習部３６が、センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、情報取得部２６によって取得された車両のセンサ情報とに基づいて、運転行動モデルの条件分岐で用いられる条件パラメータを含むモデルパラメータを学習する。【選択図】図１
2015170126.tif 000002
【特許請求の範囲】
【請求項１】
車両の走行状態を示すセンサ情報を取得する取得手段と、
前記センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、前記取得手段によって取得された前記車両のセンサ情報とに基づいて、前記運転行動モデルの前記条件分岐で用いられる条件パラメータを含むモデルパラメータを学習するパラメータ学習手段と、
を含むパラメータ学習装置。
【請求項２】
前記近似モデルは、前記運転行動モデルをシグモイド関数によって連続かつ微分可能な関数で近似した近似モデルである請求項１記載のパラメータ学習装置。
【請求項３】
前記取得手段は、前記車両の位置情報を含むセンサ情報を取得し、
前記パラメータ学習手段は、拡張カルマンフィルタを用いて、前記取得手段によって取得した前記車両の位置情報を観測値として、前記モデルパラメータを学習する請求項１又は２記載のパラメータ学習装置。
【請求項４】
前記取得手段は、前記車両が走行する走路における定常走行速度と、前記車両が走行する走路の曲率と、前記車両の前方を走行する車両との距離を示す前方車両情報とを含むセンサ情報を取得し、
前記運転行動モデルは、前記車両の走路上の目標位置を決定し、前記定常走行速度を、定常走行に関する速度制約条件を満たす上限速度として算出し、前記走路の曲率に基づいて、カーブ走行に関する速度制約条件を満たす上限速度を算出し、前記前方車両情報に基づいて、前方車両追従に関する速度制約条件を満たす上限速度を算出し、前記決定された走路上の目標位置に基づいて、前後位置制御に関する速度制約条件を満たす上限速度を算出し、前記算出された上限速度のうちの何れかを目標速度として選択するようにモデル化された請求項１〜請求項３の何れか１項記載のパラメータ学習装置。
【請求項５】
前記取得手段は、前記車両の走路上の信号情報と、前記車両の目的地とを含むセンサ情報を取得し、
前記運転行動モデルは、前記信号情報に基づいて、信号停止に関する位置制約条件を満たす車両位置を算出し、前記車両の目的地に基づいて求められた経路情報に基づいて、経路に関する位置制約条件を満たす車両位置を算出し、前記算出された車両位置のうちの何れかを選択し、選択した位置を目標位置として決定するようにモデル化された請求項１〜請求項４の何れか１項記載のパラメータ学習装置。
【請求項６】
請求項１〜請求項５の何れか１項記載のパラメータ学習装置と、
前記パラメータ学習装置によって学習された前記モデルパラメータと、前記運転行動モデルと、前記取得手段によって取得された前記センサ情報とに基づいて、前記車両のドライバの運転支援を行う運転支援手段と、
を含む運転支援装置。
【請求項７】
コンピュータを、
車両の走行状態を示すセンサ情報を取得する取得手段、及び
前記センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、前記取得手段によって取得された前記車両のセンサ情報とに基づいて、前記運転行動モデルの前記条件分岐で用いられる条件パラメータを含むモデルパラメータを学習するパラメータ学習手段
として機能させるためのプログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、パラメータ学習装置、運転支援装置、及びプログラムに係り、特に、ドライバの運転行動モデルのモデルパラメータを学習するパラメータ学習装置、運転支援装置、及びプログラムに関する。
【背景技術】
【０００２】
従来より、車両の挙動を表す挙動データ及びドライバの操作を表す操作データからなる検出データを取得する検出データ取得手段と、様々な運転環境にて取得された前記検出データをクラスタリングすることで予め生成され、それぞれが異なった運転環境に対応する複数のクラスタからなるクラスタ分布を使用し、前記検出データ取得手段にて逐次取得される検出データを前記クラスタ分布と照合することによって、車両の運転環境を判定する環境判定手段と、前記環境判定手段での判定結果の種類毎に用意され、ドライバの運転傾向をモデル化した推定モデルを記憶するモデル記憶手段と、前記検出データ取得手段にて取得された検出データに基づいて前記推定モデルを学習する学習手段と、前記運転環境判定装置での判定結果に従って選択した推定モデルを用い、前記検出データに基づいてドライバの運転状況を推定する推定手段と、を備え、前記検出データには、自車速及び先行車との車間距離が少なくとも含まれ、前記学習手段は、前記自車速と前記車間距離に関わる車間パラメータとの関係に基づいて、前記自車速から前記車間パラメータの目標値を推定するための推定モデルを生成し、前記推定手段は、前記自車速と前記推定モデルとによって設定された目標値と前記車間パラメータの実測値との差から前記運転状況を推定し、前記車間パラメータが、車間距離の逆数、もしくは衝突余裕時間の逆数のうち少なくとも一方を含むことを特徴とする運転状況推定装置が知られている（例えば、特許文献１）。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２０１３−１７８８２７号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
しかしながら、上記の特許文献１に記載の技術では、モデルにおける切り替え部（運転環境判定部）の切り替え条件は、実測データから逐次的に学習することはできないため、市場においては、個々のドライバに合わせて切り替え条件を学習することができない。
【０００５】
本発明は、上記の事情に鑑みてなされたもので、ドライバに合ったモデルパラメータを学習することができる車両挙動予測装置及びプログラムを提供することを目的とする。
【課題を解決するための手段】
【０００６】
上記の目的を達成するために本発明に係るパラメータ学習装置は、車両の走行状態を示すセンサ情報を取得する取得手段と、前記センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、前記取得手段によって取得された前記車両のセンサ情報とに基づいて、前記運転行動モデルの前記条件分岐で用いられる条件パラメータを含むモデルパラメータを学習するパラメータ学習手段と、を含んで構成されている。
【０００７】
本発明に係るプログラムは、コンピュータを、車両の走行状態を示すセンサ情報を取得する取得手段、及び前記センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、前記取得手段によって取得された前記車両のセンサ情報とに基づいて、前記運転行動モデルの前記条件分岐で用いられる条件パラメータを含むモデルパラメータを学習するパラメータ学習手段として機能させるためのプログラムである。
【０００８】
本発明によれば、取得手段によって、車両の走行状態を示すセンサ情報を取得する。
【０００９】
そして、パラメータ学習手段によって、センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、取得手段によって取得された車両のセンサ情報とに基づいて、運転行動モデルの条件分岐で用いられる条件パラメータを含むモデルパラメータを学習する。
【００１０】
このように、センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、取得された車両のセンサ情報とに基づいて、運転行動モデルの条件分岐で用いられる条件パラメータを含むモデルパラメータを学習することにより、ドライバに合ったモデルパラメータを学習することができる。
【００１１】
本発明に係る、前記近似モデルは、前記運転行動モデルをシグモイド関数によって連続かつ微分可能な関数で近似した近似モデルであるようにすることができる。
【００１２】
また、前記取得手段は、前記車両の位置情報を含むセンサ情報を取得し、前記パラメータ学習手段は、拡張カルマンフィルタを用いて、前記取得手段によって取得した前記車両の位置情報を観測値として、前記モデルパラメータを学習するようにすることができる。
【００１３】
また、前記取得手段は、前記車両が走行する走路における定常走行速度と、前記車両が走行する走路の曲率と、前記車両の前方を走行する車両との距離を示す前方車両情報とを含むセンサ情報を取得し、前記運転行動モデルは、前記車両の走路上の目標位置を決定し、前記定常走行速度を、定常走行に関する速度制約条件を満たす上限速度として算出し、前記走路の曲率に基づいて、カーブ走行に関する速度制約条件を満たす上限速度を算出し、前記前方車両情報に基づいて、前方車両追従に関する速度制約条件を満たす上限速度を算出し、前記決定された走路上の目標位置に基づいて、前後位置制御に関する速度制約条件を満たす上限速度を算出し、前記算出された上限速度のうちの何れかを目標速度として選択するようにモデル化されたようにすることができる。
【００１４】
また、前記取得手段は、前記車両の走路上の信号情報と、前記車両の目的地とを含むセンサ情報を取得し、前記運転行動モデルは、前記信号情報に基づいて、信号停止に関する位置制約条件を満たす車両位置を算出し、前記車両の目的地に基づいて求められた経路情報に基づいて、経路に関する位置制約条件を満たす車両位置を算出し、前記算出された車両位置のうちの何れかを選択し、選択した位置を目標位置として決定するようにモデル化されたようにすることができる。
【００１５】
本発明に係る運転支援装置は、上記のパラメータ学習装置と、パラメータ学習装置によって学習された前記モデルパラメータと、前記運転行動モデルと、前記取得手段によって取得された前記センサ情報とに基づいて、前記車両のドライバの運転支援を行う運転支援手段と、を含んで構成されている。
【００１６】
また、本発明のプログラムは、記憶媒体に格納して提供することも可能である。
【発明の効果】
【００１７】
以上説明したように、本発明のパラメータ学習装置及びプログラムによれば、センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、取得された車両のセンサ情報とに基づいて、運転行動モデルの条件分岐で用いられる条件パラメータを含むモデルパラメータを学習することにより、ドライバに合ったモデルパラメータを学習することができる、という効果が得られる。
また、本発明の運転支援装置及びプログラムによれば、運転特性パラメータ学習装置によって学習されたモデルパラメータと、運転行動モデルと、取得されたセンサ情報とに基づいて、車両のドライバの運転支援を行うことにより、ドライバに合った運転支援を行うことができる、という効果が得られる。
【図面の簡単な説明】
【００１８】
【図１】本発明の第１の実施の形態に係る運転支援装置を示すブロック図である。
【図２】本発明の第１の実施の形態に係る運転支援装置における予測処理の概念を示す概念図である。
【図３】本発明の第１の実施の形態に係る運転支援装置におけるフィルタリング処理の概念を示す概念図である。
【図４】本発明の第１の実施の形態に係るパラメータ学習部３６の詳細を示すブロック図である。
【図５】本発明の第１の実施の形態に係る運転支援装置における運転支援処理ルーチンの内容を示すフローチャートである。
【図６】本発明の第１の実施の形態に係る運転支援装置における目標速度計算処理ルーチンの内容を示すフローチャートである。
【図７】本発明の第１の実施の形態に係る運転支援装置におけるパラメータ学習処理ルーチンの内容を示すフローチャートである。
【図８】本発明の第１の実施の形態に係る運転支援装置における予測処理ルーチンの内容を示すフローチャートである。
【図９】本発明の第１の実施の形態に係る運転支援装置におけるフィルタリング処理ルーチンの内容を示すフローチャートである。
【図１０】本発明の第２の実施の形態に係る状態空間モデルを示す図である。
【図１１】本発明の第２の実施の形態に係る運転支援装置を示すブロック図である。
【図１２】本発明の第２の実施の形態に係る目標運転操作量計算部２３０の詳細を示すブロック図である。
【図１３】本発明の第２の実施の形態に係る運転行動モデル計算部２５０の詳細を示すブロック図である。
【図１４】本発明の第２の実施の形態に係る車両物理モデル計算部３５０の詳細を示すブロック図である。
【図１５】本発明の第２の実施の形態に係るパラメータ学習部２３６の詳細を示すブロック図である。
【図１６】本発明の第２の実施の形態に係る予測部２３６０の詳細を示すブロック図である。
【図１７】本発明の第２の実施の形態に係る近似運転行動モデル計算部２４００の詳細を示すブロック図である。
【図１８】本発明の第２の実施の形態に係る車両物理モデル計算部２５００の詳細を示すブロック図である。
【図１９】本発明の第２の実施の形態に係る運転支援装置における運転支援処理ルーチンの内容を示すフローチャートである。
【図２０】本発明の第２の実施の形態に係る運転支援装置における目標運転操作量計算処理ルーチンの内容を示すフローチャートである。
【図２１】本発明の第２の実施の形態に係る運転支援装置におけるパラメータ学習処理ルーチンの内容を示すフローチャートである。
【図２２】本発明の第２の実施の形態に係る運転支援装置における予測処理ルーチンの内容を示すフローチャートである。
【発明を実施するための形態】
【００１９】
以下、図面を参照して、本発明の実施の形態について説明する。本実施の形態では、運転行動モデルのモデルパラメータを学習すると共に、運転行動モデル用いて車両のドライバの運転支援を行う運転支援装置に、本発明を適用した場合を例に説明する。なお、本実施の形態では、複数の運転行動を切り替えるためのパラメータを学習するアルゴリズムとして、拡張カルマンフィルタを用いた場合を例に説明する。
【００２０】
＜第１の実施の形態＞
図１に示すように、第１の実施の形態に係る運転支援装置１０は、自車両の車速を検出する車速センサ１２と、自車両の位置を計測する位置計測部１４と、自車両の前方を走行する前方車両を検出する前方車情報取得部１６と、地図情報（道路ネットワークデータ）、道路情報、及び信号情報を記憶した道路ネットワークデータベース１８と、道路ネットワークデータベース１８から取得した信号情報に基づいて、次の信号の状態Ｓを取得する信号状態取得部２０と、次の信号機の停止線の位置を取得し、当該停止線の位置に基づいて停止減速度Ｄを算出する停止減速度取得部２２と、運転支援アクチュエータ４０を制御するコンピュータ２４と、運転支援を行うための運転支援アクチュエータ４０とを備えている。
【００２１】
位置計測部１４は、例えば、ＧＰＳセンサを用いて構成され、自車両の現時刻ｔの前後位置情報ｘ＊ｔを計測する。
【００２２】
前方車情報取得部１６は、例えばレーザレーダ装置が該当し、自車両に対する前方車両までの走行方向の相対距離ｘｆを計測し、相対距離ｘｆと前方車両との相対速度とを前方車両情報として各時刻ｔについて取得する。なお、相対速度は、相対距離を時間微分することにより得られる。
【００２３】
道路ネットワークデータベース１８には、地図情報、道路情報、及び信号情報が記憶されている。地図情報及び道路情報には、信号機の位置と当該信号機に対する停止線の位置を示すデータが含まれている。信号情報には、信号機の位置と当該信号機の信号変化の周期を示すデータが含まれている。
【００２４】
信号状態取得部２０は、道路ネットワークデータベース１８から取得した信号情報に基づいて、時刻ｔにおける次の信号の状態Ｓを取得する。
【００２５】
停止減速度取得部２２は、道路ネットワークデータベース１８から取得した地図情報及び道路情報と、信号状態取得部２０によって取得された時刻ｔにおける次の信号の状態Ｓとに基づいて、次の信号の状態Ｓが青でない場合には、次の信号機の停止線の位置を取得し、当該停止線の位置に基づいて、停止減速度Ｄを算出する。
【００２６】
コンピュータ２４は、ＣＰＵと、ＲＡＭと、後述する運転支援処理ルーチン、目標速度計算処理ルーチン、パラメータ学習処理ルーチン、予測処理ルーチン、及びフィルタリング処理ルーチンを実行するためのプログラムを記憶したＲＯＭとを備え、機能的には次に示すように構成されている。コンピュータ２４は、車両の走行状態を示すセンサ情報を各時刻ｔについて取得する情報取得部２６と、運転特性パラメータが格納されている運転特性パラメータデータベース２８と、情報取得部２６によって取得されたセンサ情報と、運転特性パラメータデータベース２８に格納された運転特性パラメータに基づいて、運転支援のための目標速度を計算する目標速度計算部３０と、計算された目標速度及び情報取得部２６によって取得されたセンサ情報に基づいて、運転支援アクチュエータを制御する運転支援制御部３２と、近似モデルデータベース３４と、パラメータ学習部３６とを備えている。
【００２７】
情報取得部２６は、車両の走行状態を示すセンサ情報を各時刻ｔについて取得する。
具体的には、情報取得部２６は、車両のドライバの運転支援を行うときに、車速センサ１２によって計測された車速と、位置計測部１４によって計測された車両の前後位置ｘ＊ｔと、前方車情報取得部１６によって取得された前方車両情報と、信号状態取得部２０によって取得された次の信号の状態Ｓと、停止減速度取得部２２によって算出された停止減速度Ｄとを逐次取得して、センサ情報として蓄積する。情報取得部２６は取得手段の一例である。
【００２８】
情報取得部２６は、取得したセンサ情報を、パラメータ学習部３６と、目標速度計算部３０とへ出力する。
【００２９】
運転特性パラメータデータベース２８には、後述するパラメータ学習部３６によって学習された運転特性パラメータが格納されている。
【００３０】
目標速度計算部３０は、情報取得部２６によって取得されたセンサ情報と、運転特性パラメータデータベース２８に格納された運転特性パラメータと、運転行動モデルとに基づいて、車両の目標速度を計算する。運転行動モデルは、センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化したものである。
【００３１】
例えば、運転行動モデルでは、条件分岐により、第１の運転行動、第２の運転行動、及び第３の運転行動を切り替え、切り替えられた運転行動に従って目標速度を計算する。第１〜第３の運転行動は、以下の条件分岐によって切り替えられる。
【００３２】
【数１】
2015170126.tif 000003
【００３３】
ここで、Ｓは車両からみて次の信号の色（信号の状態）を表し、Ｓｂｌｕｅは青信号をあらわす。また、Ｄは次の信号の停止線で停止するのに必要な減速度（停止減速度）を表し、ｘｆは前方車両との距離（前方車距離）を表し、ｖｒは目標速度を表し、ｖは自車速度を表す。また、運転特性パラメータのうち、aとｂとは条件分岐で用いられる条件パラメータであり、ｃとｄとは目標速度を算出するためのモデルパラメータである。
【００３４】
運転支援制御部３２は、目標速度計算部３０によって計算された目標速度と、情報取得部２６によって取得されたセンサ情報に含まれる時刻ｔの車速とに基づいて、目標速度ｖｒと時刻ｔの車速との差に応じて、運転支援アクチュエータ４０を制御する。
【００３５】
運転支援アクチュエータ４０は、例えば、アクセル操作量やブレーキ操作量を調整するためのアクチュエータである。
【００３６】
本実施の形態では、拡張カルマンフィルタを用いて、運転特性パラメータを学習する。以下、拡張カルマンフィルタの原理について説明する。
【００３７】
本実施の形態では、車両の前後位置ｘｔと、車両の速度ｘ・ｔと、車両の加速度ｘ・・ｔと、運転特性パラメータ［ａｔ，ｂｔ，ｃｔ，ｄｔ］とを、以下の式（２）に示すように状態ベクトルＸｔ＝［ｘｔ，ｘ・ｔ，ｘ・・ｔ，ａｔ，ｂｔ，ｃｔ，ｄｔ］として構成する。なお、運転特性パラメータのうち［ａｔ，ｂｔ］は条件パラメータである。
また、以下の式（３）に示すように、位置計測部１４によって計測された車両の位置情報を観測値Ｙｔ＝［ｘｔ＊］として構成する。
【００３８】
【数２】
2015170126.tif 000004
【００３９】
（１）予測ステップ
まず、予測ステップにおける処理の概要について説明する。予測ステップでは、以下の式（４）に示すように、時刻ｔの状態ベクトルＸｔ−１＝［ｘｔ−１，ｘ・ｔ−１，ｘ・・ｔ−１，ａｔ−１，ｂｔ−１，ｃｔ−１，ｄｔ−１］と、システムノイズｕｔ（誤差項）とに基づいて、時刻ｔの状態ベクトルＸｔを算出する。以下の式（４）におけるｆｔはシステムモデルである。本実施の形態では、システムモデルは、運転支援装置１０の目標速度計算部３０の運転行動モデルを近似した後述する近似モデルと、車両物理モデルとを含むモデルである。
【００４０】
また、観測値Ｙｔは、観測行列Ｈｔと観測ノイズｗｔ（誤差項）とに基づいて、以下の式（５）に示すように算出される。なお、観測行列Ｈｔは予め求められている。
【００４１】
【数３】
2015170126.tif 000005
【００４２】
図２に、予測ステップの概念図を示す。図２に示すように、予測ステップでは、フィルタリングステップで推定された時刻ｔ−１の状態ベクトルＸｔ−１｜ｔ−１に基づいて、時刻ｔの状態ベクトルＸｔ｜ｔ−１を予測する（中心値の予測）。なお、Ｘｔ｜ｔ−１は、時刻ｔ−１までに利用可能なデータに基づき予測された時刻ｔの状態ベクトルを表す。また、Ｘｔ−１｜ｔ−１は、時刻ｔ−１までに利用可能なデータに基づき推定された時刻ｔ−１の状態ベクトルを表す。
【００４３】
なお、以下では、添え字ｔ｜ｔ−１が付与された値は、時刻ｔ−１までに利用可能なデータに基づき予測された時刻ｔの事前推定値を表す。また、添え字ｔ｜ｔ（又は、ｔ−１｜ｔ−１）が付与された値は、時刻ｔまでに利用可能なデータに基づき推定された時刻ｔの事後推定値を表す。
【００４４】
また、予測ステップでは、システムモデルｆｔを偏微分して得られる行列＾Ｆｔと行列＾Ｇｔとを、以下の式（６）〜（７）に従って算出する。
【００４５】
【数４】
2015170126.tif 000006
【００４６】
ここで、「’」はベクトルの転置を表す。
【００４７】
そして、上記式（６）〜（７）に従って算出した行列＾Ｆｔと行列＾Ｇｔと、前回のフィルタリングステップで推定された事前誤差共分散行列Ｐｔ｜ｔ−１とに基づいて、以下の式（８）に従って、事前誤差共分散行列Ｐｔ｜ｔ−１を算出する（分散の予測）。
【００４８】
【数５】
2015170126.tif 000007
【００４９】
なお、上記式（８）におけるＱｔは、システム雑音ｕｔ（誤差項）の分散を表す。
【００５０】
すなわち、予測ステップでは、時刻ｔの状態ベクトルＸｔ｜ｔ−１を中心値とし、事前誤差共分散行列Ｐｔ｜ｔ−１を分散とする確率分布を予測していることになる。
【００５１】
（２）フィルタリングステップ
次に、フィルタリングステップについての概要を説明する。図３に、フィルタリングステップの概念図を示す。図３に示すように、フィルタリングステップでは、上記式（２）で示した時刻ｔの状態ベクトルＸｔの要素である車両の前後位置［ｘｔ］と、上記式（３）で示した時刻ｔの車両の前後位置情報［ｘ＊ｔ］（観測中心）とに基づいて、フィルタリングを行い、予測ステップで出力された時刻ｔの状態ベクトルＸｔ｜ｔ−１を修正してＸｔ｜ｔを算出すると共に、事前誤差共分散行列Ｐｔ｜ｔ−１を修正して事後誤差共分散行列Ｐｔ｜ｔを算出する。
【００５２】
具体的には、まず、フィルタリングステップでは、予測ステップで算出された事前誤差共分散行列Ｐｔ｜ｔ−１と、観測行列Ｈｔと、観測ノイズｗｔ（誤差項）の分散Ｒｔとに基づいて、以下の式（９）に従って、カルマンゲインＫｔを算出する。
【００５３】
次に、算出されたカルマンゲインＫｔと、予測ステップで算出された時刻ｔにおける状態ベクトルＸｔ｜ｔ−１と、上記式（３）で示したＹｔ＝［ｘ＊ｔ］と、観測行列Ｈｔとに基づいて、以下の式（１０）に従って、時刻ｔにおける状態ベクトルＸｔ｜ｔを推定する。
【００５４】
そして、予測ステップで算出された事前誤差共分散行列Ｐｔ｜ｔ−１と、算出されたカルマンゲインＫｔと、観測行列Ｈｔとに基づいて、以下の式（１１）に従って、事後誤差共分散行列Ｐｔ｜ｔを算出する。
【００５５】
【数６】
2015170126.tif 000008
【００５６】
フィルタリングステップで算出された各値（カルマンゲインＫｔ、状態ベクトルＸｔ｜ｔ、事後誤差共分散行列Ｐｔ｜ｔ）は、次回の予測ステップにおける処理で用いられる。
【００５７】
近似モデルデータベース３４には、目標速度計算部３０において用いられる運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルが格納されている。本実施の形態では、条件パラメータである［ａｔ，ｂｔ］を、シグモイド関数によって連続かつ微分可能な関数で近似した近似モデルを用いる。
ここで、運転行動モデルを近似する方法について説明する。まず、上記式（１）のうち、以下の［］で示した、条件パラメータｂを用いた条件分岐の部分を、近似モデルによって近似する。
【００５８】
【数７】
2015170126.tif 000009
【００５９】
上記式（１２）における［］の部分は、以下の式（１３）に示すように近似することができる。
【００６０】
【数８】
2015170126.tif 000010
【００６１】
ここで、ｐ１は、条件分岐の曖昧さを表す予め求められたパラメータである。また、上記式（１２）及び（１３）を、Ｖ１を用いて書き直すと、以下の式（１４）、（１５）のようになる。
【００６２】
【数９】
2015170126.tif 000011
【００６３】
上記式（１４）の［］で示した、条件パラメータａを用いた条件分岐の部分は、以下の式（１６）に示すように近似することができる。
【００６４】
【数１０】
2015170126.tif 000012
【００６５】
ここで、ｐ２は、条件分岐の曖昧さを表す予め求められたパラメータである。そして、上記式（１）を、上記式（１５）と（１６）とを用いて書き直すと、以下の式（１７）のように表すことができる。
【００６６】
【数１１】
2015170126.tif 000013
【００６７】
以上のように、条件パラメータａ、ｂを用いた運転行動モデルについて、上記式（１７）に示すようにシグモイド関数によって連続かつ微分可能な関数で近似した近似モデルを導出することができる。
【００６８】
パラメータ学習部３６は、近似モデルデータベース３４に格納された近似モデルと、情報取得部２６によって取得された車両の前後位置情報とに基づいて、運転行動モデルの条件分岐で用いられる条件パラメータａ，ｂを含む運動特性パラメータを学習する。図４に示すように、パラメータ学習部３６は、予測部３６０と、フィルタリング部３６２とを備えている。
【００６９】
予測部３６０は、近似モデルデータベース３４に格納された近似モデルと、フィルタリング部３６２によって前回推定された時刻ｔ−１の状態ベクトルＸｔ−１とに基づいて、上記式（４）に従って、時刻ｔの状態ベクトルＸｔを予測する（予測ステップ）。予測部３６０における処理は、拡張カルマンフィルタの予測ステップに対応する。
【００７０】
具体的には、まず、予測部３６０は、情報取得部２６によって取得されたセンサ情報に含まれる次の信号の状態Ｓ、前方車両との相対距離ｘｆ、及び停止減速度Ｄと、近似モデルデータベース３４に格納された近似モデルとに基づいて、上記式（１７）に従って、目標速度ｖｒを算出する。
【００７１】
次に、予測部３６０は、算出された目標速度ｖｒと、時刻ｔ−１の状態ベクトルＸｔ−１の要素である車両の速度ｘ・ｔ−１とに基づいて、時刻ｔの加速度ｘ・・ｔを予測する。例えば、予測部３６０は、車両物理モデルである比例制御モデルを用いて、車速ｘ・ｔ−１と目標速度ｖｒとの差に応じて、時刻ｔの加速度ｘ・・ｔを予測する。
【００７２】
また、予測部３６０は、時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｘ・ｔ−１，ｘ・・ｔ−１］とに基づいて、車両物理モデルに従って、時刻ｔの車速ｘ・ｔを予測する。例えば、速度算出式ｘ・ｔ＝ｘ・ｔ−１＋ｘ・・ｔ−１Ｔに従って、時刻ｔの車速ｘ・ｔを予測する。Ｔは、時刻ｔから時刻ｔ−１までの経過時間を表す。
【００７３】
そして、予測部３６０は、予測された車両の速度ｘ・ｔと、時刻ｔ−１の状態ベクトルＸｔ−１の要素であるｘｔ−１とに基づいて、車両物理モデルに従って、時刻ｔの車両の位置［ｘｔ］を予測する。
【００７４】
上記式（２）における［ｘｔ，ｘ・ｔ，ｘ・・ｔ］については、以上のように予測するが、運動特性パラメータ［ａｔ，ｂｔ，ｃｔ，ｄｔ］については、時刻ｔ−１の運動特性パラメータ［ａｔ−１，ｂｔ−１，ｃｔ−１，ｄｔ−１］をそのまま代入する。
【００７５】
また、予測部３６０は、上記式（６）〜（７）に従って、上記式（１７）で示した近似モデルの偏微分を行い、行列＾Ｆｔと行列＾Ｇｔとを算出する。上記式（１７）における目標速度は、シグモイド関数によって連続かつ微分可能な関数で近似されているため、偏微分をすることができる。
【００７６】
そして、予測部３６０は、算出された行列＾Ｆｔと行列＾Ｇｔと、前回フィルタリング部３６２によって推定された事前誤差共分散行列Ｐｔ｜ｔ−１とに基づいて、上記式（８）に従って、事前誤差共分散行列Ｐｔ｜ｔ−１を算出する。
【００７７】
フィルタリング部３６２は、情報取得部２６によって取得されたセンサ情報に含まれる車両の前後位置情報ｘ＊ｔと、予測部３６０によって予測された時刻ｔの状態ベクトルＸｔと、予測部３６０によって算出された事前誤差共分散行列Ｐｔ｜ｔ−１とに基づいて、時刻ｔにおける状態ベクトルＸｔを推定する（フィルタリングステップ）。フィルタリング部３６２における処理は、拡張カルマンフィルタにおけるフィルタリングステップに対応する。
【００７８】
具体的には、フィルタリング部３６２は、情報取得部２６によって取得されたセンサ情報に含まれる時刻ｔの車両の前後位置情報ｘ＊ｔと、予測部３６０によって予測された時刻ｔの車両の前後位置情報ｘｔと、予測部３６０によって算出された事前誤差共分散行列Ｐｔ｜ｔ−１とに基づいて、上記式（９）に従って、カルマンゲインＫｔを算出する。そして、フィルタリング部３６２は、算出されたカルマンゲインＫｔと、予測部３６０によって算出された時刻ｔにおける状態ベクトルＸｔ｜ｔ−１と、上記式（３）で示したＹｔ＝［ｘ＊ｔ］とに基づいて、上記式（１０）に従って、時刻ｔにおける状態ベクトルＸｔ｜ｔを推定する。
【００７９】
また、フィルタリング部３６２は、算出されたカルマンゲインＫｔと、予測部３６０によって算出された事前誤差共分散行列Ｐｔ｜ｔ−１に基づいて、上記式（１１）に従って、事後誤差共分散行列Ｐｔ｜ｔを算出する。
【００８０】
そして、フィルタリング部３６２は、推定された状態ベクトルＸｔ｜ｔの要素である［ａｔ，ｂｔ，ｃｔ，ｄｔ］を運転特性パラメータとして更新し、運転特性パラメータデータベース２８へ格納する。
【００８１】
＜運転支援装置１０の動作＞
次に、第１の実施の形態に係る運転支援装置１０の動作について説明する。まず、ドライバの運転操作により車両が走行し、運転支援装置１０の情報取得部２６によってセンサ情報が各時刻ｔについて取得されているときに、運転支援装置１０において、図５に示す運転支援処理ルーチンが実行される。
【００８２】
まず、ステップＳ１００において、目標速度計算部３０によって、運転特性パラメータデータベース２８に格納された運動特性パラメータが読み出される。
【００８３】
次に、ステップＳ１０２において、情報取得部２６によって、時刻ｔ−１のセンサ情報を受け付ける。
【００８４】
ステップＳ１０４において、目標速度計算部３０によって、上記ステップＳ１０２で受け付けたセンサ情報と、上記ステップＳ１００で読み出された運転特性パラメータとに基づいて、目標速度ｖｒを計算する。ステップＳ３０６は、図６に示す目標速度計算処理ルーチンによって実現される。
【００８５】
＜目標速度計算処理ルーチン＞
まず、ステップＳ２００において、上記ステップＳ１０２で取得されたセンサ情報に含まれる時刻ｔ−１の信号の状態Ｓに基づいて、車両からみて次の信号が青であるか否かを判定する。次の信号が青である場合には、ステップＳ２０２へ進む。一方、次の信号が青でない場合には、ステップＳ２０４へ進む。
【００８６】
ステップＳ２０２において、上記ステップＳ１０２で取得されたセンサ情報に含まれる時刻ｔ−１の前方車距離ｘｆと、上記ステップＳ１００で読み出された運転特性パラメータｂとに基づいて、前方車距離ｘｆが運転特性パラメータｂより大きいか否かを判定する。前方車距離ｘｆが運転特性パラメータｂより大きい場合には、ステップＳ２０６へ進む。一方、前方車距離ｘｆが運転特性パラメータｂ以下の場合には、ステップＳ２０８へ進む。
【００８７】
ステップＳ２０４において、上記ステップＳ１０２で取得されたセンサ情報に含まれる時刻ｔ−１の停止減速度Ｄと、上記ステップＳ１００で読み出された運転特性パラメータａとに基づいて、停止減速度Ｄが運転特性パラメータａより大きいか否かを判定する。停止減速度Ｄが運転特性パラメータａより大きい場合には、ステップＳ２０２へ移行する。一方、停止減速度Ｄが運転特性パラメータａ以下の場合には、ステップＳ２１０へ進む。
【００８８】
ステップＳ２０６において、目標速度ｖｒに上記ステップＳ１００で読み出された運転特性パラメータｃを代入する。
【００８９】
ステップＳ２０８において、上記ステップＳ１００で読み出された運転特性パラメータｄと、上記ステップＳ１０２で取得されたセンサ情報に含まれる時刻ｔ−１の前方車距離ｘｆと、センサ情報に含まれる時刻ｔ−１の車速とに基づいて、算出式ｄ×（前方車距離ｘｆ／車速）に従って、目標速度ｖｒを算出する。
【００９０】
ステップＳ２１０において、目標速度ｖｒに０を代入する。
【００９１】
ステップＳ２１２において、上記ステップＳ２０６で算出された目標速度ｖｒ、上記ステップＳ２０８で算出された目標速度ｖｒ、及び上記ステップＳ２１０で算出された目標速度ｖｒの何れか１つを、目標速度として出力して、目標速度計算処理ルーチンを終了する。
【００９２】
次に、運転支援処理ルーチンに戻り、ステップＳ１０６において、運転支援制御部３２によって、上記ステップＳ３０６で出力された目標速度ｖｒと、センサ情報に含まれる時刻ｔ−１の車速とに基づいて、運転支援アクチュエータ４０の制御量を算出する。
【００９３】
ステップＳ１０８において、上記ステップＳ１０６で算出された制御量に基づいて、運転支援アクチュエータ４０を制御し、ドライバの運転支援を行う。
【００９４】
ステップＳ１１０において、パラメータ学習部３６によって、運動特性パラメータを学習する。ステップＳ１１０は、図７に示すパラメータ学習処理ルーチンによって実現される。
【００９５】
＜パラメータ学習処理ルーチン＞
まず、ステップＳ３００において、予測部３６０によって、予測処理を実行する。ステップＳ３００は、図８に示す予測処理ルーチンによって実現される。
【００９６】
＜予測処理ルーチン＞
まず、ステップＳ４００において、予測部３６０によって、上記ステップＳ１０２で受け付けたセンサ情報に含まれる次の信号の状態Ｓ、前方車両との相対距離ｘｆ、及び停止減速度Ｄと、近似モデルデータベース３４に格納された近似モデルとに基づいて、上記式（１７）に従って、目標速度ｖｒを予測する。
【００９７】
ステップＳ４０２において、予測部３６０によって、上記ステップＳ４００で予測された目標速度と、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｘ・ｔ−１，ｘ・・ｔ−１］とに基づいて、時刻ｔの［ｘｔ，ｘ・ｔ，ｘ・・ｔ］を予測する。また、運動特性パラメータ［ａｔ，ｂｔ，ｃｔ，ｄｔ］については、時刻ｔ−１の運動特性パラメータ［ａｔ−１，ｂｔ−１，ｃｔ−１，ｄｔ−１］（上記ステップＳ１００で読み出された運動特性パラメータ）をそのまま代入する。そして、時刻ｔの状態ベクトルＸｔ［ｘｔ，ｘ・ｔ，ｘ・・ｔ，ａｔ，ｂｔ，ｃｔ，ｄｔ］を構成する。
【００９８】
ステップＳ４０４において、予測部３６０によって、上記ステップＳ４０２で予測された時刻ｔの状態ベクトルＸｔに基づいて、上記式（６）〜（７）に従って、近似モデルの偏微分を行い、行列＾Ｆｔと行列＾Ｇｔとを算出する。そして、予測部３６０によって、行列＾Ｆｔと行列＾Ｇｔと、前回のステップＳ３０２で推定された事後誤差共分散行列Ｐｔ−１｜ｔ−１とに基づいて、上記式（８）に従って、事前誤差共分散行列Ｐｔ｜ｔ−１を算出する。
【００９９】
ステップＳ４０６において、上記ステップＳ４０２で予測された時刻ｔの状態ベクトルＸｔと、上記ステップＳ４０４で算出された事前誤差共分散行列Ｐｔ｜ｔ−１とを結果として出力する。
【０１００】
次に、パラメータ学習処理ルーチンに戻り、ステップＳ３０２において、フィルタリング処理を実行する。ステップＳ３０２は、図９に示すフィルタリング処理ルーチンによって実現される。
【０１０１】
＜フィルタリング処理ルーチン＞
まず、ステップＳ５００において、上記ステップＳ３００で出力された時刻ｔの状態ベクトルＸｔと、事前誤差共分散行列Ｐｔ｜ｔ−１とを受け付ける。
【０１０２】
次に、ステップＳ５０２において、フィルタリング部３６２によって、上記ステップＳ５００で受け付けた事前誤差共分散行列Ｐｔ｜ｔ−１に基づいて、上記式（９）に従って、カルマンゲインＫｔを算出する。
【０１０３】
ステップＳ５０４において、フィルタリング部３６２によって、上記ステップＳ５０２で算出されたカルマンゲインＫｔと、上記ステップＳ５００で受け付けた時刻ｔにおける状態ベクトルＸｔ｜ｔ−１と、上記ステップＳ１００で受け付けたセンサ情報に含まれる車両の前後位置情報ｘ＊ｔとに基づいて、上記式（１０）に従って、時刻ｔにおける状態ベクトルＸｔ｜ｔを推定する。
【０１０４】
ステップＳ５０６において、上記ステップＳ５００で受け付けた事前誤差共分散行列Ｐｔ｜ｔ−１と、上記ステップＳ５０２で算出されたカルマンゲインＫｔに基づいて、上記式（１１）に従って、事後誤差共分散行列Ｐｔ｜ｔを算出する。
【０１０５】
ステップＳ５０８において、上記ステップＳ３０６で推定された時刻ｔにおける状態ベクトルＸｔ｜ｔと、上記ステップＳ５０６で算出された事後誤差共分散行列Ｐｔ｜ｔとを、結果として出力する。
【０１０６】
次に、パラメータ学習処理ルーチンに戻り、ステップＳ３０４において、上記ステップＳ３０２で出力された時刻ｔにおける状態ベクトルＸｔ｜ｔのうち、運転特性パラメータ［ａｔ，ｂｔ，ｃｔ，ｄｔ］を、新たな運転特性パラメータとして更新し、運転特性パラメータデータベース２８に格納する。
【０１０７】
以上説明したように、第１の実施の形態に係る運転支援装置によれば、センサ情報を用いて車両のドライバの複数の運転行動を離散的にモデル化し、かつ、条件分岐により切り替えるようにモデル化した運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルと、取得された車両のセンサ情報とに基づいて、運転行動モデルの条件分岐で用いられる条件パラメータを含む運転特性パラメータを学習することにより、ドライバに合ったモデルパラメータを学習することができる。
【０１０８】
また、以上説明したように、第１の実施の形態に係る運転支援装置によれば、学習された運転特性パラメータと、運転行動モデルと、取得されたセンサ情報とに基づいて、車両のドライバの運転支援を行うことにより、ドライバに合った運転支援を行うことができる。
【０１０９】
また、市街地走行時の運転支援システムを考慮すると、運転行動に応じた離散的な運転行動モデルが不可欠であり、その離散的な運転行動モデルのパラメータを、実測データから逐次に学習することで、より精度の高い運転支援が可能となる。
【０１１０】
また、従来では、離散状態の切り替えとしてモデル化された運転行動モデルの学習は困難であった。また、クラスタリングなどに代表される判断モデルの同定手法を用いることで学習することも可能だが、学習に時間がかかるうえ、逐次的な学習が困難であった。本実施の形態の形態によれば、非連続な関数である運転行動モデルを、シグモイド関数を用いて、連続かつ微分可能な関数で近似し、拡張カルマンフィルタを用いることにより、より早く、逐次的に、離散的な運転行動モデルのパラメータを学習することができ、より精度のよい運転支援が可能となる。
【０１１１】
また、更新したパラメータを次回実行時の運転行動モデルのパラメータとして使用することで、パラメータを逐次更新して精度を上げながら運転支援を行うことができる。
【０１１２】
＜第２の実施の形態＞
次に、第２の実施の形態について説明する。なお、第１の実施の形態と同様の構成となる部分については、同一符号を付して説明を省略する。
【０１１３】
第２の実施の形態では、目標位置、走路速度情報、及び走路曲率情報を更に考慮して加速度及び操舵角を含む目標の運転操作量を計算する点が、第１の実施の形態と異なっている。第２の実施の形態における状態空間モデルは、図１０に示すように、ドライバモデルと車両物理モデルとで表現される。第２のシステムモデルｆｔは、図１０に示すドライバモデルと車両物理モデルとで表現される。
【０１１４】
図１１に示すように、第２の実施の形態に係る運転支援装置２１０は、ドライバが目的地を入力するための入力操作部２１２と、自車両の位置を計測する位置計測部１４と、自車両の前方を走行する前方車両を検出する前方車情報取得部１６と、地図情報（道路ネットワークデータ）、道路情報、及び信号情報を記憶した道路ネットワークデータベース２１８と、道路ネットワークデータベース２１８から取得した信号情報に基づいて、次の信号の状態Ｓを取得する信号状態取得部２０と、運転支援アクチュエータ４０を制御するコンピュータ２４と、運転支援を行うための運転支援アクチュエータ４０とを備えている。
【０１１５】
道路ネットワークデータベース２１８に記憶されている地図情報及び道路情報には、走路速度情報及び走路曲率情報が含まれている。走路速度情報には、当該走路における定常走行速度に関する情報が含まれている。定常走行速度は、当該走路における過去の走行データ及び制限速度等から算出される。また、走路曲率情報には、当該走路の曲率に関する情報が含まれている。
【０１１６】
情報取得部２２６は、更に、入力操作部２１２により受け付けた目的地情報と、道路ネットワークデータベース２１８より得られた走路速度情報及び走路曲率情報とを各時刻ｔについて取得する。
【０１１７】
運転特性パラメータデータベース２２８には、後述するパラメータ学習部２３６によって学習された運転特性パラメータが格納されている。
【０１１８】
なお、第２の実施の形態では、車両の位置［ｘｔ，ｙｔ］と、車両の向きθｔと、車両の速度ｖｔと、車両の加速度ａｔと、車両の曲率δｔと、後述する条件パラメータｐｓｉｇｎａｌと、目標速度を算出するためのモデルパラメータｐｒｏａｄ、ｐｆ、及びｐｃとを、以下の式（１８）に示すように状態ベクトルＸｔ＝［ｘｔｙｔ θｔｖｔａｔδｔｐｒｏａｄｐｆ ｐｃ ｐｓｉｇｎａｌ］として構成する。ｐｒｏａｄ、ｐｆ、ｐｃ、及びｐｓｉｇｎａｌは、運転特性パラメータである。また、以下の式（１９）に示すように、位置計測部１４によって計測された車両の位置情報を観測ベクトルＹｔ＝［ｘｔ＊ｙｔ＊］として構成する。
【０１１９】
【数１２】
2015170126.tif 000014
【０１２０】
目標運転操作量計算部２３０は、情報取得部２２６によって取得されたセンサ情報と、運転特性パラメータデータベース２２８に格納された運転特性パラメータと、運転行動モデルとに基づいて、加速度及び操舵角を含む目標の運転操作量を計算する。目標運転操作量計算部２３０は、図１２に示すように、運転行動モデル計算部２５０と、車両物理モデル計算部３５０とを備えている。
【０１２１】
運転行動モデル計算部２５０は、情報取得部２２６によって取得されたセンサ情報と、運転特性パラメータデータベース２２８に格納された運転特性パラメータと、運転行動モデルと、後述する車両物理モデル計算部３５０によって前回計算された車両の速度ｖｔ−１、及び車両の向きθｔ−１とに基づいて、時刻ｔの加速度及び操舵角を含む目標の運転操作量を計算する。運転行動モデル計算部２５０は、図１３に示すように、運転操作受付部２５２と、経路生成部２５４と、目標位置制約部２５６と、目標位置選択部２６２と、横位置制御部２６４と、目標速度制約部２６６と、目標速度選択部２７６と、速度制御部２７８と、運転操作出力部２８０とを備えている。
【０１２２】
運転操作受付部２５２は、車両物理モデル計算部３５０によって前回計算された時刻ｔ−１の車両の速度ｖｔ−１、及び車両の向きθｔ−１と、運転特性パラメータデータベース２２８に格納されている運転特性パラメータｐｒｏａｄ、ｐｆ、ｐｃ、及びｐｓｉｇｎａｌを受け付ける。
【０１２３】
経路生成部２５４は、情報取得部２２６によって取得されたセンサ情報に含まれる目的地情報、地図情報、及び車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］に基づいて、最短経路を探索するアルゴリズムや、最短時間の経路を探索するアルゴリズムなど（例えば、Ａ＊アルゴリズム）を用いて、出発地から目的地までの最短経路を生成する。
【０１２４】
目標位置制約部２５６は、情報取得部２２６によって取得されたセンサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］に基づいて、複数の位置制約条件を満たす車両位置を算出する。目標位置制約部２５６は、信号制約部２５８と、経路制約部２６０とを備えている。
【０１２５】
信号制約部２５８は、情報取得部２２６によって取得されたセンサ情報に含まれる信号情報、車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］、及び運転操作受付部２５２によって受け付けた時刻ｔ−１の車両の速度ｖｔ−１と、運転特性パラメータデータベース２２８に格納されている運転特性パラメータｐｓｉｇｎａｌとに基づいて、信号停止に関する予め定められた位置制約条件を満たす車両位置を算出する。具体的には、信号制約部２５８は、以下の式（２０）に示す位置制約条件を満たす車両位置［ｘｒ，ｙｒ］を算出する。
【０１２６】
【数１３】
2015170126.tif 000015
【０１２７】
ここで、［ｘｒ，ｙｒ］Ｔは車両位置、［ｘ＊ｔ−１，ｙ＊ｔ−１］Ｔは時刻ｔ−１の車両の位置、［ｘｓｔｏｐｌｉｎｅ，ｙｓｔｏｐｌｉｎｅ］Ｔは信号に対応した停止線の位置、Ｓｔ−１は前回の信号の状態（赤、黄、青）、Ｓｒｅｄは赤信号、ｖｔ−１は、時刻ｔ−１の車両の速度である。ｐｓｉｇｎａｌは、停止するか否かを決定するためのパラメータであり、後述するパラメータ学習部２３６によって学習される。本実施の形態の形態では、ｐｓｉｇｎａｌが条件パラメータに対応する。
【０１２８】
経路制約部２６０は、経路生成部２５４によって車両の目的地に基づいて求められた経路情報と、情報取得部２２６によって取得されたセンサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］とに基づいて、経路に関する位置制約条件を満たす車両位置を算出する。例えば、経路制約部２６０は、目的地までの経路上における、車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］から１００ｍ先の地点を車両位置として算出する。
【０１２９】
目標位置選択部２６２は、信号制約部２５８によって算出された車両位置、及び経路制約部２６０によって算出された車両位置の何れかを選択し、選択された車両位置を目標位置［ｘｒ，ｙｒ］として決定する。例えば、目標位置選択部２６２は、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］から最も近い車両位置を目標位置［ｘｒ，ｙｒ］として選択する。
【０１３０】
横位置制御部２６４は、目標位置選択部２６２によって選択された目標位置［ｘｒ，ｙｒ］と、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、運転操作受付部２５２によって受け付けた時刻ｔ−１の［ｖｔ−１，θｔ−１］とに基づいて、例えば前方注視モデルを用いて、ドライバの目標のステアリング操作量を計算する。そして、横位置制御部２６４は、計算された目標のステアリング操作量に基づいて、目標の車両の曲率δを算出する。ステアリング操作量と曲率δとの関係は予め求められている。
【０１３１】
目標速度制約部２６６は、情報取得部２２６によって取得されたセンサ情報と、目標位置選択部２６２によって選択された目標位置［ｘｒ，ｙｒ］と、運転操作受付部２５２によって受け付けた時刻ｔ−１の車両の速度ｖｔ−１及び車両の向きθｔ−１とに基づいて、複数の速度制約条件の各々を満たす上限速度を算出する。複数の速度制約条件の各々は、運転操作における様々なシーンに対応する。目標速度制約部２６６は、前後位置制御制約部２６８と、定常走行制約部２７０と、追従制約部２７２と、カーブ制約部２７４とを備えている。
【０１３２】
前後位置制御制約部２６８は、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、目標位置選択部２６２によって選択された走路上の目標位置［ｘｒ，ｙｒ］とに基づいて、前後位置制御に関する速度制約条件を満たす上限速度を算出する。例えば、前後位置制御制約部２６８は、比例制御モデルを用いて、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と目標位置［ｘｒ，ｙｒ］との差に応じて、上限速度を算出する。
【０１３３】
定常走行制約部２７０は、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、情報取得部２２６によって取得されたセンサ情報の道路情報に含まれる走路速度情報に基づいて、当該走路の定常走行速度を、以下の式（２１）に示す定常走行に関する速度制約条件を満たす上限速度として算出する。具体的には、定常走行制約部２７０は、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］に基づいて、当該位置の走路速度情報から得られる、車両が現在走行中の走路の一般的な最高速度を表すパラメータｐｒｏａｄ（定常走行速度）を取得し、上限速度とする。ｐｒｏａｄは、当該走路での過去の走行データや制限速度等から算出される。ｐｒｏａｄは、後述するパラメータ学習部２３６によって学習される。
【０１３４】
【数１４】
2015170126.tif 000016
【０１３５】
追従制約部２７２は、運転操作受付部２５２によって受け付けた時刻ｔ−１の車両の速度ｖｔ−１と、センサ情報に含まれる前方車情報（前方車との相対速度）とに基づいて、以下の式（２２）に示す前方車両追従に関する速度制約条件を満たす上限速度を算出する。具体的には、追従制約部２７２は、運転操作受付部２５２によって受け付けた時刻ｔ−１の車両の速度［ｖｔ−１］と前方車との相対速度に基づいて、等速予測により、Ｔ秒先の前方車との車間距離の予測値＾ｘｆ（ｔ＋Ｔ）を算出する。そして、追従制約部２７２は、式（２２）の制約条件を満たす上限速度を算出する。
【０１３６】
【数１５】
2015170126.tif 000017
【０１３７】
ここで、ｐｆは後述されるパラメータ学習部２３６によって学習される。Ｌは車両の長さである。
【０１３８】
カーブ制約部２７４は、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、情報取得部２２６によって取得されたセンサ情報の地図情報に含まれる走路曲率情報に基づいて、以下の式（２３）に示すカーブ走行に関する速度制約条件を満たす上限速度を算出する。具体的には、カーブ制約部２７４は、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］に基づいて、当該位置におけるＴ秒先の走路の曲率の絶対値の予測値｜＾δ（ｔ＋Ｔ）｜を算出し、算出された予測値｜＾δ（ｔ＋Ｔ）｜に基づいて、式（２３）を満たす上限速度を算出する。
【０１３９】
【数１６】
2015170126.tif 000018
【０１４０】
なお、ｐｃは後述されるパラメータ学習部２３６によって学習される。
【０１４１】
目標速度選択部２７６は、目標速度制約部２６６によって算出された上限速度のうち、最も低い速度を目標速度ｖｒとして選択する。
【０１４２】
速度制御部２７８は、目標速度選択部２７６によって選択された目標速度ｖｒと、時刻ｔ−１の車両の速度ｖｔ−１とに基づいて、目標のアクセルペダル操作量を計算する。そして、速度制御部２７８は、計算された目標のアクセルペダル操作量に基づいて、目標の車両の加速度ａｔを算出する。例えば、速度制御部２７８は、比例制御モデルを用いて、目標速度ｖｒと推定された時刻ｔ−１の車両の速度ｖｔ−１との差に応じて、加速度ａｔを算出する。
【０１４３】
運転操作出力部２８０は、横位置制御部２６４によって算出された目標の曲率δｔと、速度制御部２７８によって算出された目標の加速度ａｔとを、目標の運転操作量として運転支援制御部２３２へ出力する。また、運転操作出力部２８０は、曲率δｔと加速度ａｔとを車両物理モデル計算部３５０へ出力する。
【０１４４】
車両物理モデル計算部３５０は、運転操作出力部２８０によって出力された目標の曲率δｔと目標の加速度ａｔとに基づいて、車両の物理量を計算する。車両物理モデル計算部３５０は、図１４に示すように、速度算出部３５２と、向き算出部３５４と、位置算出部３５６と、車両物理モデル出力部３５８とを備えている。
【０１４５】
速度算出部３５２は、運転操作出力部２８０によって出力された目標の車両の加速度ａｔと、速度算出部３５２で前回算出された車両の速度ｖｔ−１とに基づいて、車両の速度ｖｔを予測する。例えば、速度算出部３５２は、速度算出式ｖｔ＝ｖｔ−１＋ａｔＴに従って、車両の速度ｖｔを予測する。
【０１４６】
向き算出部３５４は、運転操作出力部２８０によって出力された目標の曲率δｔと、向き算出部３５４で前回算出されたθｔ−１と、速度算出部３５２によって予測された車両の速度ｖｔとに基づいて、車両の向きθｔを予測する。
【０１４７】
位置算出部３５６は、速度算出部３５２によって予測された車両の速度ｖｔと、向き算出部３５４によって予測された車両の向きθｔと、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］とに基づいて、車両の位置［ｘｔ，ｙｔ］を予測する。
【０１４８】
車両物理モデル出力部３５８は、速度算出部３５２よって予測された車両の速度ｖｔと、向き算出部３５４によって予測された車両の向きθｔと、位置算出部３５６によって予測された車両の位置［ｘｔ，ｙｔ］とを出力する。出力された車両の速度ｖｔと車両の向きθｔとは、運転行動モデル計算部２５０によって次回用いられる。
【０１４９】
運転支援制御部２３２は、目標運転操作量計算部２３０によって計算された目標の加速度ａｔと目標の曲率δｔとを実現するように、運転支援アクチュエータ４０を制御する。
【０１５０】
近似モデルデータベース２３４には、目標運転操作量計算部２３０において用いられる運転行動モデルを、連続かつ微分可能な関数で近似した近似モデルが格納されている。本実施の形態では、条件パラメータｐｓｉｇｎａｌを用いた運動行動モデルについて、以下の式（２４）に示すように、シグモイド関数によって連続かつ微分可能な関数で近似した近似モデルを導出することができる。具体的には、上記式（２０）のうち、以下のｉｆ文内の（）で示した条件パラメータｐｓｉｇｎａｌについての条件分岐の部分を、近似モデルによって近似する。上記式（２０）を近似する場合、信号停止における条件分岐（ｉｆ節）のパラメータｐｓｉｇｎａｌを学習するため、この信号停止における条件分岐を以下の式（２４）のようにシグモイド関数で連続化する。
【０１５１】
【数１７】
2015170126.tif 000019
【０１５２】
ここで、ｐｓｉｇａは切り替え条件の不確かさを表すパラメータである。
【０１５３】
パラメータ学習部２３６は、近似モデルデータベース２３４に格納された近似モデルと、情報取得部２２６によって取得されたセンサ情報に含まれる車両の位置情報［ｘｔ＊，ｙｔ＊］とに基づいて、運転行動モデルの条件分岐で用いられる条件パラメータｐｓｉｇｎａｌを含む運動特性パラメータを学習する。図１５に示すように、パラメータ学習部２３６は、予測部２３６０と、フィルタリング部２３６２とを備えている。
【０１５４】
予測部２３６０は、図１６に示すように、近似運転行動モデル計算部２４００と、車両物理モデル計算部２５００とを備えている。
【０１５５】
近似運転行動モデル計算部２４００は、上記式（２４）で近似された運転行動を含む運転行動モデルを計算する。近似運転行動モデル計算部２４００は、図１７に示すように、運転操作受付部２４０２と、経路生成部２４０４と、目標位置制約部２４０６と、目標位置選択部２４１２と、横位置制御部２４１４と、目標速度制約部２４１６と、目標速度選択部２４２６と、速度制御部２４２８と、運転操作出力部２４３０とを備えている。また、目標位置制約部２４０６は、信号制約部２４０８と、経路生成部２４０４とを備えている。また、目標位置制約部２４０６は、信号制約部２４０８と、経路生成部２４０４とを備えている。目標速度制約部２４１６は、前後位置制御制約部２４１８と、定常走行制約部２４２０と、追従制約部２４２２と、カーブ制約部２４２４とを備えている。
【０１５６】
信号制約部２４０８で計算する運転行動モデルは、上記式（２４）に示すように、信号制約部２５８において用いられる運転行動モデルを近似したものである。従って、信号制約部２４０８における運転行動以外は、運転行動モデル計算部２５０の各部と同様に計算が行われる。
【０１５７】
運転操作受付部２４０２は、フィルタリング部２３６２によって推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｘｔ−１，ｙｔ−１，θｔ−１，ｖｔ−１，ａｔ−１，δｔ−１］と、運転特性パラメータデータベース２２８に格納されている運転特性パラメータｐｒｏａｄ、ｐｆ、ｐｃ、及びｐｓｉｇｎａｌとを受け付ける。
【０１５８】
経路生成部２４０４は、情報取得部２２６によって取得されたセンサ情報に含まれる目的地情報、及び地図情報と、運転操作受付部２４０２によって受け付けた時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｘｔ−１，ｙｔ−１］とに基づいて、経路生成部２５４と同様に、出発地から目的地までの最短経路を生成する。
【０１５９】
信号制約部２４０８は、情報取得部２２６によって取得されたセンサ情報に含まれる信号情報と、運転操作受付部２４０２によって受け付けた状態ベクトルＸｔ−１の要素である［ｘｔ−１，ｙｔ−１，ｖｔ−１］と、運転特性パラメータデータベース２２８に格納されている運転特性パラメータｐｓｉｇｎａｌとに基づいて、信号停止に関する予め定められた位置制約条件を満たす車両位置を算出する。具体的には、信号制約部２４０８は、上記式（２２）に示す位置制約条件を満たす車両位置［ｘｒ，ｙｒ］を算出する。
【０１６０】
経路制約部２４１０は、経路生成部２４０４によって車両の目的地に基づいて求められた経路情報と、運転操作受付部２４０２によって受け付けた時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｘｔ−１，ｙｔ−１］とに基づいて、経路制約部２６０と同様に、経路に関する位置制約条件を満たす車両位置を算出する。
【０１６１】
目標位置選択部２４１２は、目標位置選択部２６２と同様に、信号制約部２４０８によって算出された車両位置、及び経路制約部２４１０によって算出された車両位置の何れかを選択し、選択された車両位置を目標位置［ｘｒ，ｙｒ］として決定する。
【０１６２】
横位置制御部２４１４は、目標位置選択部２４１２によって選択された目標位置［ｘｒ，ｙｒ］と、運転操作受付部２４０２によって受け付けた時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｘｔ−１，ｙｔ−１，ｖｔ−１，θｔ−１］とに基づいて、横位置制御部２６４と同様に、ドライバのステアリング操作量を予測する。
【０１６３】
前後位置制御制約部２４１８は、運転操作受付部２４０２によって受け付けた時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｘｔ−１，ｙｔ−１］と、目標位置選択部２４１２によって選択された走路上の目標位置［ｘｒ，ｙｒ］とに基づいて、前後位置制御制約部２６８と同様に、前後位置制御に関する速度制約条件を満たす上限速度を算出する。
【０１６４】
定常走行制約部２４２０は、運転操作受付部２４０２によって受け付けた時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｘｔ−１，ｙｔ−１］と、情報取得部２２６によって取得されたセンサ情報の道路情報に含まれる走路速度情報に基づいて、定常走行制約部２７０と同様に、定常走行に関する速度制約条件を満たす上限速度を算出する。
【０１６５】
追従制約部２４２２は、運転操作受付部２４０２によって受け付けた時刻ｔ−１の状態ベクトルＸｔ−１の要素であるｖｔ−１と、センサ情報に含まれる前方車情報（前方車との相対速度）とに基づいて、追従制約部２７２と同様に、前方車両追従に関する速度制約条件を満たす上限速度を算出する。
【０１６６】
カーブ制約部２４２４は、運転操作受付部２４０２によって受け付けた時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｘｔ−１，ｙｔ−１］と、情報取得部２２６によって取得されたセンサ情報の地図情報に含まれる走路曲率情報に基づいて、カーブ制約部２７４と同様に、カーブ走行に関する速度制約条件を満たす上限速度を算出する。
【０１６７】
目標速度選択部２４２６は、目標速度選択部２７６と同様に、目標速度制約部２４１６によって算出された上限速度のうち、最も低い速度を目標速度ｖｒとして選択する。
【０１６８】
速度制御部２４２８は、目標速度選択部２４２６によって選択された目標速度ｖｒと、運転操作受付部２４０２によって受け付けた時刻ｔ−１の車両の速度ｖｔ−１とに基づいて、速度制御部２７８と同様に、アクセルペダルの操作量を予測し、車両の加速度ａｔを算出する。
【０１６９】
運転操作出力部２４３０は、横位置制御部２４１４によって算出された曲率δｔと、速度制御部２４２８によって算出された加速度ａｔとを車両物理モデル計算部２５００へ出力する。
【０１７０】
車両物理モデル計算部２５００は、運転操作出力部２４３０によって出力された曲率δｔと加速度ａｔとに基づいて、車両の物理量を計算する。車両物理モデル計算部２５００は、図１８に示すように、車両物理モデル受付部２５０２と、速度算出部２５０４と、向き算出部２５０６と、位置算出部２５０８と、車両物理モデル出力部２５１０とを備えている。
【０１７１】
車両物理モデル受付部２５０２は、フィルタリング部２３６２によって推定された時刻ｔ−１の［ｘｔ−１，ｙｔ−１，θｔ−１，ｖｔ−１，ａｔ−１，δｔ−１］を受け付ける。
【０１７２】
速度算出部２５０４は、運転操作出力部２４３０によって出力された車両の加速度ｖｔと、車両物理モデル受付部２５０２によって受け付けた時刻ｔ−１の車両の速度ｖｔ−１とに基づいて、速度算出部３５２と同様に、車両の速度ｖｔを予測する。
【０１７３】
向き算出部２５０６は、運転操作出力部２４３０によって出力された曲率δｔと、車両物理モデル受付部２５０２によって受け付けた時刻ｔ−１の車両の向きθｔ−１と、速度算出部２５０４によって予測された車両の速度ｖｔとに基づいて、向き算出部３５４と同様に、車両の向きθｔを予測する。
【０１７４】
位置算出部２５０８は、速度算出部２５０４によって予測された車両の速度ｖｔと、向き算出部２５０６によって予測された車両の向きθｔと、車両物理モデル受付部２５０２によって受け付けた時刻ｔ−１の車両の位置［ｘｔ−１，ｙｔ−１］とに基づいて、位置算出部３５６と同様に、車両の位置［ｘｔ，ｙｔ］を予測する。
【０１７５】
上記式（１８）における［ｘｔ，ｙｔ，θｔ，ｖｔ，ａｔ，δｔ］については、以上のように予測するが、運動特性パラメータｐｒｏａｄ、ｐｆ、ｐｃ、及びｐｓｉｇｎａｌについては、時刻ｔ−１の運動特性パラメータｐｒｏａｄ、ｐｆ、ｐｃ、及びｐｓｉｇｎａｌをそのまま代入する。
【０１７６】
また、予測部２３６０は、上記式（６）〜（７）に従って、上記式（２４）で示した近似モデルを含む運転行動モデルの偏微分を行い、行列＾Ｆｔと行列＾Ｇｔとを算出する。上記式（２４）は、シグモイド関数によって連続かつ微分可能な関数で近似されているため、偏微分をすることができる。
【０１７７】
そして、予測部２３６０は、上記式（８）に従って、事前誤差共分散行列Ｐｔ｜ｔ−１を算出する。
【０１７８】
フィルタリング部２３６２は、情報取得部２２６によって取得されたセンサ情報に含まれる車両の位置情報［ｘ＊ｔ，ｙ＊ｔ］と、予測部２３６０によって予測された時刻ｔの状態ベクトルＸｔと、予測部２３６０によって算出された事前誤差共分散行列Ｐｔ｜ｔ−１とに基づいて、第１の実施の形態と同様に、時刻ｔにおける状態ベクトルＸｔを推定する（フィルタリングステップ）。そして、フィルタリング部２３６２は、推定された状態ベクトルＸｔ｜ｔの要素である［ｐｒｏａｄ，ｐｆ，ｐｃ，ｐｓｉｇｎａｌ］を運転特性パラメータとして更新し、運転特性パラメータデータベース２２８へ格納する。
【０１７９】
＜運転支援装置２１０の動作＞
次に、第２の実施の形態に係る運転支援装置２１０の動作について説明する。まず、ドライバの運転操作により車両が走行し、運転支援装置２１０の情報取得部２２６によってセンサ情報が各時刻ｔについて取得されているときに、運転支援装置２１０において、図１９に示す運転支援処理ルーチンが実行される。
【０１８０】
ステップＳ２１０４において、目標運転操作量計算部２３０によって、上記ステップＳ１０２で受け付けたセンサ情報と、上記ステップＳ１００で読み出された運転特性パラメータｐｓｉｇｎａｌとに基づいて、現時刻ｔにおける加速度及び操舵量を含む目標の運転操作量を計算する。ステップＳ２１０４は、図２０に示す目標運転操作量計算処理ルーチンによって実現される。
【０１８１】
＜目標運転操作量計算処理ルーチン＞
まず、ステップＳ６００において、経路生成部２５４によって、上記ステップＳ１０２で受け付けたセンサ情報に含まれる目的地情報、及び車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］とに基づいて、出発地から目的地までの最短経路を生成する。
【０１８２】
ステップＳ６０２において、信号制約部２５８によって、上記ステップＳ１０２で受け付けた時刻ｔ−１の車両のセンサ情報に含まれる信号情報、及び車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、前回のステップＳ６１８で予測された時刻ｔ−１の車両の速度ｖｔ−１とに基づいて、上記式（２０）に従って、信号停止に関する予め定められた位置制約条件を満たす車両位置［ｘｒ，ｙｒ］を設定する。
【０１８３】
ステップＳ６０４において、経路制約部２６０によって、上記ステップＳ６００で生成された経路情報と、上記ステップＳ１０２で受け付けたセンサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］とに基づいて、経路上における位置［ｘｒ，ｙｒ］を設定する。
【０１８４】
ステップＳ６０６において、目標位置選択部２６２によって、上記ステップＳ６０２で設定された車両位置と、上記ステップＳ６０４で設定された車両位置と、上記ステップＳ１０２で受け付けたセンサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］とに基づいて、［ｘ＊ｔ−１，ｙ＊ｔ−１］から最も近い経路上における位置［ｘｒ，ｙｒ］を目標位置として選択する。
【０１８５】
ステップＳ６０８において、横位置制御部２６４によって、上記ステップＳ６０６で選択された目標位置［ｘｒ，ｙｒ］と、上記ステップＳ１０２で受け付けたセンサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、前回のステップＳ６１８で計算された時刻ｔ−１の車両の目標速度ｖｔ−１，及び目標の車両の向きθｔ−１とに基づいて、ドライバの目標のステアリング操作量を計算する。そして、計算された目標のステアリング操作量に基づいて、目標の車両の曲率δを算出する。
【０１８６】
ステップＳ６１０において、複数の速度制約条件の各々を満たす上限速度を算出する。
本ステップでは、まず、前後位置制御制約部２６８によって、上記ステップＳ１０２で受け付けたセンサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、上記ステップＳ６０６で選択された目標位置［ｘｒ，ｙｒ］とに基づいて、上限速度を算出する。
次に、定常走行制約部２７０によって、上記ステップＳ１０２で受け付けたセンサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、上記ステップＳ１０２で受け付けたセンサ情報に含まれる走路速度情報に基づいて、当該走路の定常走行速度を、上記式（１９）に示す速度制約条件の上限速度として算出する。
また、追従制約部２７２によって、前回のステップＳ６１８で推定された時刻ｔ−１の車両の速度ｖｔ−１と、上記ステップＳ１０２で受け付けたセンサ情報に含まれる前方車情報（前方車との相対速度）とに基づいて、上記式（２０）に示す速度制約条件の上限速度を算出する。
そして、カーブ制約部２７４によって、上記ステップＳ１０２で受け付けたセンサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］と、上記ステップＳ１０２で受け付けたセンサ情報の地図情報に含まれる走路曲率情報に基づいて、上記式（２１）に示す速度制約条件の上限速度を算出する。
【０１８７】
ステップＳ６１２において、目標速度選択部２７６によって、上記ステップＳ６１０で算出された上限速度のうち、最も低い速度を目標速度ｖｒとして選択する。
【０１８８】
ステップＳ６１４において、速度制御部２７８によって、上記ステップＳ６１２で選択された目標速度ｖｒと、前回のステップＳ１１０で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素である［ｖｔ−１］とに基づいて、目標のアクセルペダル操作量を計算する。そして、計算された目標のアクセルペダル操作量に基づいて、目標の車両の加速度ａを算出する。
【０１８９】
ステップＳ６１６において、運転操作出力部２８０によって、上記ステップＳ６０８で算出された目標の曲率δと、上記ステップＳ６１４で算出された目標の加速度ａとを、時刻ｔにおける目標の曲率δｔと加速度ａｔとして出力する。
【０１９０】
ステップＳ６１８において、速度算出部３５２によって、上記ステップＳ６１６で算出された車両の加速度ａｔと、前回本ステップＳ６１８で算出された車両の速度ｖｔ−１とに基づいて、車両の速度ｖｔを予測する。
【０１９１】
ステップＳ６２０において、向き算出部３５４によって、上記ステップＳ６１６で算出された曲率δｔと、前回本ステップＳ６２０で算出されたθｔ−１と、上記ステップＳ６１８で予測された車両の速度ｖｔとに基づいて、車両の向きθｔを予測する。
【０１９２】
ステップＳ６２２において、位置算出部３５６によって、上記ステップＳ６１８で予測された車両の速度ｖｔと、上記ステップＳ６２０で予測された車両の向きθｔと、センサ情報に含まれる車両の位置［ｘ＊ｔ−１，ｙ＊ｔ−１］とに基づいて、車両の位置［ｘｔ，ｙｔ］を予測する。
【０１９３】
ステップＳ６２４において、上記ステップＳ６１６で予測された時刻ｔにおける曲率δｔと加速度ａｔとを結果として出力して目標運転操作量計算処理ルーチンを終了する。
【０１９４】
次に、運転支援処理ルーチンに戻り、ステップＳ２１１０において、パラメータ学習処理を実行する。ステップＳ２１１０は、図２１に示す、パラメータ学習処理ルーチンによって実現される。
【０１９５】
＜パラメータ学習処理ルーチン＞
まず、ステップＳ２３００において、予測部２３６０によって、予測処理を実行する。ステップＳ２３００は、図２２に示す予測処理ルーチンによって実現される。
【０１９６】
＜予測処理ルーチン＞
まず、ステップＳ７００において、経路生成部２４０４によって、上記ステップＳ１０２で受け付けたセンサ情報に含まれる目的地情報と、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１］とに基づいて、出発地から目的地までの最短経路を生成する。
【０１９７】
ステップＳ７０２において、信号制約部２４０８によって、上記ステップＳ１０２で受け付けた時刻ｔ−１の車両のセンサ情報に含まれる信号情報と、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１，ｖｔ−１］とに基づいて、上記式（２４）に従って、信号停止に関する予め定められた位置制約条件を満たす車両位置［ｘｒ，ｙｒ］を設定する。
【０１９８】
ステップＳ７０４において、経路制約部２４１０によって、上記ステップＳ７０２で生成された経路情報と、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１］とに基づいて、経路上における位置［ｘｒ，ｙｒ］を設定する。
【０１９９】
ステップＳ７０６において、目標位置選択部２４１２によって、上記ステップＳ７０２で設定された車両位置と、上記ステップＳ７０４で設定された車両位置と、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１］とに基づいて、［ｘｔ−１，ｙｔ−１］から最も近い経路上における位置［ｘｒ，ｙｒ］を目標位置として選択する。
【０２００】
ステップＳ７０８において、横位置制御部２４１４によって、上記ステップＳ７０６で選択された目標位置［ｘｒ，ｙｒ］と、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１，ｖｔ−１，θｔ−１］とに基づいて、ドライバのステアリング操作量を予測する。そして、予測されたステアリング操作量に基づいて、車両の曲率δｔを算出する。
【０２０１】
ステップＳ７１０において、複数の速度制約条件の各々を満たす上限速度を算出する。
本ステップでは、まず、前後位置制御制約部２４１８によって、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１］と、上記ステップＳ７０６で選択された目標位置［ｘｒ，ｙｒ］とに基づいて、上限速度を算出する。
次に、定常走行制約部２４２０によって、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１］と、上記ステップＳ１０２で受け付けたセンサ情報に含まれる走路速度情報に基づいて、当該走路の定常走行速度を、上記式（１９）に示す速度制約条件の上限速度として算出する。
また、追従制約部２４２２によって、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素ｖｔ−１と、上記ステップＳ１０２で受け付けたセンサ情報に含まれる前方車情報（前方車との相対速度）とに基づいて、上記式（２０）に示す速度制約条件の上限速度を算出する。
そして、カーブ制約部２４２４によって、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１］と、上記ステップＳ１０２で受け付けたセンサ情報の地図情報に含まれる走路曲率情報に基づいて、上記式（２１）に示す速度制約条件の上限速度を算出する。
【０２０２】
ステップＳ７１２において、目標速度選択部２４２６によって、上記ステップＳ７１０で算出された上限速度のうち、最も低い速度を目標速度ｖｒとして選択する。
【０２０３】
ステップＳ７１４において、速度制御部２４２８によって、上記ステップＳ７１２で選択された目標速度ｖｒと、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｖｔ−１］とに基づいて、アクセルペダルの操作量を予測する。そして、予測されたアクセルペダルの操作量に基づいて、車両の加速度ａを算出する。
【０２０４】
ステップＳ７１６において、運転操作出力部２４３０によって、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ａｔ−１，δｔ−１］と、上記ステップＳ７０８で算出された曲率δと、上記ステップＳ７１４で算出された加速度ａとに基づいて、時刻ｔにおける曲率δｔと加速度ａｔとを予測する。
【０２０５】
ステップＳ７１８において、速度算出部２５０４によって、上記ステップＳ７１６で算出された車両の加速度ａｔと、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素ｖｔ−１とに基づいて、車両の速度ｖｔを予測する。
【０２０６】
ステップＳ７２０において、向き算出部２５０６によって、上記ステップＳ７１６で算出された曲率δｔと、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素θｔ−１と、上記ステップＳ７１８で予測された車両の速度ｖｔとに基づいて、車両の向きθｔを予測する。
【０２０７】
ステップＳ７２２において、位置算出部２５０８によって、上記ステップＳ７１８で予測された車両の速度ｖｔと、上記ステップＳ７２０で予測された車両の向きθｔと、前回のステップＳ３０２で推定された時刻ｔ−１の状態ベクトルＸｔ−１の要素［ｘｔ−１，ｙｔ−１］とに基づいて、車両の位置［ｘｔ，ｙｔ］を予測する。
【０２０８】
ステップＳ７２４において、上記ステップＳ７１６で予測された時刻ｔにおける曲率δｔと加速度ａｔと、上記ステップＳ７１８で予測された車両の速度ｖｔと、上記ステップＳ７２０で予測された車両の向きθｔと、上記ステップＳ７２２で予測された車両の位置［ｘｔ，ｙｔ］とを状態ベクトルＸｔとして構成する。なお、運動特性パラメータｐｒｏａｄ、ｐｆ、ｐｃ、及びｐｓｉｇｎａｌについては、時刻ｔ−１の運動特性パラメータｐｒｏａｄ、ｐｆ、ｐｃ、及びｐｓｉｇｎａｌをそのまま代入し、状態ベクトルＸｔを［ｘｔ，ｙｔ，θｔ，ｖｔ，ａｔ，δｔ，ｐｒｏａｄ，ｐｆ，ｐｃ，ｐｓｉｇｎａｌ］として構成する。
【０２０９】
ステップＳ７２６において、予測部２３６０によって、上記ステップＳ７２４で構成された時刻ｔの状態ベクトルＸｔに基づいて、上記式（６）〜（７）に従って、近似モデルの偏微分を行い、行列＾Ｆｔと行列＾Ｇｔとを算出する。そして、予測部２３６０によって、行列＾Ｆｔと行列＾Ｇｔと、前回のステップＳ３０２で推定された事後誤差共分散行列Ｐｔ−１｜ｔ−１とに基づいて、上記式（８）に従って、事前誤差共分散行列Ｐｔ｜ｔ−１を算出する。
【０２１０】
ステップＳ７２８において、予測部２３６０によって、上記ステップＳ７２４で構成された時刻ｔの状態ベクトルＸｔと、上記ステップＳ７２６で算出された事前誤差共分散行列Ｐｔ｜ｔ−１とを結果として出力する。
【０２１１】
次に、パラメータ学習処理ルーチンに戻り、ステップＳ３０２において、フィルタリング部２３６２によって、第１の実施の形態と同様に、時刻ｔにおける状態ベクトルＸｔを推定する（フィルタリングステップ）。
【０２１２】
そして、ステップＳ３０４において、上記ステップＳ３０２で推定された状態ベクトルＸｔ｜ｔの要素である［ｐｒｏａｄ，ｐｆ，ｐｃ，ｐｓｉｇｎａｌ］を運転特性パラメータとして更新し、運転特性パラメータデータベース２２８へ格納する。
【０２１３】
なお、第２の実施の形態に係る運転支援装置の他の構成及び作用については、第１の実施の形態と同様であるため、説明を省略する。
【０２１４】
以上説明したように、第２の実施の形態に係る運転支援装置によれば、運転行動モデルとして、定常走行に関する速度制約条件を満たす上限速度として算出し、カーブ走行に関する速度制約条件を満たす上限速度を算出し、前方車両追従に関する速度制約条件を満たす上限速度を算出し、前後位置制御に関する速度制約条件を満たす上限速度を算出し、算出された上限速度のうちの何れかを目標速度として選択し、かつ信号停止に関する位置制約条件を満たす車両位置を算出し、経路に関する位置制約条件を満たす車両位置を算出し、算出された車両位置のうちの何れかを選択し、選択した位置を目標位置として決定し、運転行動モデルの条件分岐で用いられる条件パラメータを含むモデルパラメータを学習することにより、ドライバに合ったモデルパラメータを学習することができる。
【０２１５】
また、以上説明したように、第２の実施の形態に係る運転支援装置によれば、学習された運転特性パラメータと、運転行動モデルと、取得されたセンサ情報とに基づいて、車両のドライバの運転支援を行うことにより、ドライバに合った運転支援を行うことができる。
【０２１６】
なお、上記の実施の形態では、パラメータ学習部３６（２３６）と、運転支援制御部３２（２３２）とが１つの装置で構成される場合を例に説明したが、これに限定されるものではなく、別々の装置として構成してもよい。
【０２１７】
また、上記の実施の形態における前方車情報取得部１６は、レーザレーダ装置を用いる場合を例に説明したが、これに限定されるものではない。例えば、前方車情報取得部１６として、車車間通信装置や、路車間通信装置等を用いて、前方車両情報を取得してもよい。
【０２１８】
また、上記の実施の形態では、上述の運転支援装置は、道路ネットワークデータベース１８（２１８）を備えている場合を例に説明したが、これに限定されるものではなく、例えば、道路ネットワークデータベース１８（２１８）が車両挙動予測装置の外部装置に設けられ車両挙動予測装置は、外部装置と通信手段を用いて通信することにより、道路ネットワークデータベース１８（２１８）を参照するようにしてもよい。
【０２１９】
また、第２の実施の形態では、目標速度制約部２６６において、複数の速度制約条件の各々を満たす上限速度を算出し、目標速度選択部２７６において、上限速度のうち最も低いものを目標速度として選択する場合を例に説明したが、これに限定されるものではなく、複数の速度制約条件の各々の組み合わせに基づいて、目標速度を選択するようにしてもよい。
【０２２０】
また、本実施の形態では、運転支援の方法として車両の制御を行う場合を例に説明したが、これに限定されるものではなく、例えば、ドライバへの情報提示であってもよい。
【０２２１】
なお、本発明のプログラムは、記録媒体に格納して提供することができる。
【符号の説明】
【０２２２】
１０，２１０  運転支援装置
１２   車速センサ
１４   位置計測部
１６   前方車情報取得部
１８，２１８  道路ネットワークデータベース
２０   信号状態取得部
２２   停止減速度取得部
２４   コンピュータ
２６，２２６  情報取得部
２８，２２８  運転特性パラメータデータベース
３０   目標速度計算部
３２，２３２  運転支援制御部
３４，２３４  近似モデルデータベース
３６，２３６  パラメータ学習部
４０   運転支援アクチュエータ
２１２ 入力操作部
２３０ 目標運転操作量計算部
２５０ 運転行動モデル計算部
２５２ 運転操作受付部
２５４，２４０４     経路生成部
２５６，２４０６     目標位置制約部
２５８，２４０８     信号制約部
２６０，２４１０     経路制約部
２６２，２４１２     目標位置選択部
２６４，２４１４     横位置制御部
２６６，２４１６     目標速度制約部
２６８，２４１８     前後位置制御制約部
２７０，２４２０     定常走行制約部
２７２，２４２２     追従制約部
２７４，２４２４     カーブ制約部
２７６，２４２６     目標速度選択部
２７８，２４２８     速度制御部
２８０，２４３０     運転操作出力部
３５０，２５００     車両物理モデル計算部
３５２，２５０４     速度算出部
３５４，２５０６     向き算出部
３５６，２５０８     位置算出部
３５８，２５１０     車両物理モデル出力部
３６０，２３６０     予測部
３６２，２３６２     フィルタリング部
２４００      近似運転行動モデル計算部
２４０２      運転操作受付部
２５０２      車両物理モデル受付部
【図１】
2015170126.tif 000020
【図２】
2015170126.tif 000021
【図４】
2015170126.tif 000022
【図５】
2015170126.tif 000023
【図６】
2015170126.tif 000024
【図７】
2015170126.tif 000025
【図８】
2015170126.tif 000026
【図９】
2015170126.tif 000027
【図１１】
2015170126.tif 000028
【図１２】
2015170126.tif 000029
【図１３】
2015170126.tif 000030
【図１４】
2015170126.tif 000031
【図１５】
2015170126.tif 000032
【図１６】
2015170126.tif 000033
【図１７】
2015170126.tif 000034
【図１８】
2015170126.tif 000035
【図１９】
2015170126.tif 000036
【図２０】
2015170126.tif 000037
【図２１】
2015170126.tif 000038
【図２２】
2015170126.tif 000039
【図３】
2015170126.tif 000040
【図１０】
2015170126.tif 000041