ホーム > 特許ランキング > 日立Ａｓｔｅｍｏ株式会社
知財求人 - 知財ポータルサイト「IP Force」
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2024-12-10
(45)【発行日】2024-12-18
(54)【発明の名称】車両制御装置、車両制御方法、および車両制御システム
(51)【国際特許分類】
B60W 30/10 20060101AFI20241211BHJP
B62D 6/00 20060101ALI20241211BHJP
B62D 101/00 20060101ALN20241211BHJP
B62D 111/00 20060101ALN20241211BHJP
B62D 113/00 20060101ALN20241211BHJP
【ＦＩ】
B60W30/10
B62D6/00 ZYW
B62D101:00
B62D111:00
B62D113:00
【請求項の数】
10
(21)【出願番号】P 2023505132
(86)(22)【出願日】2021-12-28
(86)【国際出願番号】 JP2021048878
(87)【国際公開番号】W WO2022190585
(87)【国際公開日】2022-09-15
【審査請求日】2023-05-25
(31)【優先権主張番号】P 2021038825
(32)【優先日】2021-03-11
(33)【優先権主張国・地域又は機関】JP
(73)【特許権者】
【識別番号】509186579
【氏名又は名称】日立Ａｓｔｅｍｏ株式会社
(74)【代理人】
【識別番号】100129425
【弁理士】
【氏名又は名称】小川 護晃
(74)【代理人】
【識別番号】100168642
【弁理士】
【氏名又は名称】関谷 充司
(72)【発明者】
【氏名】菅原 弘貴
(72)【発明者】
【氏名】上野 健太郎
【審査官】稲本 遥
(56)【参考文献】
【文献】特開２０１７－０４７７９８（ＪＰ，Ａ）
【文献】特開２０１６－１４６０６１（ＪＰ，Ａ）
【文献】独国特許出願公開第１０２０１４２０８７８６（ＤＥ，Ａ１）
(58)【調査した分野】(Int.Cl.，ＤＢ名)
Ｂ６０Ｗ １０／００－１０／３０
３０／００－６０／００
Ｇ０８Ｇ １／００－９９／００
Ｂ６２Ｄ ６／００
Ｂ６２Ｄ １０１／００
Ｂ６２Ｄ １１１／００
Ｂ６２Ｄ １１３／００
(57)【特許請求の範囲】
【請求項1】
車両の目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得する左右方向差取得部と、前記左右方向差取得部で取得された前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定する外乱推定部と、
前記外乱推定部で推定した前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求める追従制御部と、
を備え、
前記外乱推定部は、
過去の前記左右方向の位置の差に関する情報、および、現在の前記左右方向の位置の差に関する情報を用いて、前記外乱量を推定する、
車両制御装置。
【請求項2】
請求項１記載の車両制御装置であって、前記過去の前記左右方向の位置の差に関する情報は予測値で、前記現在の前記左右方向の位置の差に関する情報は実際値であり、
前記外乱推定部は、
前記予測値と実際値との差に基づき前記実際値を変更した結果を用いて、前記外乱量を推定する、
車両制御装置。
【請求項3】
車両の目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得する左右方向差取得部と、前記左右方向差取得部で取得された前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定する外乱推定部と、
前記外乱推定部で推定した前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求める追従制御部と、
を備え、
前記追従制御部は、
前記制御指令としての前記車両の横加速度の制御指令を、前記左右方向の位置の差が小さくなるように求めるものであって、前記横加速度の制御指令を、前記目標軌道における路面の左右勾配と、前記実軌道における路面の左右勾配との差を補償するように求める、
車両制御装置。
【請求項4】
請求項３記載の車両制御装置であって、前記追従制御部は、
前記横加速度の制御指令の変化速度を所定範囲内に制限する、
車両制御装置。
【請求項5】
請求項３記載の車両制御装置であって、前記追従制御部は、
前記横加速度の制御指令を、前記実軌道が前記目標軌道より路面の左右勾配において高い位置にある場合は低い位置にある場合に比べて小さくする、
車両制御装置。
【請求項6】
請求項３記載の車両制御装置であって、前記追従制御部は、
前記横加速度の制御指令を、前記左右方向の位置の差に関する情報とともに、前記車両の向きに関する情報及び前記目標軌道の曲率に関する情報のうちの少なくとも１つを用いて求める、
車両制御装置。
【請求項7】
車両に搭載された車両制御装置が実行する車両制御方法であって、前記車両の目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得するステップと、
取得された前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定するステップと、
推定された前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求めるステップと、
を備え、
前記外乱量を推定するステップは、
過去の前記左右方向の位置の差に関する情報、および、現在の前記左右方向の位置の差に関する情報を用いて、前記外乱量を推定する、
車両制御方法。
【請求項8】
車両に搭載された車両制御装置が実行する車両制御方法であって、前記車両の目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得するステップと、
取得された前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定するステップと、
推定された前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求めるステップと、
を備え、
前記制御指令を求めるステップは、
前記制御指令としての前記車両の横加速度の制御指令を、前記左右方向の位置の差が小さくなるように求めるものであって、前記横加速度の制御指令を、前記目標軌道における路面の左右勾配と、前記実軌道における路面の左右勾配との差を補償するように求める、
車両制御方法。
【請求項9】
車両に搭載される車両制御システムであって、第１制御装置と、第２制御装置と、アクチュエータ制御装置と、を備え、
前記第１制御装置は、
前記車両の目標軌道を生成し、
前記第２制御装置は、
前記目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得する左右方向差取得部と、
前記左右方向差取得部で取得された前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定する外乱推定部と、
前記外乱推定部で推定した前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求める追従制御部と、
を備え、
前記外乱推定部は、
過去の前記左右方向の位置の差に関する情報、および、現在の前記左右方向の位置の差に関する情報を用いて、前記外乱量を推定するよう構成され、
前記アクチュエータ制御装置は、
前記制御指令を取得する、
車両制御システム。
【請求項10】
車両に搭載される車両制御システムであって、第１制御装置と、第２制御装置と、アクチュエータ制御装置と、を備え、
前記第１制御装置は、
前記車両の目標軌道を生成し、
前記第２制御装置は、
前記目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得する左右方向差取得部と、
前記左右方向差取得部で取得された前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定する外乱推定部と、
前記外乱推定部で推定した前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求める追従制御部と、
を備え、
前記追従制御部は、
前記制御指令としての前記車両の横加速度の制御指令を、前記左右方向の位置の差が小さくなるように求めるものであって、前記横加速度の制御指令を、前記目標軌道における路面の左右勾配と、前記実軌道における路面の左右勾配との差を補償するように求めるよう構成され、
前記アクチュエータ制御装置は、
前記制御指令を取得する、
車両制御システム。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、車両制御装置、車両制御方法、および車両制御システムに関する。
【背景技術】
【0002】
特許文献１には、車両の走行路のカントを推定するカント推定方法が開示されている。
このカント推定方法は、第１の車両を含む複数の車両の速度、横加速度、操舵角、ヨーレートおよび位置の情報を含む車両情報を取得するステップと、車両情報に基づいて、第１の車両の走行路のカントを推定するステップと、推定されたカントを、第１の車両の位置の情報と関連付けて、複数の車両で利用可能なカント角データベースに記憶するステップと、を含む。
このカント推定方法は、第１の車両を含む複数の車両の速度、横加速度、操舵角、ヨーレートおよび位置の情報を含む車両情報を取得するステップと、車両情報に基づいて、第１の車両の走行路のカントを推定するステップと、推定されたカントを、第１の車両の位置の情報と関連付けて、複数の車両で利用可能なカント角データベースに記憶するステップと、を含む。
【先行技術文献】
【特許文献】
【0003】
【文献】特開２０１９－１７２２２０号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
ところで、車両の実軌道を目標軌道に追従させる自動運転では、たとえば、車両が左右勾配（換言すれば、横断勾配）を有する道路を走行すると、実軌道が重力によって勾配の低い方へずれ、目標軌道に対する実軌道の追従性が低下する場合があった。
また、横風によっても車両を偏向させる外力が車両に加わって実軌道が目標軌道からずれ、更に、アライメントなどの車両１０の偏向に関与する車両特性によっても、実軌道が目標軌道からずれる可能性がある。
また、横風によっても車両を偏向させる外力が車両に加わって実軌道が目標軌道からずれ、更に、アライメントなどの車両１０の偏向に関与する車両特性によっても、実軌道が目標軌道からずれる可能性がある。
【0005】
ここで、道路の左右勾配や横風などの外乱によって目標軌道への追従性が低下することを抑止するためには、外乱量を高い精度で推定し、操舵制御指令などの制御指令を外乱量に見合う指令とすることが必要となる。
しかし、たとえば、車速、横加速度、ヨーレートなどの車両運動に関する情報に基づき外乱量を推定する処理では、外乱量を高い精度で推定することが難しく、車両制御装置が、外乱量の推定結果に基づき車両を制御しても、目標軌道に対する実軌道の追従性が外乱によって低下することを十分に抑止できなかった。
しかし、たとえば、車速、横加速度、ヨーレートなどの車両運動に関する情報に基づき外乱量を推定する処理では、外乱量を高い精度で推定することが難しく、車両制御装置が、外乱量の推定結果に基づき車両を制御しても、目標軌道に対する実軌道の追従性が外乱によって低下することを十分に抑止できなかった。
【0006】
本発明は、従来の実情に鑑みてなされたものであり、その目的は、外乱量を精度良く推定して、目標軌道への追従性を向上させることができる、車両制御装置、車両制御方法、および車両制御システムを提供することにある。
【課題を解決するための手段】
【0007】
本発明によれば、その１つの態様において、車両の目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得し、前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定し、前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求めるよう構成され、前記外乱量を、過去の前記左右方向の位置の差に関する情報、および、現在の前記左右方向の位置の差に関する情報を用いて推定する。
また、本発明によれば、その別の態様において、車両の目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得し、前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定し、前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求めるよう構成され、前記制御指令としての前記車両の横加速度の制御指令を、前記左右方向の位置の差が小さくなるように求めるものであって、前記横加速度の制御指令を、前記目標軌道における路面の左右勾配と、前記実軌道における路面の左右勾配との差を補償するように求める。
また、本発明によれば、その別の態様において、車両の目標軌道と前記車両の実軌道との左右方向の位置の差に関する情報を取得し、前記左右方向の位置の差に関する情報を用いて、前記左右方向の位置の差に相当する外乱量を推定し、前記外乱量を用いて、前記車両を前記目標軌道に追従させるための制御指令を求めるよう構成され、前記制御指令としての前記車両の横加速度の制御指令を、前記左右方向の位置の差が小さくなるように求めるものであって、前記横加速度の制御指令を、前記目標軌道における路面の左右勾配と、前記実軌道における路面の左右勾配との差を補償するように求める。
【発明の効果】
【0008】
本発明によれば、外乱量を精度良く推定して、目標軌道への追従性を向上させることができる。
【図面の簡単な説明】
【0009】
【図1】車両制御システムの第１実施形態を示すブロック図である。
【図2】横加速度指令の算出に用いる各種変数及び座標系の一態様を示す図である。
【図3】直線距離としての左右偏差を示す図である。
【図4】路面に沿った長さとしての左右偏差を示す図である。
【図5】左右勾配による左右偏差の発生状態を示す図である。
【図6】左右偏差と左右勾配推定値との変化を例示するタイムチャートであって、左右勾配推定値の変化を制限しない状態を示すタイムチャートである。
【図7】左右偏差と左右勾配推定値との変化を例示するタイムチャートであって、左右勾配推定値の変化を制限した状態を示すタイムチャートである。
【図8】車両制御システムの第２実施形態を示すブロック図である。
【図9】車両制御システムの第３実施形態を示すブロック図である。
【図10】ヨーレート、車速、および横加速度に基づく左右勾配の推定処理を説明するための図である。
【図11】横加速度指令に対し操舵制御及び制動力制御を実施するシステムを示すブロック図である。
【発明を実施するための形態】
【0010】
以下、本発明に係る車両制御装置、車両制御方法、および車両制御システムの実施形態を、図面に基づいて説明する。
図１は、車両制御システム１００の第１実施形態を示すブロック図である。
図１は、車両制御システム１００の第１実施形態を示すブロック図である。
【0011】
車両制御システム１００は、４輪自動車などの車両１０に搭載される。
そして、車両制御システム１００は、自動運転において、車両１０が目標軌道（換言すれば、目標パス）に追従するように、電子制御パワーステアリング装置６００による舵角を制御する。
そして、車両制御システム１００は、自動運転において、車両１０が目標軌道（換言すれば、目標パス）に追従するように、電子制御パワーステアリング装置６００による舵角を制御する。
【0012】
車両制御システム１００は、車両状態検出装置２００、外界認識装置３００、自動運転制御装置４００、車両運動制御装置５００、電子制御パワーステアリング装置６００、ＥＳＣ（Electric Stability Control）ユニット７００を有する。
自動運転制御装置４００、車両運動制御装置５００、およびＥＳＣユニット７００は、入力した情報に基づいて演算を行って演算結果を出力するマイクロコンピュータ４００Ａ，５００Ａ，７００Ａを主体とする電子制御装置である。
自動運転制御装置４００、車両運動制御装置５００、およびＥＳＣユニット７００は、入力した情報に基づいて演算を行って演算結果を出力するマイクロコンピュータ４００Ａ，５００Ａ，７００Ａを主体とする電子制御装置である。
【0013】
マイクロコンピュータ４００Ａ，５００Ａ，７００Ａは、ＭＰＵ（Microprocessor Unit）、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random Access Memory）などを備える。
自動運転制御装置４００のマイクロコンピュータ４００Ａは、目標軌道を演算する軌道生成部４１０の機能を有する。
自動運転制御装置４００のマイクロコンピュータ４００Ａは、目標軌道を演算する軌道生成部４１０の機能を有する。
【0014】
軌道生成部４１０は、車両状態検出装置２００および外界認識装置３００を用いて、車両１０の位置情報（換言すれば、自車位置の情報）、車両の運転状態情報、および周辺情報を取得し、取得した各情報に基づき目標軌道を演算する。
そして、車両運動制御装置５００のマイクロコンピュータ５００Ａは、自動運転制御装置４００が演算した目標軌道に車両１０を追従させるための操舵制御指令、詳細には、舵角制御指令または操舵トルク制御指令を演算し、演算した操舵制御指令を電子制御パワーステアリング装置６００へ出力する。
そして、車両運動制御装置５００のマイクロコンピュータ５００Ａは、自動運転制御装置４００が演算した目標軌道に車両１０を追従させるための操舵制御指令、詳細には、舵角制御指令または操舵トルク制御指令を演算し、演算した操舵制御指令を電子制御パワーステアリング装置６００へ出力する。
【0015】
電子制御パワーステアリング装置６００は、車両１０の前輪１１Ｌ，１１Ｒの角度を変えることで車両１０の進行方向を変える操舵装置である。
電子制御パワーステアリング装置６００は、操舵輪である前輪１１Ｌ，１１Ｒの角度を変えるモータなどの操舵アクチュエータ６０１と、操舵アクチュエータ６０１を制御するアクチュエータ制御装置である操舵コントロールユニット６０２とを備える。
電子制御パワーステアリング装置６００は、操舵輪である前輪１１Ｌ，１１Ｒの角度を変えるモータなどの操舵アクチュエータ６０１と、操舵アクチュエータ６０１を制御するアクチュエータ制御装置である操舵コントロールユニット６０２とを備える。
【0016】
操舵コントロールユニット６０２は、車両運動制御装置５００から取得した操舵制御指令に基づき操舵アクチュエータ６０１を制御して、操舵制御指令に応じた舵角あるいは操舵トルクを実現させる。
つまり、車両制御システム１００においては、自動運転制御装置４００が車両１０の目標軌道を生成し、車両運動制御装置５００が車両１０を目標軌道に追従させるための制御指令を求め、操舵コントロールユニット６０２が制御指令を取得して操舵アクチュエータ６０１を制御する。
つまり、車両制御システム１００においては、自動運転制御装置４００が車両１０の目標軌道を生成し、車両運動制御装置５００が車両１０を目標軌道に追従させるための制御指令を求め、操舵コントロールユニット６０２が制御指令を取得して操舵アクチュエータ６０１を制御する。
【0017】
車両状態検出装置２００は、車輪速若しくは車速を検出する車輪速／車速センサ２１０、車両１０のヨーレートを検出するヨーレートセンサ２２０、車両１０の横加速度を検出する横Ｇセンサ２３０、前輪１１Ｌ，１１Ｒの舵角を検出する舵角センサ２４０を備える。
また、外界認識装置３００は、ステレオカメラ３１０、ナビゲーションシステム３２０、車車間通信装置３３０、レーダ３４０、全方位カメラ３５０を備える。
また、外界認識装置３００は、ステレオカメラ３１０、ナビゲーションシステム３２０、車車間通信装置３３０、レーダ３４０、全方位カメラ３５０を備える。
【0018】
ステレオカメラ３１０は、車両１０の周囲の対象物を検出・識別し、対象物までの距離などを求める。
つまり、ステレオカメラ３１０は、左右のカメラの見え方のずれから視差を計測し、三角測量の原理を用いて対象物までの距離を算出する。
つまり、ステレオカメラ３１０は、左右のカメラの見え方のずれから視差を計測し、三角測量の原理を用いて対象物までの距離を算出する。
【0019】
ナビゲーションシステム３２０は、ＧＰＳ（Global Positioning System）受信部及び地図データベースを備え、車両１０の現在位置の情報、目的地までの経路の情報などを取得する。
ナビゲーションシステム３２０のＧＰＳ受信部は、ＧＰＳ衛星から信号を受信することにより、車両１０の位置の緯度及び経度を測定する。
ナビゲーションシステム３２０のＧＰＳ受信部は、ＧＰＳ衛星から信号を受信することにより、車両１０の位置の緯度及び経度を測定する。
【0020】
ナビゲーションシステム３２０の地図データベースは、車両１０が搭載する記憶装置内に形成したデータベースであって、地図情報は、道路位置，道路形状，交差点位置などの情報を含む。
車車間通信装置３３０は、車両同士の無線通信によって、他の車両から、道路交通情報、他車の挙動情報、他車の位置情報などを取得する。
車車間通信装置３３０は、車両同士の無線通信によって、他の車両から、道路交通情報、他車の挙動情報、他車の位置情報などを取得する。
【0021】
レーダ３４０は、車両１０の前方障害物の検出、更に、前方障害物までの距離や前方障害物の速度の測定を行ない、前方障害物に関する情報として出力する。
全方位カメラ３５０は、車両１０の前後左右に装着された複数のカメラから得られた映像の視点を変換し、自車を上から見下ろしたような画像、つまり、俯瞰画像を得る装置である。
全方位カメラ３５０は、車両１０の前後左右に装着された複数のカメラから得られた映像の視点を変換し、自車を上から見下ろしたような画像、つまり、俯瞰画像を得る装置である。
【0022】
自動運転制御装置４００は、外界認識装置３００から取得した自車位置や自車周囲の物体の情報などに基づき自車周辺の状況を認識し、認識結果に基づき車両１０の走行経路の目標である目標軌道を生成する。
ここで、自動運転制御装置４００は、ＧＰＳによる測位、デッドレコニング、ステレオカメラ３１０などによる周辺状況の認識結果、更に、車車間通信によって周囲を走行する他車から得た情報などに基づき、車両１０の位置情報を取得する。
ここで、自動運転制御装置４００は、ＧＰＳによる測位、デッドレコニング、ステレオカメラ３１０などによる周辺状況の認識結果、更に、車車間通信によって周囲を走行する他車から得た情報などに基づき、車両１０の位置情報を取得する。
【0023】
デッドレコニングによる測位や、ステレオカメラ３１０などによる周辺状況の認識結果を用いて車両１０の位置情報を取得する方法は、車載センサの信号に基づき車両１０の位置に関する情報を取得する方法である。
デッドレコニングでは、たとえば、車両１０の車速、ヨー角に基づき車両１０の位置を推定する。
デッドレコニングでは、たとえば、車両１０の車速、ヨー角に基づき車両１０の位置を推定する。
【0024】
一方、ＧＰＳによる測位や、車車間通信によって周囲を走行する他車から得た情報などに基づき車両１０の位置情報を取得する方法は、車両１０の外部から受信した信号に基づき車両１０の位置に関する情報を取得する方法である。
そして、ＧＰＳによる測位では、車両１０の外部から受信した信号は、ＧＰＳ衛星から受信した信号、詳細には、時刻のデータ、衛星の軌道の情報などである。
また、車車間通信を用いた測位では、車両１０の外部から受信した信号は、車車間通信によって他車から受信した信号である。
そして、ＧＰＳによる測位では、車両１０の外部から受信した信号は、ＧＰＳ衛星から受信した信号、詳細には、時刻のデータ、衛星の軌道の情報などである。
また、車車間通信を用いた測位では、車両１０の外部から受信した信号は、車車間通信によって他車から受信した信号である。
【0025】
ＥＳＣユニット７００は、車両１０がスリップする挙動を検知した際に、車両１０の駆動装置の出力、および／または、車両１０の制動装置における個々の車輪のブレーキ圧を制御することで、車両１０の姿勢を安定に保つ制御を実施する。
ＥＳＣユニット７００は、車両状態検出装置２００から、車両１０の車速、横加速度、舵角、ヨーレートなどの情報を取得し、取得した車両情報に基づき運転者の運転操作および車両１０の動きを監視する。そして、ＥＳＣユニット７００は、運転者の運転操作および車両１０の動きに基づいて、車両１０の姿勢を安定に保つための機能を作動させる。
また、ＥＳＣユニット７００は、取得した車両情報に基づいて車両１０が走行する道路の左右勾配を推定し、推定した左右勾配の情報を車両運動制御装置５００に出力する。
ＥＳＣユニット７００は、車両状態検出装置２００から、車両１０の車速、横加速度、舵角、ヨーレートなどの情報を取得し、取得した車両情報に基づき運転者の運転操作および車両１０の動きを監視する。そして、ＥＳＣユニット７００は、運転者の運転操作および車両１０の動きに基づいて、車両１０の姿勢を安定に保つための機能を作動させる。
また、ＥＳＣユニット７００は、取得した車両情報に基づいて車両１０が走行する道路の左右勾配を推定し、推定した左右勾配の情報を車両運動制御装置５００に出力する。
【0026】
車両運動制御装置５００は、車両モデル５１０、制御部５２０、先読み補償部５３０、勾配補正値作成部５４０、勾配補正部５５０、制御量補正値作成部５６０、アクチュエータ制御部５７０を有する。
ここで、車両モデル５１０、制御部５２０、および、先読み補償部５３０は、車両１０を目標軌道に追従させるための制御指令を求める追従制御部５０１を構成する。
ここで、車両モデル５１０、制御部５２０、および、先読み補償部５３０は、車両１０を目標軌道に追従させるための制御指令を求める追従制御部５０１を構成する。
【0027】
追従制御部５０１は、自動運転制御装置４００が生成した目標軌道に車両１０を追従させるための制御指令である横加速度指令を、モデル予測制御（Model Predictive Control）を利用して演算する。
モデル予測制御は、制御対象のモデルを利用して未来の挙動を予測し、各時刻で最適化問題を解きながら制御対象の操作量を決定する、公知の制御方法である。
モデル予測制御は、制御対象のモデルを利用して未来の挙動を予測し、各時刻で最適化問題を解きながら制御対象の操作量を決定する、公知の制御方法である。
【0028】
車両運動制御装置５００（詳細には、追従制御部５０１）におけるモデル予測制御においては、車両モデル５１０を用いて所定の予測時間後（たとえば、500ms後）の応答を予測し、予測区間における追従誤差を小さくする横加速度指令yd2c（換言すれば、横加速度の目標値）を探索する。
係るモデル予測制御を利用すれば、電子制御パワーステアリング装置６００の操舵アクチュエータ６０１の応答遅れなどによって、車両１０の目標軌道への追従性が低下することを抑止でき、また、フィードフォワード制御により自然な軌道制御を実現できる。
係るモデル予測制御を利用すれば、電子制御パワーステアリング装置６００の操舵アクチュエータ６０１の応答遅れなどによって、車両１０の目標軌道への追従性が低下することを抑止でき、また、フィードフォワード制御により自然な軌道制御を実現できる。
【0029】
車両運動制御装置５００は、車両１０（換言すれば、車両１０の実軌道）と目標軌道との間の距離である左右方向の位置の差（以下、「左右偏差」と称する。）、車両１０の向き（換言すれば、目標軌道に対する車両１０の進行方向）、および、目標軌道の曲率の情報を取得する。
そして、車両運動制御装置５００は、左右偏差（換言すれば、横位置偏差）、車両１０の向き、および、目標軌道の曲率に基づいて、左右偏差が小さくなるように横加速度指令yd2cを算出する。
つまり、車両運動制御装置５００は、車両１０の目標軌道と車両１０の実軌道との左右方向の差に関する情報を取得する左右方向差取得部としての機能を有する。
そして、車両運動制御装置５００は、左右偏差（換言すれば、横位置偏差）、車両１０の向き、および、目標軌道の曲率に基づいて、左右偏差が小さくなるように横加速度指令yd2cを算出する。
つまり、車両運動制御装置５００は、車両１０の目標軌道と車両１０の実軌道との左右方向の差に関する情報を取得する左右方向差取得部としての機能を有する。
【0030】
【0031】
また、図２の軌道接線方向は、最近接点Ｐでの目標軌道の接線方向と平行で、車両１０の重心ＣＧを通る仮想線である。
そして、車両１０の重心ＣＧを原点とし、軌道接線方向をｘ軸、重心ＣＧから最近接点Ｐに向かう方向をｙ軸とする座標系を用いる。
そして、車両１０の重心ＣＧを原点とし、軌道接線方向をｘ軸、重心ＣＧから最近接点Ｐに向かう方向をｙ軸とする座標系を用いる。
【0032】
数式１は、横加速度指令yd2cの演算式である。
数式１において、Ｇ１，Ｇ２，Ｇ３は定数として与えられるゲイン、Ｒは目標軌道の曲率、Ｖは車速、Δyは車両１０の重心ＣＧと目標軌道との左右偏差（詳細には、車両１０の重心から最近接点までの距離）、Δyd1は目標軌道に向かう車両１０の速度、θは目標軌道の接線に対する車両１０の角度（換言すれば、向き）、yd2rは目標軌道の曲率Ｒに相当する遠心加速度である。
【数1】
【0033】
なお、左右偏差Δyは、自車位置の測位方法によって異なる物理量として取得される。たとえば、左右偏差Δyは、左右勾配が設けられている実際の路面上での左右偏差、つまり、路面に沿った長さの情報として取得される。或いは、左右偏差Δyは、左右勾配が設けられていないと仮定した仮想平面上での左右偏差、つまり、直線距離の情報として取得される。
図３は、直線距離の情報としての左右偏差Δyを示し、図４は、路面に沿った長さの情報としての左右偏差Δyを示す。
なお、図３および図４において、紙面を貫通する方向が車両１０の進行方向である。
図３は、直線距離の情報としての左右偏差Δyを示し、図４は、路面に沿った長さの情報としての左右偏差Δyを示す。
なお、図３および図４において、紙面を貫通する方向が車両１０の進行方向である。
【0034】
たとえば、車両制御システム１００が、ナビゲーションシステム３２０のＧＰＳ受信部を用いて自車位置を検出する場合、自車位置は緯度と経度とのＧＰＳ座標で検出されるため、路面の左右勾配は考慮されず、左右偏差Δyは、図３に示したように、直線距離の情報として求められる。
一方、車両制御システム１００が、車両運動に関する情報に基づくデッドレコニングによって自車位置を検出する場合、自車位置は、路面勾配の影響を加味して推定されることになるため、左右偏差Δyは、図４に示したように、路面に沿った長さの情報として求められる。
一方、車両制御システム１００が、車両運動に関する情報に基づくデッドレコニングによって自車位置を検出する場合、自車位置は、路面勾配の影響を加味して推定されることになるため、左右偏差Δyは、図４に示したように、路面に沿った長さの情報として求められる。
【0035】
更に、車両制御システム１００が、ステレオカメラ３１０、レーダ３４０、全方位カメラ３５０などによる外界認識の結果に基づき自車位置を検出する場合、実際に路面上を走行している車両１０の外界を認識するので、左右偏差Δyは、図４に示したように、路面に沿った長さの情報として求められる。
但し、外界認識の結果に基づき求めた自車位置の情報を路面の左右勾配に応じて補正する場合や、外界認識の結果に基づき地図データを参照して自車位置を推定する場合などでは、左右偏差Δyは、図３に示したように、直線距離の情報として求められる。
但し、外界認識の結果に基づき求めた自車位置の情報を路面の左右勾配に応じて補正する場合や、外界認識の結果に基づき地図データを参照して自車位置を推定する場合などでは、左右偏差Δyは、図３に示したように、直線距離の情報として求められる。
【0036】
アクチュエータ制御部５７０は、追従制御部５０１から取得した横加速度指令yd2cを、舵角あるいは操舵トルクの制御指令である操舵制御指令に変換し、係る操舵制御指令を電子制御パワーステアリング装置６００の操舵コントロールユニット６０２に出力する。
そして、操舵コントロールユニット６０２は、取得した操舵制御指令に基づき操舵アクチュエータ６０１を制御することで、横加速度指令yd2cを実現させる。
そして、操舵コントロールユニット６０２は、取得した操舵制御指令に基づき操舵アクチュエータ６０１を制御することで、横加速度指令yd2cを実現させる。
【0037】
一方、勾配補正値作成部５４０、勾配補正部５５０、および、制御量補正値作成部５６０は、車両１０の軌道を左右方向に偏向させる外乱量を左右偏差Δyの情報を用いて推定し、推定した外乱量を用いて横加速度指令yd2c（または操舵制御指令）を補正する。
つまり、車両運動制御装置５００は、左右偏差Δyの情報を用いて、左右偏差Δyに相当する外乱量を推定する外乱推定部、および、推定した外乱量を用いて、車両１０を目標軌道に追従させるための制御指令を求める追従制御部の機能を備える。
つまり、車両運動制御装置５００は、左右偏差Δyの情報を用いて、左右偏差Δyに相当する外乱量を推定する外乱推定部、および、推定した外乱量を用いて、車両１０を目標軌道に追従させるための制御指令を求める追従制御部の機能を備える。
【0038】
ここで、車両１０の軌道を左右方向に偏向させる外乱は、道路の左右勾配、横風などの車両１０に作用することで車両１０の軌道を左右方向に偏向させる外力、および、車両１０の軌道を左右方向に偏向させることになるホイールアライメントなどの車両特性を含む。
たとえば、道路に左右勾配があると、車両１０の実軌道が重力によって目標軌道から勾配の低い方へずれ、目標軌道への追従性が低下する場合がある。
また、車両１０の進行方向に対して直交する方向の横風が吹いている場合、風圧によって車両１０の実軌道が目標軌道から風下方向にずれ、目標軌道への追従性が低下する場合がある。
たとえば、道路に左右勾配があると、車両１０の実軌道が重力によって目標軌道から勾配の低い方へずれ、目標軌道への追従性が低下する場合がある。
また、車両１０の進行方向に対して直交する方向の横風が吹いている場合、風圧によって車両１０の実軌道が目標軌道から風下方向にずれ、目標軌道への追従性が低下する場合がある。
【0039】
図５は、左右勾配を有する道路での左右偏差Δyの発生状態を示す。
図５の場合、車両１０の進行方向の右側が高く左側が低い左右勾配を有する道路であるため、重力によって車両１０の軌道が目標軌道よりも左側（換言すれば、勾配の低い側）にずれて左右偏差Δyが発生する。
図５の場合、車両１０の進行方向の右側が高く左側が低い左右勾配を有する道路であるため、重力によって車両１０の軌道が目標軌道よりも左側（換言すれば、勾配の低い側）にずれて左右偏差Δyが発生する。
【0040】
左右勾配や風などの外乱によって左右偏差Δyが発生すれば、追従制御部５０１が数式１を用いて求める横加速度指令yd2cは、左右偏差Δyを小さくする方向に変更される。
しかし、数式１を用いた横加速度指令yd2cの算出処理は、外乱のない状態での左右偏差Δyの縮小に適合するものであるため、数式１から算出された横加速度指令yd2cにしたがって操舵制御が実施されても、目標軌道への収束が遅れたり、定常偏差が生じる場合がある。
しかし、数式１を用いた横加速度指令yd2cの算出処理は、外乱のない状態での左右偏差Δyの縮小に適合するものであるため、数式１から算出された横加速度指令yd2cにしたがって操舵制御が実施されても、目標軌道への収束が遅れたり、定常偏差が生じる場合がある。
【0041】
そこで、車両運動制御装置５００は、左右勾配や横風などの外乱量を推定し、数式１にしたがって算出した横加速度指令yd2c（または操舵制御指令）を、推定した外乱量に基づき補正することで、目標軌道への追従性が外乱によって低下することを抑止する。
なお、左右勾配にのみ着目すると、数式１は、車両１０が走行する路面の左右勾配が零であると仮定して横加速度指令yd2cを導出する式である。したがって、車両運動制御装置５００は、目標軌道における路面の左右勾配と、車両１０の実軌道における路面の左右勾配との差を補償するように、横加速度指令yd2c（または操舵制御指令）を補正することになる。
なお、左右勾配にのみ着目すると、数式１は、車両１０が走行する路面の左右勾配が零であると仮定して横加速度指令yd2cを導出する式である。したがって、車両運動制御装置５００は、目標軌道における路面の左右勾配と、車両１０の実軌道における路面の左右勾配との差を補償するように、横加速度指令yd2c（または操舵制御指令）を補正することになる。
【0042】
図１に示した車両制御システム１００は、車両運動制御装置５００は、ＥＳＣユニット７００から左右勾配の推定値の情報を取得するが、係る左右勾配の推定値は、外乱に対する追従性の低下を抑止するための制御に用いるには精度が低い。
そこで、勾配補正値作成部５４０は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1［deg］を補正するための左右勾配補正値ΔLRGを、左右偏差Δyを用いて求める。
そこで、勾配補正値作成部５４０は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1［deg］を補正するための左右勾配補正値ΔLRGを、左右偏差Δyを用いて求める。
【0043】
そして、勾配補正部５５０は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1を、勾配補正値作成部５４０が作成した左右勾配補正値ΔLRGで補正して、最終的な左右勾配推定値LRGを求める。
これにより、左右勾配推定値LRGは、左右勾配、横風、更に、車両特性などの車両１０を偏向させる各種外乱を、高い精度で反映した値になる。
制御量補正値作成部５６０は、制御量補正値を左右勾配推定値LRG（換言すれば、外乱量の推定値）に基づき求め、求めた制御量補正値で、数式１にしたがって算出された横加速度指令yd2c（または、数式１にしたがって算出された横加速度指令yd2cに基づく操舵制御指令）を補正する。
これにより、左右勾配推定値LRGは、左右勾配、横風、更に、車両特性などの車両１０を偏向させる各種外乱を、高い精度で反映した値になる。
制御量補正値作成部５６０は、制御量補正値を左右勾配推定値LRG（換言すれば、外乱量の推定値）に基づき求め、求めた制御量補正値で、数式１にしたがって算出された横加速度指令yd2c（または、数式１にしたがって算出された横加速度指令yd2cに基づく操舵制御指令）を補正する。
【0044】
たとえば、左右勾配を有する道路を車両１０が走行する場合、左右勾配の低い方向に向けて重力の分力が発生し、車両１０がこの分力に引っ張られるため、目標軌道と実軌道とに左右偏差Δyが生じる。
そこで、勾配補正値作成部５４０は、左右偏差Δyに基づき制御した横加速度と、重力加速度の分力とが釣り合うと仮定して、左右勾配補正値ΔLRGを求める。
そこで、勾配補正値作成部５４０は、左右偏差Δyに基づき制御した横加速度と、重力加速度の分力とが釣り合うと仮定して、左右勾配補正値ΔLRGを求める。
【0045】
左右偏差Δyに基づき制御した横加速度と重力加速度の分力とが釣り合うと仮定すると、数式１から数式２が導かれる。
【数2】
【0046】
ここで、左右偏差Δyを一定と仮定して、角度θおよび曲率Ｒを零とすると、数式２は数式３に変換される。
【数3】
【0047】
したがって、左右勾配補正値ΔLRGは、ゲインＧ１が１であるとすると、数式４から求めることができる。
つまり、左右勾配補正値ΔLRGは、重力加速度の分力［m／s2］と、重力加速度［9.8m／s2］のアークサインで導出することができる。
【数4】
【0048】
たとえば、左右偏差Δyが0.2mであったとすると、左右勾配補正値ΔLRGは、数式５に示すようにΔLRG＝1.169［deg］となる。
【数5】
【0049】
勾配補正部５５０は、勾配補正値作成部５４０が求めた左右勾配補正値ΔLRGの情報、および、ＥＳＣユニット７００が推定した左右勾配推定値LRG1を取得し、数式６にしたがって、最終的な左右勾配推定値LRG［deg］を求める。
【数6】
【0050】
たとえば、左右偏差Δyが零で、車両１０の実軌道が目標軌道に追従できている場合、勾配補正値作成部５４０は、左右勾配補正値ΔLRGを0［deg］に算出し、勾配補正部５５０は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1をそのまま最終的な左右勾配推定値LRGに設定する。
一方、車両１０が目標軌道に対して左右勾配の低い方を走行している場合、勾配補正値作成部５４０は、左右勾配推定値LRG1を増大補正する左右勾配補正値ΔLRGを算出し、勾配補正部５５０は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1を左右勾配補正値ΔLRGで増大させた結果を最終的な左右勾配推定値LRGに設定する。
一方、車両１０が目標軌道に対して左右勾配の低い方を走行している場合、勾配補正値作成部５４０は、左右勾配推定値LRG1を増大補正する左右勾配補正値ΔLRGを算出し、勾配補正部５５０は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1を左右勾配補正値ΔLRGで増大させた結果を最終的な左右勾配推定値LRGに設定する。
【0051】
また、車両１０が目標軌道に対して左右勾配の高い方を走行している場合、勾配補正値作成部５４０は、左右勾配推定値LRG1を減少補正する左右勾配補正値ΔLRGを算出する。
勾配補正部５５０は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1を左右勾配補正値ΔLRGで減少させた結果を最終的な左右勾配推定値LRGに設定する。
つまり、左右偏差Δyは、ＥＳＣユニット７００による左右勾配推定値LRG1の推定誤差や横風、車両特性のばらつきなどに影響されて発生する。したがって、左右偏差Δyに基づく左右勾配補正値ΔLRGで左右勾配推定値LRG1を補正した結果としての左右勾配推定値LRGは、左右勾配や横風などの外乱量を高い精度で表す情報となる。
勾配補正部５５０は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1を左右勾配補正値ΔLRGで減少させた結果を最終的な左右勾配推定値LRGに設定する。
つまり、左右偏差Δyは、ＥＳＣユニット７００による左右勾配推定値LRG1の推定誤差や横風、車両特性のばらつきなどに影響されて発生する。したがって、左右偏差Δyに基づく左右勾配補正値ΔLRGで左右勾配推定値LRG1を補正した結果としての左右勾配推定値LRGは、左右勾配や横風などの外乱量を高い精度で表す情報となる。
【0052】
制御量補正値作成部５６０は、勾配補正部５５０から左右勾配推定値LRGの情報を取得し、左右勾配推定値LRGに基づき、左右勾配による左右偏差Δyの発生を抑止する制御量補正値を求める。
前述した数式１では、左右勾配や横風などの車両１０を偏向させる外乱を考慮せず、左右偏差Δyを小さくするように横加速度指令yd2cが算出されるため、外乱が発生すると目標軌道への追従性が低下する。
前述した数式１では、左右勾配や横風などの車両１０を偏向させる外乱を考慮せず、左右偏差Δyを小さくするように横加速度指令yd2cが算出されるため、外乱が発生すると目標軌道への追従性が低下する。
【0053】
そこで、制御量補正値作成部５６０は、数式１にしたがって算出した横加速度指令yd2cを外乱量（つまり、左右勾配推定値LRG）に応じて補正することで、横加速度指令yd2cを、外乱量を見込んだ値に修正する。
係る左右勾配推定値LRGに応じた横加速度指令yd2cの補正処理によって、外乱があっても目標軌道への追従性が低下することが抑止される。
係る左右勾配推定値LRGに応じた横加速度指令yd2cの補正処理によって、外乱があっても目標軌道への追従性が低下することが抑止される。
【0054】
なお、車両１０の発進時などにおいては、大きな左右偏差Δyが検出される場合があり、係る左右偏差Δyを基づき左右勾配補正値ΔLRGが算出されると、目標軌道への追従性を低下させる可能性がある。
そこで、勾配補正値作成部５４０は、左右偏差Δyが上限値よりも大きい場合、左右勾配補正値ΔLRGを零とすることで、左右勾配推定値LRG1をそのまま用いて横加速度指令yd2cの補正処理が実施されるようにする。
そこで、勾配補正値作成部５４０は、左右偏差Δyが上限値よりも大きい場合、左右勾配補正値ΔLRGを零とすることで、左右勾配推定値LRG1をそのまま用いて横加速度指令yd2cの補正処理が実施されるようにする。
【0055】
ここで、前記上限値は、車両１０の発進時などに限って左右偏差Δyが超える値として設定される。
つまり、車両運動制御装置５００は、左右偏差Δyが所定範囲外であるとき、左右偏差Δyの情報を用いた外乱量の推定を行わない。
また、車両１０が目標軌道を使わずに走行している場合、勾配補正値作成部５４０及び勾配補正部５５０は、左右勾配推定値LRG1の補正は停止する。
つまり、車両運動制御装置５００は、左右偏差Δyが所定範囲外であるとき、左右偏差Δyの情報を用いた外乱量の推定を行わない。
また、車両１０が目標軌道を使わずに走行している場合、勾配補正値作成部５４０及び勾配補正部５５０は、左右勾配推定値LRG1の補正は停止する。
【0056】
更に、道路の左右勾配は、道路の構造上急に変化しないため、勾配補正値作成部５４０若しくは勾配補正部５５０は、左右偏差Δyが急に変化した場合であっても、左右勾配補正値ΔLRG若しくは最終的な左右勾配推定値LRGを徐々に変化させ、引いては、横加速度指令yd2cの変化速度を所定範囲内に制限する。
図６および図７は、左右偏差Δyの急変に対する左右勾配推定値LRG（又は左右勾配補正値ΔLRG）の変化を示す図である。図６は、左右偏差Δyの急変を最終的な左右勾配推定値LRGにそのまま反映させた場合を示す。図７は、左右偏差Δyの急変に対し最終的な左右勾配推定値LRGを徐々に追従させた場合を示す。
図６および図７は、左右偏差Δyの急変に対する左右勾配推定値LRG（又は左右勾配補正値ΔLRG）の変化を示す図である。図６は、左右偏差Δyの急変を最終的な左右勾配推定値LRGにそのまま反映させた場合を示す。図７は、左右偏差Δyの急変に対し最終的な左右勾配推定値LRGを徐々に追従させた場合を示す。
【0057】
図６の場合、左右偏差Δyの急変に応じて最終的な左右勾配推定値LRGも急変する。これに対し、図７の場合、左右勾配推定値LRG若しくは左右勾配補正値ΔLRGの演算周期当たりの変化量を上限値に基づき制限するので、左右偏差Δyが急変しても、最終的な左右勾配推定値LRGは徐々に変化する。
このように、左右偏差Δyが急変しても最終的な左右勾配推定値LRGを徐々に変化させれば、左右偏差Δyの急変に伴って横加速度指令yd2cが急変することが抑止され、舵角の急変を抑止して滑らかな車両運動を実現できる。
このように、左右偏差Δyが急変しても最終的な左右勾配推定値LRGを徐々に変化させれば、左右偏差Δyの急変に伴って横加速度指令yd2cが急変することが抑止され、舵角の急変を抑止して滑らかな車両運動を実現できる。
【0058】
また、追従制御部５０１が、前述したようにモデル予測制御を実施する場合、勾配補正値作成部５４０は、左右偏差Δyの予測値と実際値との差、換言すれば、過去の時点での予測値と現在の実際値との差から左右勾配補正値ΔLRGを算出することができる。
たとえば、追従制御部５０１が、500ms後の左右偏差Δyz-50を推定する場合、勾配補正値作成部５４０は、数式７に示すように、500ms前の予測値である左右偏差Δyz-50と、現時点での実際値である左右偏差Δyとの差（換言すれば、予測誤差）に基づき、左右勾配補正値ΔLRGを算出する。
たとえば、追従制御部５０１が、500ms後の左右偏差Δyz-50を推定する場合、勾配補正値作成部５４０は、数式７に示すように、500ms前の予測値である左右偏差Δyz-50と、現時点での実際値である左右偏差Δyとの差（換言すれば、予測誤差）に基づき、左右勾配補正値ΔLRGを算出する。
【0059】
【数7】
【0060】
ところで、図１に示した車両制御システム１００において、車両運動制御装置５００は、ＥＳＣユニット７００が推定した左右勾配推定値LRG1の情報を取得するが、左右勾配を推定する外部の電子制御装置をＥＳＣユニット７００に限定するものではない。
たとえば、車両１０がアクティブサスペンションを備える場合、車両運動制御装置５００は、アクティブサスペンションの電子制御装置がＧセンサ（加速度センサ）の検出出力に基づき推定した左右勾配の情報を取得し、取得した左右勾配推定値を左右偏差Δyに基づき補正することができる。
たとえば、車両１０がアクティブサスペンションを備える場合、車両運動制御装置５００は、アクティブサスペンションの電子制御装置がＧセンサ（加速度センサ）の検出出力に基づき推定した左右勾配の情報を取得し、取得した左右勾配推定値を左右偏差Δyに基づき補正することができる。
【0061】
アクティブサスペンションは、サスペンションに油圧の力を加えることで車両１０の動きをコントロールする装置である。係るアクティブサスペンションは、一般的に、路面の凹凸や車両１０の走行状態に応じて発生する振動や動揺を検出する加速度センサを有する。
そして、アクティブサスペンションの電子制御装置は、加速度センサの検出出力から左右勾配を推定することができる。
そして、アクティブサスペンションの電子制御装置は、加速度センサの検出出力から左右勾配を推定することができる。
【0062】
また、ステレオカメラ３１０の画像処理装置若しくはステレオカメラ３１０の画像を取得する自動運転制御装置４００において、ステレオカメラ３１０の画像から求められた左右勾配の情報を、車両運動制御装置５００が取得するシステムとすることができる。
更に、車両運動制御装置５００は、外部から取得した左右勾配推定値LRG1の情報を左右偏差Δyに基づき補正して追従制御に用いる左右勾配推定値LRGの情報を得る代わりに、左右偏差Δyの情報から追従制御に用いる左右勾配推定値LRGの情報を直接求めることができる。
更に、車両運動制御装置５００は、外部から取得した左右勾配推定値LRG1の情報を左右偏差Δyに基づき補正して追従制御に用いる左右勾配推定値LRGの情報を得る代わりに、左右偏差Δyの情報から追従制御に用いる左右勾配推定値LRGの情報を直接求めることができる。
【0063】
図８は、車両制御システム１００の第２実施形態を示すブロック図であって、この図８に示す車両運動制御装置５００は、左右偏差Δyの情報から追従制御に用いる左右勾配推定値LRGの情報を直接算出する。
図８の車両運動制御装置５００は、図１の車両運動制御装置５００における勾配補正値作成部５４０および勾配補正部５５０に代えて、勾配推定部５８０を有する。
図８の車両運動制御装置５００は、図１の車両運動制御装置５００における勾配補正値作成部５４０および勾配補正部５５０に代えて、勾配推定部５８０を有する。
【0064】
勾配推定部５８０は、左右偏差Δyの情報を取得し、左右勾配推定値LRGの情報を出力する。
詳細には、勾配推定部５８０は、数式４または数式７にしたがって算出される角度の情報をそのまま左右勾配推定値LRGとし、制御量補正値作成部５６０に出力する。
そして、制御量補正値作成部５６０は、横加速度指令yd2cを車両１０を偏向させる外乱に応じて補正するための補正値を、勾配推定部５８０から取得した左右勾配推定値LRGに基づき求める。
詳細には、勾配推定部５８０は、数式４または数式７にしたがって算出される角度の情報をそのまま左右勾配推定値LRGとし、制御量補正値作成部５６０に出力する。
そして、制御量補正値作成部５６０は、横加速度指令yd2cを車両１０を偏向させる外乱に応じて補正するための補正値を、勾配推定部５８０から取得した左右勾配推定値LRGに基づき求める。
【0065】
図８の車両制御システム１００においても、左右勾配を含む外乱量を見込んだ横加速度指令yd2cを設定でき、外乱によって目標軌道への追従性が低下することを抑止できる。
また、図８の車両制御システム１００では、車両運動制御装置５００が外部から左右勾配推定値LRG1の情報を取得する必要がなく、また、車両運動制御装置５００において左右勾配推定値の補正処理が不要となり、車両運動制御装置５００の構成、処理を簡略化できる。
また、図８の車両制御システム１００では、車両運動制御装置５００が外部から左右勾配推定値LRG1の情報を取得する必要がなく、また、車両運動制御装置５００において左右勾配推定値の補正処理が不要となり、車両運動制御装置５００の構成、処理を簡略化できる。
【0066】
また、車両運動制御装置５００は、車両１０の横加速度、ヨーレート、車速などの車両運動情報から左右勾配を推定する機能、更に、左右偏差Δyに基づき左右勾配推定値を補正する機能を備えることができる。
図９は、車両制御システム１００の第３実施形態を示すブロック図である。
図９に示す車両運動制御装置５００は、横加速度、ヨーレート、車速から左右勾配推定値LRG2を求める一方、左右偏差Δyの情報に基づき左右勾配補正値ΔLRGを求める。そして、車両運動制御装置５００は、左右勾配推定値LRG2を左右勾配補正値ΔLRGで補正して得た左右勾配推定値LRGに基づいて追従制御を実施する。
図９は、車両制御システム１００の第３実施形態を示すブロック図である。
図９に示す車両運動制御装置５００は、横加速度、ヨーレート、車速から左右勾配推定値LRG2を求める一方、左右偏差Δyの情報に基づき左右勾配補正値ΔLRGを求める。そして、車両運動制御装置５００は、左右勾配推定値LRG2を左右勾配補正値ΔLRGで補正して得た左右勾配推定値LRGに基づいて追従制御を実施する。
【0067】
図９の車両運動制御装置５００は、図１の車両運動制御装置５００に対し、車両状態検出装置２００から取得した車両運動状態の情報に基づき左右勾配を推定する勾配推定部５９０が付加されている。
図１０は、勾配推定部５９０における、車両運動状態の情報、詳細には、ヨーレート、車速、および横加速度に基づく左右勾配推定値LRG2の算出処理を説明するための図である。
図１０は、勾配推定部５９０における、車両運動状態の情報、詳細には、ヨーレート、車速、および横加速度に基づく左右勾配推定値LRG2の算出処理を説明するための図である。
【0068】
勾配推定部５９０は、まず、車両１０にかかる遠心力を、ヨーレートの検出値および車速の検出値に基づき求める。
遠心力＝ヨーレート×車速
遠心力＝ヨーレート×車速
【0069】
次いで、勾配推定部５９０は、車両１０に対し横方向にかかる力を、遠心力の算出結果、および、横加速度の検出値に基づき求める。
横方向にかかる力［Ｇ］＝横加速度－遠心力
横方向にかかる力［Ｇ］＝横加速度－遠心力
【0070】
そして、勾配推定部５９０は、左右勾配推定値LRG2を、横方向にかかる力の算出結果に基づき求める。
左右勾配推定値LRG2＝sin-1（横方向にかかる力）
左右勾配推定値LRG2＝sin-1（横方向にかかる力）
【0071】
一方、勾配補正値作成部５４０は、図１に示した車両制御システム１００の勾配補正値作成部５４０と同様に、数式４または数式７にしたがって、左右偏差Δyに基づき左右勾配補正値ΔLRGを求める。
勾配補正部５５０は、勾配推定部５９０が求めた左右勾配推定値LRG2と、勾配補正値作成部５４０が求めた左右勾配補正値ΔLRGとを取得し、左右勾配推定値LRG2を左右勾配補正値ΔLRGで補正した結果を、最終的な左右勾配推定値LRGに設定する。
勾配補正部５５０は、勾配推定部５９０が求めた左右勾配推定値LRG2と、勾配補正値作成部５４０が求めた左右勾配補正値ΔLRGとを取得し、左右勾配推定値LRG2を左右勾配補正値ΔLRGで補正した結果を、最終的な左右勾配推定値LRGに設定する。
【0072】
つまり、図９に示した車両運動制御装置５００は、左右偏差Δyに関する情報とともに、車両１０の横加速度に関する情報、車両１０のヨーレートに関する情報、および車両１０の車速に関する情報を用いて、車両１０を偏向させる外乱量を推定する。
図９の車両制御システム１００においても、左右勾配を含む外乱量を見込んだ横加速度指令yd2cを設定でき、外乱によって目標軌道への追従性が低下することを抑止できる。
図９の車両制御システム１００においても、左右勾配を含む外乱量を見込んだ横加速度指令yd2cを設定でき、外乱によって目標軌道への追従性が低下することを抑止できる。
【0073】
ところで、車両運動制御装置５００（詳細には、アクチュエータ制御部５７０）は、車両１０の実軌道を目標軌道に追従させるための制御として、電子制御パワーステアリング装置６００による操舵を制御する機能とともに、制動装置における制動力指令の左右配分（換言すれば、制動力の左右差）を変更する制御機能を備えることができる。
図１１は、車両運動制御装置５００が、操舵制御機能及び制動制御機能を備える、車両制御システム１００を示すブロック図である。
図１１に示すアクチュエータ制御部５７０は、車両１０の実軌道を目標軌道に追従させるために、操舵装置である電子制御パワーステアリング装置６００による操舵と制動装置９００による制動力とを制御する。
図１１は、車両運動制御装置５００が、操舵制御機能及び制動制御機能を備える、車両制御システム１００を示すブロック図である。
図１１に示すアクチュエータ制御部５７０は、車両１０の実軌道を目標軌道に追従させるために、操舵装置である電子制御パワーステアリング装置６００による操舵と制動装置９００による制動力とを制御する。
【0074】
制動装置９００は、車両１０の各車輪の制動力を個別に調整することが可能な制動装置であって、たとえば、各車輪に供給するブレーキ液圧を個別に調整可能な油圧式の制動装置である。
そして、アクチュエータ制御部５７０は、横加速度指令yd2cを、舵角あるいは操舵トルクの指令である操舵制御指令と、ブレーキ液圧指令（詳細には、ブレーキ液圧の左右配分指令）とに変換し、操舵制御指令を電子制御パワーステアリング装置６００に出力し、ブレーキ液圧指令を制動装置９００に出力する。
そして、アクチュエータ制御部５７０は、横加速度指令yd2cを、舵角あるいは操舵トルクの指令である操舵制御指令と、ブレーキ液圧指令（詳細には、ブレーキ液圧の左右配分指令）とに変換し、操舵制御指令を電子制御パワーステアリング装置６００に出力し、ブレーキ液圧指令を制動装置９００に出力する。
【0075】
つまり、車両運動制御装置５００は、電子制御パワーステアリング装置６００による操舵と制動装置９００による制動力との少なくとも一方を制御することで、横加速度指令yd2cを実現することができる。
たとえば、車両運動制御装置５００は、電子制御パワーステアリング装置６００による操舵の制御を主体として車両１０の実軌道を目標軌道に追従させるようにし、制動力の左右差を変えることで目標軌道と実軌道との偏差を微修正することができる。
たとえば、車両運動制御装置５００は、電子制御パワーステアリング装置６００による操舵の制御を主体として車両１０の実軌道を目標軌道に追従させるようにし、制動力の左右差を変えることで目標軌道と実軌道との偏差を微修正することができる。
【0076】
また、車両運動制御装置５００のアクチュエータ制御部５７０は、電子制御パワーステアリング装置６００による操舵を制御する機能とともに、車両１０の駆動装置による左右輪での駆動力の差を制御する機能を備える。
そして、アクチュエータ制御部５７０は、電子制御パワーステアリング装置６００による操舵と駆動装置による駆動力との少なくとも一方を制御することで、横加速度指令yd2cを実現することができる。
そして、アクチュエータ制御部５７０は、電子制御パワーステアリング装置６００による操舵と駆動装置による駆動力との少なくとも一方を制御することで、横加速度指令yd2cを実現することができる。
【0077】
更に、車両運動制御装置５００のアクチュエータ制御部５７０は、電子制御パワーステアリング装置６００による操舵と、制動装置９００による制動力と、駆動装置による駆動力とを制御することで、横加速度指令yd2cを実現することができる。
つまり、車両運動制御装置５００のアクチュエータ制御部５７０は、車両１０の操舵装置および制駆動装置のうちの少なくとも１つを制御することで、横加速度指令yd2cを実現することができる。
つまり、車両運動制御装置５００のアクチュエータ制御部５７０は、車両１０の操舵装置および制駆動装置のうちの少なくとも１つを制御することで、横加速度指令yd2cを実現することができる。
【0078】
上記実施形態で説明した各技術的思想は、矛盾が生じない限りにおいて、適宜組み合わせて使用することができる。
また、好ましい実施形態を参照して本発明の内容を具体的に説明したが、本発明の基本的技術思想及び教示に基づいて、当業者であれば、種々の変形態様を採り得ることは自明である。
また、好ましい実施形態を参照して本発明の内容を具体的に説明したが、本発明の基本的技術思想及び教示に基づいて、当業者であれば、種々の変形態様を採り得ることは自明である。
【0079】
たとえば、車両１０の目標軌道の作成と、車両１０の実軌道を目標軌道に追従させるための制御指令の作成とを、１つの制御装置で実施するシステムとすることができる。
また、車両運動制御装置５００における横加速度指令yd2cの演算処理を、モデル予測制御を用いた処理に限定するものではなく、モデル予測制御を用いない処理とすることができる。
また、左右偏差Δyは、たとえば、前方注視点での左右偏差としたり、車両１０の左右方向での車両１０から目標軌道までの距離を左右偏差Δyとしたりすることができ、図２に示した左右偏差Δyの特定に限定するものではない。
また、車両運動制御装置５００における横加速度指令yd2cの演算処理を、モデル予測制御を用いた処理に限定するものではなく、モデル予測制御を用いない処理とすることができる。
また、左右偏差Δyは、たとえば、前方注視点での左右偏差としたり、車両１０の左右方向での車両１０から目標軌道までの距離を左右偏差Δyとしたりすることができ、図２に示した左右偏差Δyの特定に限定するものではない。
【符号の説明】
【0080】
１０…車両、１００…車両制御システム、２００…車両状態検出装置、３００…外界認識装置、４００…自動運転制御装置（第１制御装置）、５００…車両運動制御装置（第２制御装置、車両制御装置）、６００…電子制御パワーステアリング装置（操舵装置）、６０２…操舵コントロールユニット（アクチュエータ制御装置）、７００…ＥＳＣユニット
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】