(57)【特許請求の範囲】
【請求項１】
自車両前方のカーブ形状を取得するカーブ形状取得手段と、
自車両の位置を取得する自車位置取得手段と、
前記カーブ形状及び前記自車両の位置に基づいて、車両に発生させる前後加速度指令値を演算する車両運動制御演算手段と、を有し、
前記車両運動制御演算手段は、自車両進行方向を正とする前後加速度指令値において、自車両がカーブ前からカーブに進入し、カーブ曲率が一定、もしくは最大になる地点まで走行する際に、負の前後加速度指令値を演算すると共に、該前後加速度指令値は、前記車両運動制御演算手段によって予め演算された自車両前方のカーブ走行時に発生するであろう最大横加速度推定値、自車両前方の道路勾配、ドライバのペダル操作、及び旋回方向のうちの少なくとも一つに基づいて変化するものであり、
前記車両運動制御演算手段は、自車両の位置を原点として、前記自車両の位置から予め定めた距離、もしくは車両速度と予め定めた時間の積により得られる距離の位置におけるカーブ曲率の時間変化に基づいて、前後加速度の時間変化である前後加加速度の増減を発生させる前記前後加速度指令値の減少を生成することを特徴とする車両運動制御装置。
【請求項２】
自車両前方のカーブ形状を取得するカーブ形状取得手段と、
自車両の位置を取得する自車位置取得手段と、
自車両の速度と前後加速度の少なくとも一つの車両運動情報を取得する車両運動情報取得手段と、
ドライバから要求するドライバ要求前後加速度を取得するドライバ入力情報取得手段と、
車両の横加加速度に基づく横運動連係前後加速度を取得する横運動連係前後加速度取得手段と、
自車両が走行する路面の路面摩擦係数及び路面縦断勾配の路面情報を取得する路面情報取得手段と、
前記カーブ形状と、前記自車両の位置と、前記車両運動情報と、前記ドライバ要求前後加速度と、前記横運動連係前後加速度と、前記路面情報と、に基づいて、車両に発生させる前後加速度指令値を演算する車両運動制御演算手段と、を有し、
前記ドライバ入力情報取得手段は、前後加速度制御スイッチのＯＮ又はＯＦＦを検知し、前後加速度制御スイッチＯＮ／ＯＦＦ情報を出力し、
前記車両運動制御演算手段は、自車両進行方向を正とする前後加速度指令値において、自車両がカーブ前からカーブに進入し、カーブ曲率が一定、もしくは最大になる地点まで走行する際に、負の前後加速度指令値を演算すると共に、該前後加速度指令値は、前記車両運動制御演算手段によって予め演算された自車両前方のカーブ走行時に発生するであろう最大横加速度推定値、自車両前方の道路勾配、ドライバのペダル操作、及び旋回方向のうちの少なくとも一つに基づいて変化するものであり、
前記車両運動制御演算手段は、
自車両進行方向のコース上に複数の予め定めた前方注視点を設定し、前記自車両の位置から前記前方注視点までの前方注視距離を算出する前方注視距離算出手段と、
前記前後加速度制御スイッチＯＮ／ＯＦＦ情報と、前記自車両の速度と、前記カーブ形状と、前記自車両の位置と、前記横運動連係前後加速度と、に基づいて前後加速度制御モードを演算する前後加速度制御モード演算手段と、
演算された前記前後加速度制御モードに基づいて、前記前方注視距離におけるカーブ曲率及びカーブ曲率の時間変化を算出するカーブ曲率算出手段と、
前記最大横加速度推定値、前記自車両前方の道路勾配、前記ドライバのペダル操作、及び前記旋回方向のうちの少なくとも一つに基づいて前記前後加速度指令値を変化させる比例ゲインを演算する比例ゲイン演算部と、
前記前方注視距離におけるカーブ曲率及びカーブ曲率の時間変化と、前記自車両の速度と、前記比例ゲインと、に基づいて前後加速度指令値を演算する前後加速度指令値演算手段と、
演算された前記前後加速度制御モードに基づいて、演算された前記前後加速度指令値を実現する制御指令値を出力する制御指令値出力手段と、を備えることを特徴とする車両運動制御装置。
【請求項３】
前記車両運動制御演算手段は、複数の異なる負の前後加速度指令値を演算することを特徴とする請求項１又は２に記載の車両運動制御装置。
【請求項４】
前記車両運動制御演算手段は、前後加速度の時間変化である前後加加速度が、減速開始直後以外にカーブ進入前からカーブ曲率が一定、もしくは最大になる期間において増減される負の前後加速度指令値を演算することを特徴とする請求項１又は２に記載の車両運動制御装置。
【請求項５】
前記複数の異なる前後加速度指令値は、前記カーブ前に自車両に最初の減速度を発生させ、その後略一定となる第１の前後加速度指令値と、前記カーブ進入開始前に自車両に発生する減速度が増加するよう変化する第２の前後加速度指令値と、を有し、
前記第１の前後加速度指令値の絶対値最大値は、前記第２の前後加速度指令値の絶対値最大値以下となることを特徴とする請求項３に記載の車両運動制御装置。
【請求項６】
前記負の前後加速度指令値は、カーブ進入前からカーブ曲率が一定、もしくは最大になる期間において、前後加速度の時間変化である前後加加速度の増減前よりも、前後加加速度の増減後の前記負の前後加速度指令値の絶対値が増加することを特徴とする請求項４に記載の車両運動制御装置。
【請求項７】
前記カーブを走行している際の前後加速度指令値は、自車両の位置のカーブ曲率の時間変化によって異なり、
前記自車両の位置のカーブ曲率の時間変化が負の場合には、自車両の位置のカーブ曲率の時間変化が０以上の場合と比較して、前記カーブ前の前後加速度指令値の絶対値を小さくすることを特徴とする請求項１又は２に記載の車両運動制御装置。
【請求項８】
前記車両運動制御演算手段は、前記自車両の前方のカーブ曲率又はカーブ曲率の時間変化と車両速度に基づいて、前後加速度の時間変化である前後加加速度の増減を発生させる前後加速度指令値の減少を生成することを特徴とする請求項１又は２に記載の車両運動制御装置。
【請求項９】
前記車両運動制御演算手段は、
自車両の速度を算出する自車速度算出手段と、
自車両進行方向のコース上に複数の予め定めた前方注視点を設定し、前記自車両の位置から前記前方注視点までの前方注視距離を算出する前方注視距離算出手段と、
前記前方注視距離におけるカーブ曲率及びカーブ曲率の時間変化を算出するカーブ曲率算出手段と、
前記最大横加速度推定値、前記自車両前方の道路勾配、前記ドライバのペダル操作、及び前記旋回方向のうちの少なくとも一つに基づいて前記前後加速度指令値を変化させる比例ゲインを演算する比例ゲイン演算部と、
前記前方注視距離におけるカーブ曲率及びカーブ曲率の時間変化と、前記自車両の速度と、前記比例ゲインと、に基づいて前後加速度指令値を演算する前後加速度指令値演算手段と、を備えることを特徴とする請求項１に記載の車両運動制御装置。
【請求項１０】
前記車両運動制御装置は、前記車両運動制御演算手段と前記車両運動制御装置外の車載電子制御器とで情報の通信をする車両通信手段を備えることを特徴とする請求項１又は２に記載の車両運動制御装置。
【請求項１１】
前方注視点は、車両速度と予め設定される前方注視時間の積により得られる距離、もしくは、車両の前後加速度と前記前方注視時間の積に車両速度を加算して得られた第１の前方注視点速度と、前方注視点位置におけるカーブ曲率および前方注視距離に基づいて作成される第２の前方注視点速度と、のいずれか小さい方の値を前方注視点速度として該前方注視点速度の積分により得られる距離、に基づいて設定されることを特徴とする請求項２または９に記載の車両運動制御装置。
【請求項１２】
前記道路勾配は、縦断勾配及び横勾配の少なくともいずれか一方から構成されることを特徴とする請求項１又は２に記載の車両運動制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、車両運動制御装置に関し、特に車両の運動状態が好適になるよう車両を加減速する車両運動制御装置に関する。
【背景技術】
【０００２】
従来、ナビゲーションシステムのカーブ情報や旋回時の横加速度から、車両に発生する横加速度が設定値よりも過大となる際に減速を行うシステムが知られている（例えば特許文献１）。
【０００３】
このような装置では、カーブを通過する際に発生する横加速度の大きさが設定値以上にならないように、予め設定された横加速度設定値と自車前方のカーブ曲率からカーブ走行時の目標車両速度を設定し、前記目標車両速度と実際の車両速度から、必要な減速度を作成している。このような減速度の作成方法は、車両がカーブを旋回走行可能な限界速度を超過してカーブに進入する場合、路外への逸脱を抑制する上で有効である。
【０００４】
しかし、この設定横加速度を旋回可能な限界横加速度ではなく、ドライバが通常旋回時に許容するであろう横加速度に設定してカーブ前での減速制御を実行した場合、必ずしもドライバの減速フィーリングにあった減速になるとは限らない。この一因として、上述の目標車両速度による減速度作成方法では、カーブ進入前の総減速量（減速度の積分値）は規定できるものの、減速度の時間変化を規定できないことが挙げられる。
【０００５】
仮にこのカーブ前の減速度が一定となるように減速制御をした場合、カーブや車両速度によってはドライバの減速フィーリングに合わない可能性がある。また、カーブ毎にこの減速度の時間変化を設定しようとした場合、莫大な適合工数と膨大なデータが必要となる。
【０００６】
ドライバの減速フィーリングにあった加減速度の時間変化を規定する方法として、ドライバ操作により発生する横加加速度に基づく加減速度の作成方法が提案されている（例えば特許文献２，非特許文献１）。この方法により、カーブ毎に減速度の時間変化を設定することなくスキルドライバと同様の加減速を行うことができる。
【先行技術文献】
【特許文献】
【０００７】
【特許文献１】特開２００９−５１４８７号公報
【特許文献２】特開２００８−２８５０６６号公報
【非特許文献】
【０００８】
【非特許文献１】自動車技術会論文集Ｖｏｌ３９，Ｎｏ．３，２００８
【発明の概要】
【発明が解決しようとする課題】
【０００９】
しかし、横加加速度に基づく加減速度の作成方法は、車両に横運動が発生した際に、その横運動と連係した加減速度の作成方法であり、例えばカーブ進入前、直線路での減速のような、車両に横運動が発生していない状態での減速度を設定することはできない。
【００１０】
本発明は、前記課題に鑑みてなされたものであって、その目的とするところは、車両に横運動が発生していない状態においても、ドライバフィーリングよく車両を加減速する車両運動制御装置を提供することにある。
【課題を解決するための手段】
【００１１】
上記する課題を解決するために、本発明にかかる車両運動制御装置は、自車両前方のカーブ形状を取得するカーブ形状取得手段と、自車両の位置を取得する自車位置取得手段と、前記カーブ形状及び前記自車両の位置に基づいて、車両に発生させる前後加速度指令値を演算する車両運動制御演算手段と、を有し、前記車両運動制御演算手段は、自車両進行方向を正とする前後加速度指令値において、自車両がカーブ前からカーブに進入し、カーブ曲率が一定、もしくは最大になる地点まで走行する際に、負の前後加速度指令値を演算すると共に、該前後加速度指令値を、前記車両運動制御演算手段によって予め演算された自車両前方のカーブ走行時に発生するであろう最大横加速度推定値、自車両前方の道路勾配、ドライバのペダル操作、及び旋回方向のうちの少なくともいずれか一つに基づいて変化させることを特徴とする。
【発明の効果】
【００１２】
本発明によれば、車両に横運動が発生していない状態においても、ドライバフィーリングよく車両を加減速する車両運動制御装置を提供することができる。
【００１３】
上記した以外の課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
【図面の簡単な説明】
【００１４】
【図１】本発明に係る車両運動制御装置の車両のカーブ前の前後加速度変化と前後加加速度変化を示した概念図。
【図２】本発明に係る車両運動制御装置の自車両と前方注視点の関係を示した概念図。
【図３】本発明に係る車両運動制御装置の横加速度推定値とカーブ遠方での前後加速度指令値の関係を示す図。
【図４】本発明に係る車両運動制御装置の前方注視点までの距離と前方注視点の移動速度の関係を示す図。
【図５】本発明に係る車両運動制御装置のカーブ曲率，速度，前後加速度の時間変化を示す図。
【図６】本発明に係る車両運動制御装置の比例ゲイン補正方法を示すブロック図。
【図７】本発明に係る車両運動制御装置の最大カーブ曲率の作成方法を示す図。
【図８】本発明に係る車両運動制御装置の最大横加速度推定値と補正ゲインＣadjGyの関係を示す図。
【図９】本発明に係る車両運動制御装置の制御用縦断勾配の作成方法を示す図。
【図１０】本発明に係る車両運動制御装置の縦断勾配と補正ゲインＣadjgradの関係を示す図。
【図１１】本発明に係る車両運動制御装置の横勾配と補正ゲインＣadjgradの関係を示す図。
【図１２】旋回方向によるカーブ半径の違いを示す図。
【図１３】本発明に係る車両運動制御装置のカーブ曲率と補正ゲインＣadjdirの関係の一例を示す図。
【図１４】本発明に係る車両運動制御装置のカーブ曲率と補正ゲインＣadjdirの関係の他例を示す図。
【図１５】本発明に係る車両運動制御装置のドライバ要求加速度/減速度と補正ゲインＣadjdrvの関係を示す図。
【図１６】本発明に係る車両運動制御装置の第１の実施形態を示す図。
【図１７】図１６に示す車両運動制御装置の車両運動制御演算手段の一例を示す図。
【図１８】図１６の車両運動制御装置のフローチャートを示す図。
【図１９】図１６の車両運動制御装置の自車位置とノード点位置を示す概念図。
【図２０】図１６の車両運動制御装置の距離とカーブ曲率，カーブ曲率変化の関係図。
【図２１】図１６の車両運動制御装置のカーブ曲率，カーブ曲率変化と、前後加速度の時間変化を示す図。
【図２２】本発明に係る車両運動制御装置の第２の実施形態を示す図。
【図２３】図２２に示す車両運動制御装置の車両運動制御演算手段の一例を示す図。
【図２４】図２２の車両運動制御装置のフローチャートを示す図。
【図２５】図２２の車両運動制御装置の自車位置とノード点位置の関係を示す概念図。
【図２６】図２２の車両運動制御装置の前後加速度の時間変化を示す図。
【図２７】本発明に係る車両運動制御装置の第３の実施形態の一例を示す図。
【図２８】本発明に係る車両運動制御装置の第３の実施形態の他例を示す図。
【図２９】本発明に係る車両運動制御装置の第４の実施形態を示す図。
【図３０】本発明に係る車両運動制御装置の第５の実施形態のフローチャートを示す図。
【図３１】本発明に係る車両運動制御装置の第５の実施形態のカーブ曲率，カーブ曲率変化の関係図。
【図３２】本発明に係る車両運動制御装置の第５の実施形態の前方注視点までの距離と前方注視点の移動速度の関係を示す図。
【図３３】本発明に係る車両運動制御装置の第５の実施形態の前方注視点までの距離と前方注視点位置でのカーブ曲率の時間変化制限値の関係を示す図。
【図３４】本発明に係る車両運動制御装置の第５の実施形態のカーブ曲率，速度，前後加速度，前後加加速度の時間変化を示す図。
【発明を実施するための形態】
【００１５】
以下、本発明に係る車両運動制御装置の実施形態について、図面を参照して説明する。
【００１６】
図１は、本発明の実施形態の車両運動制御装置による車両のカーブ前の前後加速度変化と前後加加速度変化の概念図を示したものである。
【００１７】
ここで、図１のｂおよびｂ′がそれぞれ本実施形態の車両運動制御装置による前後加速度変化，前後加加速度変化である。なお、図１のａおよびａ′はそれぞれ従来技術による前後加速度変化，前後加加速度変化である。
【００１８】
図１に示すように、従来技術では車両がカーブ前のある地点に達した時間Ａからカーブ進入開始の時間Ｂまでの間、一定の減速となる。その結果、車両速度が高い条件ではドライバがどの程度のカーブ曲率かを明確に認識する前に強い減速度が発生する可能性があり、結果、旋回時に所定の横加速度となっていたとしても、カーブ手前に過度に減速したという感じを受ける。
【００１９】
本実施形態では、前記時間Ａからカーブ曲率が一定になる時間Ｃまで前後加速度が変化し、自車位置がカーブ遠方である時の区間Ｄにおける、カーブ曲率に基づく減速から、自車位置がカーブ近傍である時の区間Ｅにおける、カーブ曲率の時間変化による減速へと移行する。その結果、減速開始から減速度が最大となるまでの区間Ｆのうち、減速開始直後の区間Ｇとカーブ近傍での減速へ移行する区間Ｈの２区間において、前後加加速度の増減が発生する。
【００２０】
これにより、カーブ遠方にてドライバが“カーブがあるから減速が必要”と認識したことによる減速から、カーブ近傍にてドライバがカーブの曲率変化を認識し、“曲率変化が大きいからもう少し減速が必要”といった、カーブ曲率の時間変化に応じた減速へと移行することができ、ドライバフィーリングにあった減速が可能となる。
【００２１】
（カーブ曲率およびカーブ曲率変化に基づく前後加速度指令値の演算方法）
実施形態の説明に先立ち、本発明の理解が容易になるよう、以下、図２〜図５を用いてカーブ曲率、およびカーブ曲率変化に基づく前後加速度指令値の演算方法について説明する。なお、本明細書において、前後加速度は加速側が正、減速側が負であり、減速度は減速側が正なる値である。図２に示すように、自車両が車両速度Ｖにて破線で示す走行コースを走行するシーンを考える。この時ドライバは自車前方の走行コースの形状を見て加減速を行うと考えられる。この時ドライバの見ている点を疑似的に表現した点として、自車両進行方向に前方注視点を設定し、この位置のカーブ曲率をκPP、カーブ曲率変化をｄκPP／ｄｘとする。ここで、前方注視点は、自車両前方のコース上にあって、自車両からある距離Ｌpp離れた点であり、Ｌppは車両速度Ｖに予め設定される時間Ｔppを積算して得られる値である。また、カーブ曲率κPPはカーブの方向によらず０以上の値とし、カーブ曲率半径が十分大きければ、カーブ曲率κPPを０とする。車両速度Ｖのままで前方注視点の位置へ進入すると考えた場合、発生するであろう横加速度推定値ＧyESTおよび横加速度の時間変化である横加加速度推定値ｄＧyESTは、それぞれ以下の式（１）（２）で与えられる。ここで、横加速度推定値ＧyESTは、式（１）からわかるように、右旋回，左旋回によらず、常に０以上の値となる。
【００２２】
【数１】
0005417386.tif 000002
【００２３】
【数２】
0005417386.tif 000003
【００２４】
ここで、自車位置がカーブ近傍にあり、車両から前方注視点までの距離が短い条件では、ドライバは上述の横加加速度に基づく加減速度の作成方法（特許文献２，非特許文献１）と同様のアルゴリズムで加減速すると仮定すると、横加加速度推定値ｄＧyESTに基づく前後加速度指令値ＧxREQは以下の式（３）で与えられる。
【００２５】
【数３】
0005417386.tif 000004
【００２６】
ここで、Ｃxyは比例ゲインであり、最大横加速度推定値、前方注視点での道路勾配、ドライバのペダル操作等に応じて可変の値とし、その設定方法は後述する。ここで、式（２）の第二項（κPP・２Ｖ・ｄＶ／ｄｔ）の影響が第一項（ｄκPP／ｄｔ・Ｖ2）と比べて十分小さいとして式（２）を式（３）に代入すると、以下の式（４）が得られる。
【００２７】
【数４】
0005417386.tif 000005
【００２８】
このように前方注視点におけるカーブ曲率の時間変化（ｄκPP／ｄｔ）に基づいた前後加速度指令値が得られる。更に（ｄκPP／ｄｔ）は式（５）のように変形することができる。
【００２９】
【数５】
0005417386.tif 000006
【００３０】
ここで、（ｄｘ／ｄｔ）は前方注視点の移動速度ＶPPであるため、式（４）はＶPPを用いて以下の式（６）で与えられる。
【００３１】
【数６】
0005417386.tif 000007
【００３２】
これにより、カーブ近傍における前後加速度指令値を作成することができる。
【００３３】
一方、自車位置がカーブ遠方にて、車両から前方注視点までの距離が長い条件では、ドライバはカーブ曲率変化のような詳細な情報を把握できず、漠然としたカーブ曲率に応じて減速を行っていると考えられる。この時の前後加速度指令値ＧxREQfarは、例えば図３に示すように、上述の式（１）により得られた横加速度推定値ＧyESTを用いて、横加速度推定値ＧyESTに応じて、ある横加速度設定値ＧyLMT0からＧyLMT1まで前後加速度指令値ＧxREQfarが最小値ＧxREQfar_minとなるように減少（減速度としては増加）するように作成してもよい。また、自車両から遠方の前方注視点までの距離をＬfarとし、ある設定横加速度ＧySETを用いて、前後加速度指令値ＧxREQfarを以下の式（７）で与えてもよい。ここで、ｍｉｎ（Ａ，Ｂ）はＡとＢのうちのどちらか小さい値を選択する関数であり、ｍａｘ（Ａ，Ｂ）はＡとＢのうちのどちら大きい方を選択する関数である。
【００３４】
【数７】
0005417386.tif 000008
【００３５】
ここで、Ｌfarは、前記ＬPP以上の値であれば、予め設定される値であっても、車両速度Ｖに予め設定される時間Ｔppを積算して得られる値であってもよい。また、ＧySET、およびＧxREQfar_minは予め設定される値であっても、路面摩擦係数取得手段やドライバによる設定手段を備える構成であれば、路面摩擦係数やドライバによる設定値に応じて変化する値であってもよい。
【００３６】
また、Ｃxは予め設定される値であっても、最大横加速度推定値、前方注視点での道路勾配、ドライバのペダル操作等に応じて変化する値であってもよい。ＧxREQfarの作成方法はこれらに限定するものではないが、前後加速度指令値ＧxREQfarによる減速度は、カーブ近傍での前後加速度ＧxREQによる減速度以下となるように作成する。
【００３７】
以上のようにして得られたカーブ近傍およびカーブ遠方の前後加速度指令に基づいて、最終的な前後加速度指令値を作成することで、図１ｂに示したようにカーブ遠方（区間Ｄ）のカーブ曲率による減速から、カーブ近傍（区間Ｅ）のカーブ曲率変化による減速へと減速度が増加する前後加速度を発生させることができる。
【００３８】
また、上述のように自車位置がカーブ近傍の場合とカーブ遠方の場合とで、前後加速度指令を別々に作成するのではなく、前記式（６）における前方注視点の移動速度ＶPPをカーブまでの距離で変化させることにより、自車位置がカーブ遠方にある時の減速からカーブ近傍での減速へと変化させてもよい。例えば、前方注視点でのカーブ曲率κPPがある値κPPlmt以上となった場合、図４に示すように、前方注視距離ＬppκがＬppκ_lmtよりも大きい領域では、前方注視点の移動速度ＶPPをＶPPminとし、自車両がカーブに近づき、前方注視距離Ｌppκ_nearで車両速度Ｖとなるように、前方注視距離Ｌppκが小さくなるに応じて前方注視点の移動速度ＶPPを増加させる。
【００３９】
ここでＬppκ_lmt，Ｌppκ_nearは、Ｌppκ_lmtがＬppκ_near以上となるように、またＶPPminは０以上、かつ車両速度Ｖ以下となるよう予め設定される値である。
【００４０】
これは、自車位置がカーブ遠方であり、ドライバが漠然とカーブを認識しているような状態では、ドライバの視線の移動速度が小さく、自車両がカーブに近づいた状態では、ドライバがカーブに沿って視線を移動させるようになるに応じて視線の移動速度が増加するという行動を、前方注視点の移動速度の形で表現したものである。
【００４１】
これにより、図５に示すような自車位置でのカーブ曲率がκvとなるコースを走行した場合、前方注視点でのカーブ曲率κpp、前方注視点の移動速度ＶPPは図５に示すように変化し、この結果、カーブ遠方での小さな減速度から、カーブが近づくにつれて徐々に減速度を増加させることができる。
【００４２】
（前後加速度指令値における比例ゲインの設定）
上述の比例ゲインＣxy，Ｃxは、自車両前方のカーブ走行時に発生するであろう最大横加速度推定値、自車両前方の道路勾配、ドライバのペダル操作、旋回方向の少なくともいずれか一つに基づいて変化する。以下、図６〜図１５を用いて、その設定方法について説明する。
【００４３】
図６は、比例ゲインＣxy，Ｃxを演算するブロック図を示したものである。ここで、比例ゲインＣxy，Ｃxは、比例ゲイン初期値Ｃxy0，Ｃx0に各補正ゲインを積算することで演算する。以下、最大横加速度推定値、道路勾配、ペダル操作、旋回方向に基づく補正ゲインの演算方法について説明する。
【００４４】
まず、補正ゲイン演算部（最大横加速度推定値）２１では、最大横加速度推定値ＧymaxESTに基づく補正ゲインＣadjGyの演算を行う。上記最大横加速度推定値ＧymaxESTは、図７に示すような前方注視点のカーブ曲率と自車位置のカーブ曲率から作成されるカーブ曲率最大値κppmaxと車両速度Ｖとを用いて、以下の式（８）で与えられる。
【００４５】
【数８】
0005417386.tif 000009
【００４６】
上記式（８）により得られた最大横加速度推定値ＧymaxESTに基づいて、補正ゲインＣadjGyは、図８に示す形態で与えられる。図８において、Ｇyset1，Ｇyset2，Ｇyset3，Ｇyset4，Ｇyset5、およびＣadjGy1，ＣadjGy2は、０≦Ｇyset1＜Ｇyset2＜Ｇyset3＜Ｇyset4≦Ｇyset5，１＜ＣadjGy1≦ＣadjGy2となるように設定される値であり、予め設定される値であっても、ドライバ自身の入力に応じて設定される値であっても、車両に発生可能な最大横加速度を取得する手段を備える場合には、車両に発生可能な最大横加速度に応じて設定される値であってもよい。
【００４７】
これらＧyset1，Ｇyset2，Ｇyset3，Ｇyset4，Ｇyset5、およびＣadjGy1，ＣadjGy2を適宜設定することで、最大横加速度推定値ＧymaxESTが小さい時は補正ゲインＣadjGyを０とする領域８Ａ、最大横加速度推定値ＧymaxESTの増加に応じて補正ゲインＣadjGyが増加する領域８Ｂ，８Ｄ，８Ｅ、最大横加速度推定値ＧymaxESTがある範囲の領域では補正ゲインＣadjGyを１とする領域８Ｃを作成することができる。これにより、最大横加速度推定値ＧymaxESTが小さい領域では、補正ゲインＣadjGyを１よりも小さくすることで、前後加速度指令値の絶対値が小さくなるように補正し、最大横加速度推定値ＧymaxESTがある範囲にある時は、補正を行わず、最大横加速度推定値ＧymaxESTが大きい領域では、補正ゲインＣadjGyを１よりも大きくすることで、前後加速度指令値の絶対値が大きくなるように補正することができる。また、最大横加速度推定値ＧymaxESTが非常に大きい領域（図８中の領域８Ｅ）では、最大横加速度推定値ＧymaxESTの増加に対して補正ゲインＣadjGyの増加をより大きくすることで、カーブ前の減速無しではカーブ進入後に道路を逸脱してしまうようなシーンで、前後加速度指令値の絶対値を更に大きくすることができる。
【００４８】
ここで、最大横加速度推定値ＧymaxESTに対する補正ゲインＣadjGyの設定方法は、図８に示した方法のみに限定されず、最大横加速度推定値ＧymaxESTの増加に対して、補正ゲインＣadjGyが０から１となる領域、１となる領域、さらに１よりも大きくなる領域を与える方法であればよい。これにより、上述の式（６）にて作成される前後加速度指令値の大きさを横加速度に応じて増減することができる。
【００４９】
次いで、補正ゲイン演算部（道路勾配）２２では、道路勾配に基づく補正ゲインＣadjgradの演算を行う。ここで、道路勾配として上り坂や下り坂のような縦断勾配を用いる場合、図９に示すように、前方注視点の縦断勾配θppと自車位置の縦断勾配θvから、制御用縦断勾配θctrlを作成して補正ゲインＣadjgradを演算する。ここで、θは上り勾配では正、下り勾配では負となる変数である。θctrlの作成方法としては、前方注視点の縦断勾配θppと自車位置の縦断勾配θvを用いて、以下の式（９）で演算された値にフィルタ処理を行う。ここで、ｋgradは前方注視点の縦断勾配θppと自車位置の縦断勾配θvの重みを変更するため、０から１の範囲の値をとる定数である。なお、ｋgradは予め設定される値であっても、前方注視点の縦断勾配θppと自車位置の縦断勾配θvに応じて変化する値であってもよい。例えば、θpp，θvが共に正である場合と、θppが負、且つθvが正である場合とで、ｋgradを異なる値としてもよく、θppが負の場合には、θppが正の場合よりもその値を大きくしてもよい。
【００５０】
【数９】
0005417386.tif 000010
【００５１】
上記式（９）により得られたθctrlを用いて、補正ゲインＣadjgradは図１０に示す形態で与えられる。図１０において、θseta1，θseta2，θseta3，θseta4，θsetb1，θsetb2，θsetb3，θsetb4、及びＣadjgrada1，Ｃadjgradb1は、θseta1＜θseta2＜０＜θseta3＜θseta4，０＜Ｃadjgrada1，θsetb1＜θsetb2＜０＜θsetb3＜θsetb4，０＜Ｃadjgradb1となるように設定される値であり、予め設定される値であっても、ドライバ自身の入力に応じて設定される値であってもよい。
【００５２】
これらθseta1，θseta2，θseta3，θseta4，θsetb1，θsetb2，θsetb3，θsetb4、およびＣadjgrada1，Ｃadjgradb1を適宜設定することで、図１０（ａ）に示す前後加速度指令値が負の場合には、制御用縦断勾配θctrlがある負の値以下では補正ゲインＣadjgradをＣadjgrada1とする領域１０ａＡ、制御用縦断勾配θctrlの増加に応じて補正ゲインＣadjgradが減少する領域１０ａＢ，１０ａＤ、制御用縦断勾配θctrlの絶対値が小さい時は補正ゲインＣadjgradを１とする領域１０ａＣ、制御用縦断勾配θctrlがある正の値以上では補正ゲインＣadjgradを０とする領域１０ａＥを作成することができる。同様に、図１０（ｂ）に示す前後加速度指令値が正の場合には、制御用縦断勾配θctrlがある負の値以下では補正ゲインＣadjgradを０とする領域１０ｂＡ、制御用縦断勾配θctrlの増加に応じて補正ゲインＣadjgradが増加する領域１０ｂＢ，１０ｂＤ、制御用縦断勾配θctrlの絶対値が小さい時は補正ゲインＣadjgradを１とする領域１０ｂＣ、制御用縦断勾配θctrlがある正の値以上では補正ゲインＣadjgradをＣadjgradb1とする領域１０ｂＥを作成することができる。
【００５３】
これにより、縦断勾配の絶対値が小さい領域では補正を行わず、負の前後加速度指令値による制御、すなわち減速制御では、下り勾配での減速度を大きくし、上り勾配での減速度を小さくすることができる。また、制御用縦断勾配θctrlを前方注視点での縦断勾配に基づいて作成することにより、平坦路を走行中の自車両前方に下りカーブが存在する場合、自車位置が平坦路であっても、前方の下り勾配を考慮した減速制御を実現することができる。
【００５４】
ここで、縦断勾配に対する補正ゲインＣadjgradの設定方法は図１０に示した方法のみに限定されず、縦断勾配に対して、縦断勾配の絶対値が小さい時には補正ゲインＣadjgradが１となり、減速制御時（図１０（ａ）参照）は、下り勾配時に補正ゲインＣadjgraが１よりも大きく、上り勾配時に１よりも小さくなり、逆に加速制御時（図１０（ｂ）参照）には、下り勾配時に１よりも小さく、上り勾配時に１よりも大きくなるように与える方法であればよい。
【００５５】
また、上記においては道路勾配として縦断勾配による場合の補正方法について示したが、カント（cant）と呼ばれる横勾配を取得可能である場合には、横勾配に応じて補正ゲインＣadjgradを変更してもよい。例えば、カーブの旋回内側から外側への上り勾配を正とした場合、図１１に示すように、横勾配の絶対値がある値以下の領域１１Ｃでは上記補正ゲインＣadjgradを１とし、領域１１Ｃよりも横勾配が小さい値の領域１１Ａ，１１Ｂでは補正ゲインＣadjgradを１よりも大きくし、領域１１Ｃよりも横勾配が大きい値の領域１１Ｄ，１１Ｅでは補正ゲインＣadjgradを１よりも小さくする。これにより、旋回外側に向かって上り勾配となっているバンク路では横勾配が大きな値となるため、補正ゲインＣadjgradが小さな値となり、過度な減速を抑制することができる。また、旋回外側に向かって下り勾配となっている場合には横勾配が小さい値となるため、補正ゲインＣadjgradが大きな値となり、十分に減速することができる。
【００５６】
また、補正ゲイン演算部（旋回方向）２３では、旋回方向に基づく補正ゲインＣadjdirの演算を行う。図１２に示すように、同じカーブを走行する場合であっても、左旋回の車両１２Ａと右旋回の車両１２Ｂで旋回半径は異なり、例えば日本のような車両が左側車線を走行する場合には、一般的に右旋回時の旋回半径ρRよりも左旋回の旋回半径ρLの方が小さくなる。自車走行車線毎のカーブ曲率が精度良く得られる場合には旋回方向に関する補正ゲインは不要となるものの、例えば、カーブ曲率が道路中心位置の値ρCで代表されている場合には、右旋回に対して左旋回では減速不足が発生する可能性がある。
【００５７】
そこで、右旋回時のカーブ曲率を正とし、左旋回時のカーブ曲率を負とした場合、カーブ曲率に対する補正ゲインＣadjdirを図１３に示す形態で与える。図１３に示すように、カーブ曲率が負、すなわち左旋回時には補正ゲインＣadjdirが１よりも大きな値となる領域１３Ａ，１３Ｂがあり、カーブ曲率が負であってもその絶対値が小さい領域、およびカーブ曲率が正となる領域１３Ｃでは、補正ゲインＣadjdirが１となるように与える。
【００５８】
これにより、カーブ曲率の絶対値が小さい領域、即ちカーブ半径が大きい領域では、カーブ半径に対して車線違いによる影響が小さくなるため、補正ゲインＣadjdirを１として補正を行わず、車線違いによる影響が大きくなるカーブ曲率の絶対値が大きい領域では、補正ゲインＣadjdirを１よりも大きな値とすることで、右旋回に対して左旋回の前後加速度制御を補正することができる。
【００５９】
図１３においては、右旋回を基準として左旋回時の前後加速度指令値を補正する方法について示したが、図１４に示すように、右旋回においても、カーブ曲率の絶対値が大きい領域１４Ｄ，１４Ｅでは、補正ゲインＣadjdirが１よりも小さくなるように与えてもよい。
【００６０】
また、補正ゲイン演算部（ペダル操作量）２４では、ドライバのアクセルペダル操作量、もしくはブレーキペダル操作量に基づく補正ゲインＣadjdrvの演算を行う。この補正ゲインＣadjdrvは、ドライバのアクセル操作量から作成されるドライバ要求加速度、もしくはドライバ要求減速度を用いて、図１５に示す形態で与えられる。
【００６１】
ここで、ドライバ要求加速度は、一定速度走行時のアクセル操作量の時にその値が０となり、アクセルペダル操作量の増加に応じて増加する値である。また、ドライバ要求減速度は、ブレーキペダル操作量が０の時にその値が０となり、ブレーキペダル操作量の増加に応じて増加する値である。図１５において、Ｇxdrvseta1，Ｇxdrvseta2，Ｇxdrvsetbは、Ｇxdrvseta1＜Ｇxdrvseta2，０≦Ｇxdrvsetbとなるように設定される値であり、予め設定される値であっても、ドライバ自身の入力に応じて設定される値であっても、車両に発生可能な最大横加速度を取得する手段を備える場合には、車両に発生可能な最大横加速度に応じて設定される値であってもよい。
【００６２】
これらＧxdrvseta1，Ｇxdrvseta2，Ｇxdrvsetbを適宜設定することで、図１５（ａ）に示す前後加速度指令値が負の場合、ドライバ要求加速度がＧxdrvseta1以下の領域１５ａＡでは補正ゲインＣadjdrvを１とし、ドライバ要求加速度がＧxdrvseta1よりも大きい領域１５ａＢでは、ドライバ要求加速度の増加に応じて補正ゲインＣadjdrvを減少させ、さらにドライバ要求加速度がＧxdrvseta2以上では補正ゲインＣadjdrvを０とする。また、図１５（ｂ）に示す前後加速度指令値が正の場合、ドライバ要求減速度が０以下の領域１５ｂＡでは補正ゲインＣadjdrvを１とし、ドライバ要求減速度が０よりも大きい領域１５ｂＢでは、ドライバ要求減速度の増加に応じて補正ゲインＣadjdrvを減少させ、ドライバ要求減速度がＧxdrvsetb以上では、補正ゲインＣadjdrvを０とする。
【００６３】
また、車両に発生可能な最大横加速度を取得する手段を備える場合には、上述の式（８）によって得られる最大横加速度推定値ＧymaxESTと発生可能な最大横加速度に基づいて、上記Ｇxdrvseta1，Ｇxdrvseta2を変更してもよい。例えば、最大横加速度推定値ＧymaxESTが発生可能な最大横加速度以上となっている場合には、Ｇxdrvseta1，Ｇxdrvseta2をドライバ要求加速度の最大値以上の値に設定することで、補正ゲインＣadjdrvはアクセルペダル操作量によらず常に１とすることができる。これにより、最大横加速度推定値ＧymaxESTが発生可能な最大横加速度を超えるような場合、ドライバのアクセルペダル操作によらず、減速制御を実施することが可能となる。
【００６４】
なお、既述するように、上記方法により得られた各補正ゲインＣadjGy，Ｃadjgrad，Ｃadjdir，Ｃadjdrvを比例ゲイン演算部２５で比例ゲイン初期値Ｃxy0，Ｃx0に積算することで、比例ゲインＣxy，Ｃxを得ることができる。
【００６５】
以上のように、最大横加速度推定値、道路勾配、旋回方向、ペダル操作量から補正ゲインを作成して比例ゲインＣxy，Ｃxを演算する方法を示したが、必ずしもこれら全ての補正ゲインを作成する必要はなく、前後加速度指令値に対して加算することで補正を行ってもよい。例えば、比例ゲインＣxy，Ｃxを演算する際の補正ゲインとして補正ゲインＣadjGyと補正ゲインＣadjdirのみを演算し、得られた前後加速度指令値に対して、前後加速度指令値が０以外の値の時に道路勾配により発生する前後加速度Ｇxgradを加算することで、勾配に対する補正を行ってもよい。同様に、前後加速度指令値が負の値の時に、ドライバのアクセルペダル操作による前後加速度Ｇxaccを加算し、前後加速度指令値が正の値の時に、ドライバのブレーキペダル操作による前後加速度Ｇxbrkを加算することで、ドライバのペダル操作による補正を行ってもよい。
【００６６】
（発明を実施するための第１の実施形態）
以下、図１６〜図２１を用いて、本発明の第１の実施形態による車両運動制御装置の構成及び動作について説明する。
【００６７】
最初に、図１６を用いて、本発明の第１の実施形態による車両運動制御装置の構成について説明する。
【００６８】
図１６は、本発明の第１の実施形態による車両運動制御装置の構成を示すシステムブロック図を示したものである。
【００６９】
本実施形態の車両運動制御装置１は車両に搭載されるものであり、自車両前方のカーブ形状を取得するカーブ形状取得手段２と、自車位置を取得する自車位置取得手段３と、前記カーブ形状取得手段２と前記自車位置取得手段３により得られた情報に基づいて車両に発生させる前後加速度を演算する車両運動制御演算手段４を備える。また、前記車両運動制御演算手段４の演算結果は、前後加速度発生手段５に送られ、車両に前後加速度を発生可能なアクチュエータの駆動を行う。
【００７０】
カーブ形状取得手段２は、自車両が走行するコースの地図情報からカーブ形状を取得する方法であっても、路車間通信により自車両進行方向のカーブ情報を取得する方法であっても、車車間通信により自車両進行方向の前方を走行する車両から、カーブ情報を取得する方法であっても、撮像手段により自車両前方のカーブ形状を取得する方法であってもよい。また、地図情報取得手段、路車間通信手段、もしくは車車間通信手段、もしくは撮像手段との通信によりカーブ形状情報を取得する方法であってもよい。
【００７１】
自車位置取得手段３は、グローバルポジショニングシステム（ＧＰＳ）により自車両の座標から自車両前方のカーブに対する自車位置を取得する方法であっても、路車間通信により自車両前方のカーブに対する自車位置を取得する方法であっても、撮像手段により自車両前方もしくは周囲、またはその両方の画像を取得し、自車両前方のカーブに対する自車位置を取得する方法であってもよい。また、ＧＰＳ、もしくは路車間通信手段、もしくは撮像手段との通信によりカーブに対する自車位置を取得する方法であってもよい。
【００７２】
ここで、カーブ形状取得手段２および自車位置取得手段３として、複数の方法を備えていてもよい。例えばカーブ形状取得手段２として地図情報および撮像手段によりカーブ形状情報を取得する手段を備え、自車位置取得手段３として、ＧＰＳおよび撮像手段により自車位置を取得する手段を備えていてもよい。複数の方法を組合せることで、カーブ遠方の情報として、地図情報、およびＧＰＳによるカーブ形状情報および自車位置情報を用い、カーブ近傍では前記地図情報、およびＧＰＳによるカーブ形状情報および自車位置情報に加え、撮像手段によるカーブ形状情報および自車位置情報を用いることで、より精度の良いカーブ形状情報および自車位置情報を得ることができる。
【００７３】
また、ＧＰＳによる自車位置情報の取得が困難である際に、撮像手段によりカーブ形状情報、および自車位置情報を取得することで、前後加速度制御に必要なカーブ形状情報、および自車位置情報を取得することができる。逆に、撮像手段ではカーブ形状情報、および自車位置情報の取得が困難な状況では、ＧＰＳおよび地図情報によりカーブ形状情報、および自車位置情報を取得することで、前後加速度制御に必要なカーブ形状情報、および自車位置情報を取得することができる。
【００７４】
前後加速度発生手段５は、例えば、エンジンのスロットル開度を制御することで前後加速度を発生させるエンジン、もしくはモータの駆動トルクを制御することで前後加速度を発生させるモータ、もしくは動力を各車輪に伝達する際の変速比を変えることで前後加速度を発生させる変速機、もしくは各車輪のブレーキパッドにブレーキディスクを押しつけることで前後加速度を発生させる摩擦ブレーキといった、前後加速度を発生可能な加減速アクチュエータを適用することができる。
【００７５】
車両運動制御演算手段４は、記憶領域、および演算処理能力、および信号の入出力手段を有する演算装置であり、前記カーブ形状取得手段２および前記自車位置取得手段３により得られたカーブ形状および自車位置から車両に発生させる前後加速度指令値を演算し、前記前後加速度指令値となる前後加速度を発生し得る前記加減速アクチュエータを前後加速度発生手段５として、前記加減速アクチュエータの駆動制御器へ前記前後加速度指令値を送る。
【００７６】
ここで、送る信号は前後加速度ではなく、前記加減速アクチュエータによって前記前後加速度指令値を実現し得る信号であればよい。
【００７７】
例えば、前記加減速アクチュエータが油圧によりブレーキパッドをブレーキディスクに押し付ける油圧式摩擦ブレーキである場合、前後加速度指令値を実現する油圧指令値を油圧式摩擦ブレーキ制御器へ送る。また、油圧式摩擦ブレーキ制御器を介さず、前後加速度指令値を実現する油圧式摩擦ブレーキ駆動アクチュエータの駆動信号を油圧式摩擦ブレーキ駆動アクチュエータに直接送ってもよい。
【００７８】
また、前後加速度指令値を実現する際に、前後加速度指令値に応じて駆動制御を行う前記加減速アクチュエータを変更してもよい。
【００７９】
例えば、自車位置がカーブ遠方での減速における前後加速度指令値を実現するために、前記変速機の変速比を変更する指令値を変速機制御器に送り、カーブ近傍での減速における前後加速度指令値を実現するために、油圧指令値を油圧式摩擦ブレーキ制御器へ送ってもよい。
【００８０】
以下、前記カーブ形状取得手段２として自車両が走行するコースの地図情報を用い、前記自車位置取得手段３としてＧＰＳを用いる場合における前後加速度指令値の作成方法について説明する。
【００８１】
ここで、前記車両運動制御演算手段４は、図１７に示すように、自車両の速度を算出する自車速度算出手段４１と、自車両の位置から前方注視点までの前方注視距離を算出する前方注視距離算出手段４２と、前記前方注視距離におけるカーブ曲率及びカーブ曲率の時間変化を算出するカーブ曲率算出手段４３と、前記前方注視距離におけるカーブ曲率及びカーブ曲率の時間変化と前記車両速度に基づいて前後加速度指令値を演算する前後加速度指令値演算手段４４と、を備える。また、前記車両運動制御演算手段４は、最大横加速度推定値や、自車両前方の道路勾配、ドライバのペダル操作、前記旋回方向のうちの少なくともいずれか一つに基づいて前後加速度指令値を変化させる比例ゲインを演算する比例ゲイン演算部２５を備える。
【００８２】
図１８は、第１の実施形態の前記車両運動制御装置１における演算フローチャートを示したものである。
【００８３】
Ｓ００１では、ＧＰＳによる自車位置データＰv（Ｘv，Ｙv）、および自車位置情報と地図情報からカーブ形状データとして自車両進行方向にあるノード点位置データＰn（Ｘn，Ｙn）を取得して演算を行う。ここで、ｎは、図１９に示すように、自車両進行方向と逆方向にある最初のノード点位置を０とし、自車両進行方向に向かって１，２・・・，ｎｍａｘと増加する整数である。また、ｎｍａｘは、取得可能なノード点位置データ番号ｎの最大値である。演算後Ｓ１００へ進む。
【００８４】
Ｓ１００では、ＧＰＳによる自車位置データＰv（Ｘv，Ｙv）が更新されたか否かの判定を行い、データが更新されていればデータ更新フラグＦGPSrefを１に、されていなければ０とする。演算後Ｓ２００へ進む。更新の判定方法として、自車位置データＰv（Ｘv，Ｙv）の前回値Ｐv_z1（Ｘv_z1，Ｙv_z1）との比較により更新されたか否かを判定しても、ＧＰＳから自車位置データの他に更新フラグを取得することで、更新されたか否かを判定してもよい。
【００８５】
Ｓ２００では、図１７に示す自車速度算出手段４１によって、自車位置の時間変化から、車両速度の算出を行う。ここで、データ更新フラグが０の時には、前回の車両速度算出結果を車両速度とする。データ更新フラグが１の時には、前回データ更新フラグが１になってから、今回データ更新フラグが１になるまでに要した時間ΔｔPと、前回データ更新フラグが１だった時の自車位置データＰv_Pz1（Ｘv_Pz1，Ｙv_Pz1）と今回の自車位置データＰv（Ｘv，Ｙv）から算出した自車両の移動距離ΔＬvから、自車両の移動速度である車両速度Ｖを算出する。
【００８６】
Ｓ３００では、図１７に示す前方注視距離算出手段４２によって、前方注視距離の演算を行う。図２０に示すように、自車両進行方向のコース上に自車両の極近傍から遠方まで前方注視点ＰＰ０，ＰＰ１，ＰＰ２という３つの前方注視点を設定し、自車両から前方注視点ＰＰ０，ＰＰ１，ＰＰ２までの前方注視距離ＬPP0，ＬPP1，ＬPP2を算出する。
【００８７】
ここで、前方注視距離ＬPP0，ＬPP1，ＬPP2は以下の式（１０）の関係を満たすように予め設定される値であっても、予め設定される前方注視時間ＴPP0，ＴPP1，ＴPP2（ただしＴPP0＜ＴPP1＜ＴPP2）と車両速度Ｖを用いて、それぞれ式（１１）に示すように与えてもよい。ただし前方注視点ＰＰ０は自車両の極近傍の注視点とし、Ｌmaxは自車位置からノード点位置Ｐ1までの距離とノード点位置Ｐ1からノード点位置Ｐnmaxまでの各ノード点間距離を合計した値である。演算後Ｓ４００へと進む。
【００８８】
【数１０】
0005417386.tif 000011
【００８９】
【数１１】
0005417386.tif 000012
【００９０】
Ｓ４００では、前後加速度制御許可フラグの演算を行う。前後加速度制御許可フラグは、その値が１の時に前後加速度制御を許可し、０の時に前後加速度制御を禁止するものとする。前後加速度制御許可フラグの作成方法としては、例えば前記データ更新フラグＦGPSrefが０となっている時間が所定時間以上となった場合、ＧＰＳによる自車位置データの取得が困難であるとして前後加速度制御許可フラグを０とする。
【００９１】
また、自車位置データによる走行軌跡と地図データ上で自車が走行していると想定しているコース形状との乖離が大きい場合、地図データ上の自車の走行コースが実際のコースと異なるとして、前後加速度制御許可フラグを０とする。
【００９２】
また、車両速度Ｖにより前後加速度制御許可フラグを０としてもよい。例えば、制御を開始する最低車両速度を予め設定しておき、最低車両速度よりも車両速度Ｖが小さければ、前後加速度制御許可フラグを０とする。
【００９３】
また、上述のように、複数のカーブ形状データの取得手段、および自車位置データの取得手段を備える場合、その全ての取得手段において、カーブ形状データ、および自車位置データの取得が困難であると判断された場合、前後加速度制御許可フラグを０とする。例えば、ＧＰＳの他に撮像手段によりカーブ形状データ、および自車位置データを取得している場合、上述のようにＧＰＳによる自車位置データの取得が困難と判定された上に、更に撮像手段によるカーブ形状データ、および自車位置データの取得が困難と判定された際に、前後加速度制御許可フラグを０とする。そして、これら以外の条件では１とする。演算後Ｓ５００へ進む。
【００９４】
Ｓ５００では、図１７に示すカーブ曲率算出手段４３によって、ノード点位置データＰn（Ｘn，Ｙn）からｎが１以上の点における各ノード点位置のカーブ曲率κn、および自車位置のカーブ曲率κvと、ノード点間のカーブ曲率変化ｄκn／ｄｘを算出し、前方注視距離ＬPP0，ＬPP1，ＬPP2でのカーブ曲率κPP0，κPP1，κPP2、およびカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP1／ｄｘ，ｄκPP2／ｄｘを算出する。ここで、カーブ曲率の算出方法としては、連続する３点のノード点Ｐn-1，Ｐn，Ｐn+1を通る円弧のカーブ曲率半径を求め、その逆数をとることでノード点Ｐnのカーブ曲率κnを求めることができる。
【００９５】
また、自車位置のカーブ曲率κvは、自車位置がノード点位置Ｐ1と一致していれば、カーブ曲率κvはカーブ曲率κ1となり、一致していなければ、ノード点Ｐ0，Ｐv，Ｐ1からカーブ曲率κvを算出することができる。ここで、カーブ曲率κnおよびカーブ曲率κvはカーブの方向によらず正の値とする。
【００９６】
また、カーブ曲率半径が十分大きければ、カーブ曲率κnを０としてもよい。これにより得られた各ノード点のカーブ曲率κnと各ノード点間距離からカーブ曲率変化ｄκn／ｄｘを算出する。図２０に示すように、ノード点間を線系補完し、ノード点Ｐn，Ｐn+1間の距離をＬnとすると、ノード点Ｐn，Ｐn+1間のカーブ曲率変化ｄκn／ｄｘは以下の式（１２）で与えられる。
【００９７】
【数１２】
0005417386.tif 000013
【００９８】
同様に、自車位置Ｐvとノード点Ｐ1間のカーブ曲率変化ｄκv／ｄｘは、自車位置Ｐvとノード点Ｐ1間の距離をＬv1とすると、以下の式（１３）で与えられる。
【００９９】
【数１３】
0005417386.tif 000014
【０１００】
各ノード点のカーブ曲率κn、およびカーブ曲率変化ｄκn／ｄｘを算出した後、前方注視距離ＬPP0，ＬPP1，ＬPP2に対応したカーブ曲率κPP0，κPP1，κPP2、およびカーブ曲率変化ｄκPP0／ｄｘ、ｄκPP1／ｄｘ、ｄκPP2／ｄｘを算出する。例えば、図２０に示すように、ＰＰ０がＰvとＰ1の間、ＰＰ１がＰ2とＰ3の間、ＰＰ２がＰnとＰn+1の間にある場合、カーブ曲率κPP0，κPP1，κPP2、及びカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP1／ｄｘ，ｄκPP2／ｄｘは、以下の式（１４）〜（１９）で与えられる。
【０１０１】
【数１４】
0005417386.tif 000015
【０１０２】
【数１５】
0005417386.tif 000016
【０１０３】
【数１６】
0005417386.tif 000017
【０１０４】
【数１７】
0005417386.tif 000018
【０１０５】
【数１８】
0005417386.tif 000019
【０１０６】
【数１９】
0005417386.tif 000020
【０１０７】
ここで、各ノード点のカーブ曲率κn、およびカーブ曲率変化ｄκn／ｄｘの算出方法は上記方法に限らず、各ノード点でのカーブ曲率、およびカーブ曲率変化を算出可能な方法であればよい。演算後Ｓ６００へと進む。
【０１０８】
Ｓ６００では、図１７に示す前後加速度指令値演算手段４４によって前方注視距離ＬPP0，ＬPP1，ＬPP2でのカーブ曲率κPP0，κPP1，κPP2、およびカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP1／ｄｘ，ｄκPP2／ｄｘ、および車両速度Ｖに基づいて前後加速度指令値初期値を作成する。ここで、車両近傍のカーブ曲率変化ｄκPP0／ｄｘ、ｄκPP1／ｄｘによる前後加速度指令値ＧxREQiniPP0，ＧxREQiniPP1は上述の式（６）により算出し、車両遠方のカーブ曲率κPP2による前後加速度指令値ＧxREQiniPP2は、上述の図３に示した方法で作成する。
【０１０９】
ここで、前方注視距離ＬPP0，ＬPP1，ＬPP2を上述の式（１１）で示した前方注視時間ＴPP0，ＴPP1，ＴPP2で作成するとした場合、前方注視点ＰＰ０，ＰＰ１，ＰＰ２の移動速度ＶPP0，ＶPP1，ＶPP2は、車両速度Ｖを微分して得られる車両前後加速度Ｇxを用いて、以下の式（２０）で与えられる。
【０１１０】
ここで、他の制御器との通信や加速度センサによる直接測定により前後加速度を取得する手段を備える構成であれば、それにより得られた前後加速度から車両前後加速度Ｇxを作成してもよい。
【０１１１】
【数２０】
0005417386.tif 000021
【０１１２】
式（６），（２０）から、前後加速度指令値ＧxREQiniPP0，ＧxREQiniPP1を以下の式（２１）により演算する。また、図３から前後加速度指令値ＧxREQiniPP2を演算する。
【０１１３】
【数２１】
0005417386.tif 000022
【０１１４】
ここで、Ｃxy0，Ｃxy1は、路面摩擦係数やドライバのアクセル操作といった他の情報を利用可能であれば、上述の図６にて示した補正ゲインのうち利用可能なもの（例えば、最大横加速度推定値による補正ゲインＣadjGy）を、予め設定される定数Ｃxy00，Ｃxy10に積算して得られる値である。ここで、定数Ｃxy00，Ｃxy10は、他の条件に応じて変更する値であってもよい。例えば、ｄκPPm／ｄｘが正の場合とｄκPPm／ｄｘが負の場合とで異なる値としてもよい。これらカーブ形状や自車位置以外の情報を利用する構成については、第２の実施形態にて説明する。演算後、Ｓ７００へと進む。
【０１１５】
Ｓ７００では、前後加速度指令値初期値ＧxREQiniPP0，ＧxREQiniPP1，ＧxREQiniPP2に前後加速度制御の介入閾値による処理や、フィルタ処理，セレクト処理，加算処理等を行い最終的な前後加速度指令値ＧxREQfinを作成する。例えば、上記前後加速度指令値ＧxREQiniPP0，ＧxREQiniPP1，ＧxREQiniPP2に対して、その符号や増減方向に応じた時定数をそれぞれ設定したフィルタ処理を行い、その値に応じたセレクト処理や加算処理を行う。
【０１１６】
更に、減速側の前後加速度制御介入閾値ＧxBRKs、および加速側の前後加速度制御介入閾値ＧxACCsとし、これらの値による前後加速度制御の介入閾値による処理を行う。ここで、前記前後加速度制御介入閾値ＧxBRKs，ＧxACCsは予め設定される値である。
【０１１７】
また、前後加速度指令値ＧxREQiniPP0，ＧxREQiniPP1，ＧxREQiniPP2のうち、２つが同時に０以外の値となっている領域では、両者が同符号であれば、その絶対値が大きい方の値とし、異符合であれば、両者を加算した値とする。また、上記前後加速度指令値ＧxREQiniPP0，ＧxREQiniPP1，ＧxREQiniPP2のうち、３つが同時に０以外の値となっている領域では、３つのうち同符号の２つの絶対値を比較して、その大きい方の値と、残る異符合の値を加算した値とする。これにより、ＧxREQiniPP0が正でＧxREQiniPP2が負、すなわち自車両極近傍の位置ではカーブ曲率変化が負で、自車両前方にカーブ曲率変化が正となるカーブが存在する場合での減速度を小さくすることができ、連続カーブを走行している際の減速フィーリングを向上させることができる。
【０１１８】
また、ここで加算をする際に、その符号に応じて重み付けをしてもよい。例えば、減速を優先したければ、正となっている値が小さくなるような係数を積算して加算し、逆に加速を優先するのであれば、負となっている値が小さくなるような係数を積算して加算してもよい。
【０１１９】
これにより、図２１に示すようなカーブ曲率κPP0，κPP1，κPP2、およびカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP1／ｄｘ，ｄκPP2／ｄｘとなるカーブを走行し、点線で示す前後加速度指令値ＧxREQiniPP0，破線で示すＧxREQiniPP1，一点鎖線で示すＧxREQiniPP2が得られた場合には、実線で示したような前後加速度指令値ＧxREQfinが得られる。ここで、上記前後加速度指令値ＧxREQiniPP0，ＧxREQiniPP1，ＧxREQiniPP2からＧxREQfinを作成する方法は、上記内容に限ったものではないが、図２１のＴ２１で示した、負の前後加速度、すなわち減速している際のＧxREQiniPP2からＧxREQiniPP1へと遷移する区間において、減速度が過度に減少しないようにする。
【０１２０】
同様に、図２１のＴ１０で示したＧxREQiniPP1からＧxREQiniPP0へと遷移する区間においても、負の前後加速度、すなわち減速している際のＧxREQiniPP1からＧxREQiniPP0へと遷移する区間において、減速度が過度に減少しないようにする。演算後Ｓ８００へと進む。
【０１２１】
Ｓ８００では、前後加速度制御許可フラグが１であれば、前後加速度指令値ＧxREQfinを実現する指令値を、前後加速度制御許可フラグが０であれば、前後加速度制御を行わないようにする指令値を図１６に示す前記前後加速度発生手段５へ送信する。
【０１２２】
ここで、前後加速度制御許可フラグが１の時に送信する信号としては、上述の通り、前記前後加速度指令値ＧxREQfinを送信することで前記前後加速度発生手段５により前後加速度指令値ＧxREQfinを実現することができる場合には、前後加速度指令値ＧxREQfinを制御指令値として送信する。
【０１２３】
また、前記前後加速度発生手段５に応じた指令値にする必要がある場合には、前後加速度指令値ＧxREQfinに基づいて前記前後加速度発生手段５を制御する指令値を作成して送信する。例えば、前記前後加速度発生手段５が油圧式摩擦ブレーキであり、油圧指令値を油圧式摩擦ブレーキ制御器に送ることで前後加速度制御を行う場合には、前後加速度指令値ＧxREQfinに基づいて油圧指令値を作成し、作成した油圧指令値を制御指令値として送信する。
【０１２４】
これにより、車両に前後加速度指令値ＧxREQfinに基づく前後加速度を発生させる。
【０１２５】
また、上述のように、前後加速度指令値を実現する指令を複数の前後加速度発生手段５に送信してもよい。例えば、カーブ遠方からの前後加速度指令値であるＧxREQiniPP2に基づいて作成された前後加速度を実現する前後加速度発生手段５を前記変速機もしくはエンジン、またはその両方とし、カーブ近傍での前後加速度指令値であるＧxREQiniPP1、およびＧxREQiniPP0に基づいて作成された前後加速度を実現する前後加速度発生手段５として更に前記油圧摩擦ブレーキを加えることができる。
【０１２６】
これにより、カーブ遠方の比較的一定な減速を、エンジンのスロットル開度や変速機のギア比を変更することによりエンジンブレーキでの減速を行い、カーブ近傍の変化が大きい減速を、油圧摩擦ブレーキにより実現することができる。これにより、ドライバがカーブ遠方で進行方向にある程度カーブ曲率の大きいカーブを視認した際に、アクセルをオフにしてエンジンブレーキによる減速を行い、カーブ近傍にてカーブ曲率変化を明確に認識してからブレーキを操作して減速を行うことと同様の減速を実現することができる。
【０１２７】
以上のように、本実施形態では、車両に発生する減速が、カーブ遠方の減速からカーブ近傍への減速へと減速パターンが変化することで、ドライバが前方のカーブを詳細に認識する前から過度の減速を行うことなく、ドライバフィーリングを向上させることができる。また、最大横加速度推定値やドライバのアクセル操作、道路勾配、旋回方向といった他の情報を利用して比例ゲインを補正することで、ドライバフィーリングをより一層向上させることができる。
【０１２８】
（発明を実施するための第２の実施形態）
以下、図２２〜図２６を用いて、本発明の第２の実施形態による車両運動制御装置の構成及び動作について説明する。なお、第１の実施形態と同様の構成については同符号を付してその詳細な説明を省略する。
【０１２９】
最初に、図２２を用いて、本発明の第２の実施形態による車両運動制御装置の構成について説明する。
【０１３０】
図２２は、本発明の第２の実施形態による車両運動制御装置の構成を示すシステムブロック図を示したものである。
【０１３１】
第２の実施形態の車両運動制御装置１′は車両に搭載されるものであり、自車両前方のカーブ形状を取得するカーブ形状取得手段２と、自車位置を取得する自車位置取得手段３と、車両運動情報取得手段６と、ドライバ入力情報取得手段７と、横運動連係前後加速度取得手段８と、路面情報取得手段９を備えると共に、前記カーブ形状取得手段２と前記自車位置取得手段３、および前記車両運動情報取得手段６、前記ドライバ入力情報取得手段７、前記横運動連係前後加速度取得手段８と、前記路面情報取得手段９とにより得られた情報に基づいて車両に発生させる前後加速度を演算する車両運動制御演算手段４′を備える。
【０１３２】
また、前記車両運動制御演算手段４′の演算結果は、前後加速度発生手段５および情報提示器１０に送られ、車両に前後加速度を発生させることのできるアクチュエータの駆動、およびドライバへの情報提示を行う。
【０１３３】
ここで、カーブ形状取得手段２、自車位置を取得する自車位置取得手段３、および前後加速度発生手段５は上述の第１の実施形態と同様であるため、その詳細な説明は省略する。
【０１３４】
前記車両運動情報取得手段６では、車両の運動情報として、少なくとも車両速度Ｖもしくは前後加速度Ｇx、またはその両方を取得する。ここで、車両速度Ｖ及び前後加速度Ｇxはセンサ等により直接検出された値を取得しても、他の電子制御器が演算した結果を通信により取得してもよい。
【０１３５】
また、車両速度Ｖおよび前後加速度Ｇxそのものが入力されなくとも、これらを推定可能な値であればよい。例えば、車両速度Ｖの代わりに各車輪の車輪速度Ｖｗ［ｗｈｅｅｌ］（ｗｈｅｅｌにはＦＬ（左前輪），ＦＲ（右前輪），ＲＬ（左後輪），ＲＲ（右前輪）がそれぞれ入る）を取得して、車両速度Ｖを推定してもよい。
【０１３６】
ドライバ入力情報取得手段７では、ドライバからの入力情報として、少なくともドライバ要求前後加速度ＧxDrvREQを取得する。ここで、ドライバ要求前後加速度ＧxDrvREQは、ドライバが直接入力した値を取得しても、他の電子制御器が演算した結果を通信により取得してもよい。また、ドライバ要求加速度ＧxDrvREQそのものが入力されなくとも、これを推定可能な値であればよい。例えば、ドライバ要求前後加速度ＧxDrvREQの代わりに、アクセルペダル操作量やブレーキペダル操作量から、ドライバ要求前後加速度ＧxDrvREQを推定してもよい。また、アクセルペダル操作量のみから、ブレーキ操作による減速を除いたドライバ要求前後加速度ＧxDrvREQを推定してもよい。
【０１３７】
また、エンジンを駆動源とした車両であれば、エンジントルク、およびシフトポジションの情報を取得し、ドライバ要求前後加速度ＧxDrvREQを推定してもよい。また、ドライバ要求前後加速度ＧxDrvREQの他に制御のＯＮ／ＯＦＦ情報や、ドライバが制御量を調整、もしくは選択した際の値を取得してもよい。
【０１３８】
横運動連係前後加速度取得手段８では、例えば特許文献２や非特許文献１に示されている車両の横加加速度に基づく前後加速度ＧxGVCを取得する。ここで、前後加速度ＧxGVCそのものが入力されなくとも、これを推定可能な値であればよい。例えば、前後加速度ＧxGVCの代わりに横加加速度を取得して前後加速度ＧxGVCを演算してもよい。また、操舵角やヨーレイト、横加速度といった横運動情報を取得して前後加速度ＧxGVCを演算してもよい。
【０１３９】
路面情報取得手段９では、路面情報として、少なくとも路面摩擦係数μおよび路面縦断勾配Ｇｒａｄを取得する。ここで、路面摩擦係数μおよび路面縦断勾配Ｇｒａｄそのものが入力されなくとも、これを推定可能な値であればよい。例えば、路面摩擦係数μの代わりに前後加速度Ｇx、前記各車輪速Ｖｗ［ｗｈｅｅｌ］、前記車両速度Ｖ等を取得して路面摩擦係数μを推定する方法であってもよい。また、操舵により発生するセルフアライニングトルクを取得して路面摩擦係数μを推定する方法であってもよい。
【０１４０】
また、各車輪の制駆動力Ｆwx［ｗｈｅｅｌ］、もしくはそれに代わる情報（例えばエンジントルクやブレーキ圧）を取得して路面摩擦係数μを推定する方法であってもよい。また、路面縦断勾配Ｇｒａｄの代わりに、各車輪の制駆動力Ｆwx［ｗｈｅｅｌ］、もしくはそれに代わる情報（例えばエンジントルクやブレーキ圧）と車両の前後加速度Ｇxを取得し、車輪で発生している力と実際に発生した前後加速度の差分から路面縦断勾配Ｇｒａｄを推定してもよい。また、平坦路での車両前後方向の加速度を測定するよう取り付けられた加速度センサによる値（情報）を取得し、車両速度Ｖを微分して得られた前後加速度の差分から路面縦断勾配Ｇｒａｄを推定してもよい。
【０１４１】
車両運動制御演算手段４′は、記憶領域、および演算処理能力、および信号の入出力手段を有する演算装置であり、前記カーブ形状取得手段２と前記自車位置取得手段３、および前記車両運動情報取得手段６，前記ドライバ入力情報取得手段７，前記横運動連係前後加速度取得手段８と、前記路面情報取得手段９により得られた情報に基づいて車両に発生させる前後加速度、およびドライバへの情報提示を演算し、前後加速度発生手段５および情報提示器１０に指令値を送る。ここで、前後加速度発生手段５に送る指令値としては、上述の第１の実施形態と同様に対象とする加減速アクチュエータに応じた指令値とする。
【０１４２】
また、情報提示器１０としては、ドライバが五感の少なくとも一つにより認識可能な情報を提示する情報提示器とし、情報提示器１０に送る指令値としては、前記情報提示器を駆動可能な指令値とする。例えば、表示ランプやディスプレイのようにドライバの視覚に情報を与える表示器を情報提示器１０とする場合、車両に発生させる前後加速度に基づいて表示ランプの点灯やディスプレイへの表示を行う指令値を送る。
【０１４３】
また、ビープ音や音声のようにドライバの聴覚に情報を与える音発生器を情報提示器１０とする場合、車両に発生させる前後加速度に基づいてビープ音や音声による案内をする指令値を送る。
【０１４４】
また、ハンドルやペダル，シートの振動等のようにドライバの触覚に情報を与える振動発生器を情報提示器１０とする場合、車両に発生させる前後加速度に基づいてハンドルやペダル、シートを振動する振動発生器に指令値を送る。また、情報提示器１０として、前記表示器，音発生器，振動発生器を組合せて用いてもよい。
【０１４５】
以下、前記カーブ形状取得手段２として自車両が走行するコースの地図情報、前記自車位置取得手段３としてＧＰＳを用い、車両運動情報取得手段６，ドライバ入力情報取得手段７，横運動連係前後加速度取得手段８，路面情報取得手段９として、他の電子制御器との通信手段を用いて、車両速度Ｖ，前後加速度Ｇx，ドライバ要求前後加速度ＧxDrvREQ，横運動連係前後加速度ＧxGVC，路面摩擦係数μ，路面縦断勾配Ｇｒａｄを取得し、さらに他の電子制御器との通信手段、もしくはスイッチ等の入力手段を用いて、前後加速度制御スイッチＯＮ／ＯＦＦ情報Ｆctrlsw，ドライバ設定値ＧDrvSetを取得する場合での前後加速度指令値の作成方法について説明する。
【０１４６】
ここで、前記車両運動制御演算手段４′は、図２３に示すように、自車両の位置から前方注視点までの前方注視距離を算出する前方注視距離算出手段４２′と、前後加速度制御スイッチＯＮ／ＯＦＦ情報と、自車両の速度と、カーブ形状と、自車両の位置と横運動連係前後加速度とに基づいて前後加速度制御モードを演算する前後加速度制御モード演算手段４５と、演算された前記前後加速度制御モードに基づいて前記前方注視距離におけるカーブ曲率及びカーブ曲率の時間変化を算出するカーブ曲率算出手段４３′と、前記前方注視距離におけるカーブ曲率及びカーブ曲率の時間変化と、前記車両速度とに基づいて前後加速度指令値を演算する前後加速度指令値演算手段４４′と、演算された前記前後加速度制御モードに基づいて演算された前記前後加速度指令値を実現する制御指令値を出力する制御指令値出力手段４６とを備える。また、前記車両運動制御演算手段４′は、最大横加速度推定値や、自車両前方の縦断勾配を除いた道路勾配、ドライバのペダル操作、前記旋回方向のうちの少なくともいずれか一つに基づいて前後加速度指令値を変化させる比例ゲインを演算する比例ゲイン演算部を備える。
【０１４７】
図２４は、第２の実施形態の車両運動制御装置１′における演算フローチャートを示したものである。
【０１４８】
Ｓ０１０では、第１の実施形態１と同様に、カーブ形状、および自車位置データを取得して演算を行う。演算後Ｓ０１１へと進む。
【０１４９】
Ｓ０１１では、車両速度Ｖ，前後加速度Ｇx，ドライバ要求前後加速度ＧxDrvREQ，横運動連係前後加速度ＧxGVC，路面摩擦係数μ，路面縦断勾配Ｇｒａｄ，前後加速度制御スイッチＯＮ／ＯＦＦ情報Ｆctrlsw，ドライバ設定値ＧDrvSet等の車両運動情報，ドライバ入力情報，路面情報，横運動連係前後加速度を取得する。また、上述のように、これらの値を直接取得せずに推定を行う場合には、推定に必要なデータを取得して演算を行う。演算後Ｓ１１０へと進む。
【０１５０】
Ｓ１１０では、第１の実施形態と同様にＧＰＳによる自車位置データＰv（Ｘv，Ｙv）が更新されたか否かの判定を行い、データが更新されていればデータ更新フラグＦGPSrefを１、されていなければ０とする。演算後Ｓ１１１へ進む。
【０１５１】
Ｓ１１１では、Ｓ０１０で得られたカーブ形状・自車位置データの更新を行う。Ｓ１１０にて演算されたデータ更新フラグが０である場合、すなわちＳ０１０にて取得するＧＰＳによる自車位置データが更新されず、Ｓ０１１にて取得する車両運動情報等のデータのみが更新されている場合には、Ｓ０１０で得られたカーブ形状・自車位置データと車両運動情報により得られた車両速度Ｖから演算される自車両の移動距離に基づいて、カーブ形状・自車位置データを更新する。
【０１５２】
例えば、ある時間ｔ０においてデータ更新フラグが１、すなわちＧＰＳによるデータ更新が行われたとし、この時に得られたカーブ形状データをＰt0_n（Ｘt0_n，Ｙt0_n）（ｎは０以上ｎｍａｘ_ｔ０以下の整数）、自車位置データをＰt0_V（Ｘt0_V，Ｙt0_V）とする。
【０１５３】
また、図２５に示すように、この時のノード点Ｐt0_n，Ｐt0_n+1の距離をＤt0_n+1、自車位置Ｐt0_Vとノード点Ｐt0_1の距離をＤt0_V1とする。ｔ０のΔｔv後であるｔ１での演算では、データ更新フラグが０、すなわちＧＰＳによるデータ更新が行われず、車両運動情報等の更新のみが行われた場合、車両速度ＶとΔｔvから自車両の移動距離Ｄt1_Vを算出し、自車位置と各ノード点の位置関係を更新する。
【０１５４】
本実施形態では、上述の通り、自車両の進行方向と逆方向にある最初のノード点をＰ0と設定している。そのため、Ｄt1_VとＤt0_V1の大小関係により、各ノード点の番号ｎが変わることになる。Ｄt1_VがＤt0_V1以下の場合には、図２５（ａ）に示すように、ｔ１においても自車位置はノード点Ｐt0_0、Ｐt0_1の間にあるため、ｔ１における各ノード点および、ノード点間距離、ノード点番号の最大値ｎｍａｘ_ｔ１、およびＤt1_V1は以下の式（２２）〜（２５）で与えられる。
【０１５５】
【数２２】
0005417386.tif 000023
【０１５６】
【数２３】
0005417386.tif 000024
【０１５７】
【数２４】
0005417386.tif 000025
【０１５８】
【数２５】
0005417386.tif 000026
【０１５９】
また、Ｄt1_VがＤt0_V1よりも大きい場合、ｔ１において自車位置がノード点Ｐt0_1よりも先にあるため、ｔ１における各ノード点および、ノード点間距離、およびＤt1_V1は以下の式（２６）〜（２９）で与えられる。
【０１６０】
【数２６】
0005417386.tif 000027
【０１６１】
【数２７】
0005417386.tif 000028
【０１６２】
【数２８】
0005417386.tif 000029
【０１６３】
【数２９】
0005417386.tif 000030
【０１６４】
ここで、ｋは式（２９）で得られるＤt1_V1が０以上、かつｎｍａｘ_ｔ１が正となる最小の整数である。
【０１６５】
例えば、図２５（ｂ）に示すように、自車位置がノード点Ｐt0_1，Ｐt0_2の間にある場合には、ｋは１となる。Ｓ０１０で得られたカーブ形状データのうち、上述の条件を満たすｋが存在しない場合には、ｎｍａｘ_ｔ０をｋとする。また、データ更新フラグが１であれば、Ｓ０１０で得られた各ノード点でのデータ、および自車位置データを、カーブ形状データ、および自車位置データとする。演算後Ｓ３１０へと進む。
【０１６６】
Ｓ３１０では、図２３に示す前方注視距離算出手段４２′によって、前方注視距離の演算を行う。上述の第１の実施形態と同様に、自車両進行方向のコース上に自車両の極近傍から遠方まで前方注視点ＰＰ０，ＰＰ１，ＰＰ２という３つの前方注視点を設定し、自車両から前方注視点ＰＰ０，ＰＰ１，ＰＰ２までの前方注視距離ＬPP0，ＬPP1，ＬPP2を算出する。
【０１６７】
ここで、前方注視距離ＬPP0，ＬPP1，ＬPP2は上述の式（１０）の関係を満たすように予め設定される値であっても、予め設定される前方注視時間ＴPP0，ＴPP1，ＴPP2（ただしＴPP0＜ＴPP1＜ＴPP2）と車両速度Ｖを用いて、それぞれ上述の式（１１）に示すように与えてもよい。
【０１６８】
また、路面摩擦係数μに応じて前方注視距離ＬPP0，ＬPP1，ＬPP2を変更してもよい。例えば、路面摩擦係数μがある所定の値以下であれば、路面摩擦係数μが小さいほど前方注視距離ＬPP0，ＬPP1，ＬPP2が長くなるように変更する。ただし、前方注視点ＰＰ０は自車両の極近傍の注視点とし、Ｌmaxは自車位置からノード点位置Ｐ1までの距離とノード点位置Ｐ1からノード点位置Ｐnmaxまでの各ノード点間距離を合計した値である。演算後Ｓ４１０へと進む。
【０１６９】
Ｓ４１０では、図２３に示す前後加速度制御モード演算手段４５によって、前後加速度制御モードＧxModeの演算を行う。前後加速度制御モードＧxModeは、その値が０の時には前後加速度制御を行わず、その値が１の時には横運動連係前後加速度ＧxGVCに基づく前後加速度制御を行い、さらに２の時には横運動連係前後加速度ＧxGVCおよび自車位置データ、およびカーブ形状データに基づく前後加速度制御を行うように設定される値である。
【０１７０】
前後加速度制御モードＧxModeの作成方法としては、例えば前後加速度制御スイッチＯＮ／ＯＦＦ情報Ｆctrlswにおいて、前後加速度制御スイッチＯＦＦの時のＦctrlswが０、前後加速度制御スイッチＯＮの時のＦctrlswが１とすると、Ｆctrlswが０の時には前後加速度制御モードＧxModeを０とする。
【０１７１】
また、車両速度Ｖにより前後加速度制御モードＧxModeを０としてもよい。
【０１７２】
例えば、制御を開始する最低車両速度を予め設定しておき、最低車両速度よりも車両速度Ｖが小さければ、前後加速度制御モードＧxModeを０とする。
【０１７３】
また、横運動連係前後加速度ＧxGVCの取得が困難、かつ自車位置データ、およびカーブ形状データの取得が困難な際に前後加速度制御モードＧxModeを０とする。前後加速度制御モードＧxModeが０となる条件にない場合、カーブ形状データ、および自車位置データの状況に応じて、前後加速度制御モードＧxModeを１もしくは２とする。
【０１７４】
例えば、前記データ更新フラグＦGPSrefが０となっている時間が所定時間以上となった場合、ＧＰＳによる自車位置データの取得が困難として前後加速度制御モードＧxModeを１とする。また、Ｓ１１１の式（２９）で演算されたＤt1_V1が０の場合には、前後加速度制御モードＧxModeを１とする。また、自車位置データによる走行軌跡と地図データ上で自車が走行していると想定しているコース形状との乖離が大きい場合には、地図データ上の自車の走行コースが実際のコースと異なるとして、前後加速度制御モードＧxModeを１とする。
【０１７５】
また、車両運動として車両速度Ｖに加えて、操舵角やヨーレイト、横加速度といった横運動情報が取得可能である場合、これらから推定される走行軌跡とＧＰＳにより得られた自車位置軌跡をそれぞれ演算し、これらの乖離が大きければ、ＧＰＳの精度が低下しているとして、前後加速度制御モードＧxModeを１とする。また、これら以外の条件では前後加速度制御モードＧxModeを２とする。
【０１７６】
これにより、ＧＰＳによるデータ取得が困難な状況においても、横運動連係前後加速度ＧxGVCに基づく前後加速度制御を実施することができる。演算後Ｓ５１０へ進む。
【０１７７】
Ｓ５１０では、図２３に示すカーブ曲率算出手段４３′によって、前記前後加速度制御モードＧxModeが２であれば、上述の第１の実施形態のＳ５００と同様に、カーブ曲率，カーブ曲率変化を演算し、それ以外であれば、カーブ曲率，カーブ曲率変化を共に０とする。演算後、Ｓ６１０へと進む。
【０１７８】
Ｓ６１０では、図２３に示す前後加速度指令値演算手段４４′によって前方注視距離ＬPP0，ＬPP1，ＬPP2でのカーブ曲率κPP0，κPP1，κPP2、およびカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP1／ｄｘ，ｄκPP2／ｄｘ、および車両速度Ｖに基づいて前後加速度指令値初期値を作成する。ここで、車両近傍のカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP1／ｄｘによる前後加速度指令値ＧxREQiniPP0，ＧxREQiniPP1は上述の式（６）により算出し、車両遠方のカーブ曲率κPP2による前後加速度指令値ＧxREQiniPP2は、上述の式（７）により算出する。
【０１７９】
ここで、前方注視距離ＬPP0，ＬPP1，ＬPP2を上述の式（１１）で示した前方注視時間ＴPP0，ＴPP1，ＴPP2で作成するとした場合、前方注視点ＰＰ０，ＰＰ１，ＰＰ２の移動速度ＶPP0，ＶPP1，ＶPP2は、前後加速度Ｇxを用いて、上述の式（２０）で与えられる。また、これにより得られた値から、前後加速度指令値ＧxREQiniPP0，ＧxREQiniPP1を上述の式（２１）により演算する。また、上述の式（７）からＧxREQiniPP2を演算する。ここで、Ｃxy0，Ｃxy1、およびＣxは、路面摩擦係数μやドライバ要求前後加速度ＧxDrvREQにより変化する値である。
【０１８０】
その設定方法としては、例えばｄκPPm／ｄｘが正の場合の定数として予め設定された値Ｃxy0_ini，Ｃxy1_ini、およびＣx_iniと路面摩擦係数μよる補正係数ｋμ、およびドライバ要求前後加速度ＧxDrvREQによる補正係数ｋＧxDrvを用いて以下の式（３０）〜（３１）で与える。
【０１８１】
【数３０】
0005417386.tif 000031
【０１８２】
【数３１】
0005417386.tif 000032
【０１８３】
ここで、補正係数ｋμおよびｋＧxDrvは０から１の値であり、ｋμは路面摩擦係数μが小さい領域では大きい領域よりもその値が小さくなるように設定し、ｋＧxDrvはドライバ要求前後加速度ＧxDrvREQがある値以上では、その増加に応じて減少し、最終的に０となるように設定する。また、ＧxREQiniPP2を演算する際、式（７）におけるＧySET、およびＧxREQfar_minは路面摩擦係数μに応じて値を変更する。例えば、路面摩擦係数μがある値以下では、ＧySETおよびＧxREQfar_minを小さな値に変更する。
【０１８４】
また、第１の実施形態で述べたように、Ｃxy0，Ｃxy1、およびＣxは、上述の図６に示した補正ゲインのうち、縦断勾配による補正を除いた補正ゲインを、予め設定される定数Ｃxy00，Ｃxy10、およびＣx0に積算することで演算してもよい。ここで、定数Ｃxy00，Ｃxy10およびＣx0は、ｄκPPm／ｄｘが正の場合とｄκPPm／ｄｘが負の場合で異なる値としてもよい。演算後、Ｓ６１１へと進む。
【０１８５】
Ｓ６１１では、前後加速度指令値初期値を路面縦断勾配Ｇｒａｄによって補正した、前後加速度指令値補正値ＧxREQhoseiPPm（ｍ＝０，１，２）を作成する。ここで、路面縦断勾配Ｇｒａｄにより車両に発生する前後加速度ＧxGradを用いて、前後加速度指令値補正値を以下の式（３２）で与える。
【０１８６】
【数３２】
0005417386.tif 000033
【０１８７】
ここで、前後加速度ＧxGradは上り勾配で負、下り勾配で正となる値である。
【０１８８】
このように、本第２の実施形態では、縦断勾配による補正を加算することで補正する方法について示しているが、加算ではなく、上述の図６に示したように、縦断勾配に基づく補正ゲインを積算することで補正を行ってもよい。演算後Ｓ７１０へと進む。
【０１８９】
Ｓ７１０では、前後加速度指令値補正値ＧxREQhoseiPP0，ＧxREQhoseiPP1，ＧxREQhoseiPP2に前後加速度制御の介入閾値による処理や、フィルタ処理，セレクト処理，加算処理等を行って得られた値ＧxREQfinに、更に横運動連係前後加速度ＧxGVCを組合せることで、最終的な前後加速度指令値ＧxREQfinGVCを作成する。ここで、ＧxREQfinの演算は、上述の第１の実施形態に示したＳ７００での演算のＧxREQiniPP0，ＧxREQiniPP1，ＧxREQiniPP2を、それぞれＧxREQhoseiPP0，ＧxREQhoseiPP1，ＧxREQhoseiPP2として同様の演算を行う。前記ＧxREQfinと横運動連係前後加速度ＧxGVCの組合せ方法としては、例えば図２６に示すように、両者が同符合の場合にはその絶対値の大きい方をＧxREQfinGVCとし、異符合の場合には両者を加算した値をＧxREQfinGVCとする。
【０１９０】
また、両者を加算する際に重み付けをして加算してもよい。
【０１９１】
ここで、前後加速度指令値ＧxREQfinGVCの演算方法として、ＧxREQfinを演算してからＧxGVCと組合せる方法について説明したが、この方法に限ったものではない。例えば、ＧxREQfinを演算する際の自車両の極近傍の前方注視点ＰＰ０による前後加速度指令値補正値ＧxREQhoseiPP0の代わりに、ＧxGVCを用いてＧxREQfinを演算し、この値を前後加速度指令値ＧxREQfinGVCとしてもよい。演算後Ｓ８１０へと進む。
【０１９２】
Ｓ８１０では、図２３に示す制御指令値出力手段４６によって、前後加速度制御モードが１もしくは２であれば、前後加速度指令値ＧxREQfinGVCを実現する指令値を、前後加速度制御モードが０であれば、前後加速度制御を行わないようにする指令値を前記前後加速度発生手段５へ送信し、同時に前後加速度制御状態に応じた情報提示指令値を情報提示器１０へと送信する。
【０１９３】
ここで、前後加速度制御モードが０以外の時に送信する信号としては、上述の通り、前後加速度指令値ＧxREQfinGVCを送信することで前記前後加速度発生手段５により前後加速度指令値ＧxREQfinGVCを実現することができる場合には、前後加速度指令値ＧxREQfinGVCを制御指令値として送信する。
【０１９４】
また、前記前後加速度発生手段５に応じた指令値にする必要がある場合には、前後加速度指令値ＧxREQfinGVCに基づいて前記前後加速度発生手段５を制御する指令値を作成して送信する。例えば、前記前後加速度発生手段５が油圧式摩擦ブレーキであって、油圧指令値を油圧式摩擦ブレーキ制御器に送ることで前後加速度制御を行う場合、前後加速度指令値ＧxREQfinGVCに基づいて油圧指令値を作成し、作成した油圧指令値を制御指令値として送信する。これにより、車両に前後加速度指令値ＧxREQfinGVCに基づく前後加速度を発生させることができる。
【０１９５】
また、上述のように、前後加速度指令値を実現する指令を複数の前後加速度発生手段５に送信してもよい。例えば、自車位置がカーブ遠方での前後加速度指令値であるＧxREQhoseiPP2に基づいて作成された前後加速度を実現する前後加速度発生手段５を、前記変速機もしくはエンジン、またはその両方とし、カーブ近傍での前後加速度指令値であるＧxREQhoseiPP1，ＧxREQhoseiPP0およびＧxGVCに基づいて作成された前後加速度を実現する前後加速度発生手段５として更に前記油圧摩擦ブレーキを加えることができる。
【０１９６】
これにより、カーブ遠方の比較的一定な減速をエンジンのスロットル開度や変速機のギア比を変更することでエンジンブレーキによる減速を行い、カーブ近傍の変化が大きい減速を油圧摩擦ブレーキにより実現することができる。これにより、ドライバがカーブ遠方で進行方向にある程度カーブ曲率の大きいカーブを視認した際に、アクセルをオフにしてエンジンブレーキによる減速を行い、カーブ近傍にてカーブ曲率変化を明確に認識してからブレーキを操作して減速を行うことと同様の減速を実現することができる。
【０１９７】
情報提示器１０への指令値としては、例えば前後加速度制御中であることをドライバへ伝えるよう表示器、または音発生器への駆動指令値を送信する。また、前後加速度制御モードが１の時には、カーブ前での減速が行われないことと、その理由をドライバへ伝えるよう表示器、または音発生器への駆動指令値を送信する。
【０１９８】
また、本第２の実施形態で用いた予め設定する値（例えば、前方注視時間ＴPP0，ＴPP1，ＴPP2や横加速度設定値ＧySET）は、ドライバ設定値ＧDrvSetに応じて変更してもよい。例えば、ドライバ設定値ＧDrvSetが０〜１０の値を取るとし、ドライバ設定値ＧDrvSetが０では、前方注視点によるカーブ前からの前後加速度制御を行わず、横運動連係前後加速度ＧxGVCによる前後加速度制御のみを行うものとし、ドライバ設定値ＧDrvSetが大きいほどカーブ遠方からの減速が大きくなるとした場合には、ドライバ設定値ＧDrvSetが０では前方注視時間ＴPP0、ＴPP1、ＴPP2を全て非常に小さな値とし、ＧDrvSetの増加に応じてＴPP2を大きな値とし、横加速度設定値ＧySETを小さな値としてもよい。これにより、カーブ遠方からの減速度が変化するため、ドライバの嗜好に応じてカーブ前の減速開始タイミングやその減速量を変更することができる。ここで、ドライバ設定値ＧDrvSetに応じて、前方注視時間ＴPP0，ＴPP1，ＴPP2ではなく、上述の図８に示したＧyset1，Ｇyset2，Ｇyset3，Ｇyset4，Ｇyset5、およびＣadjGy1，ＣadjGy2を変更することで、発生する減速量を変更してもよい。
【０１９９】
以上のように、第２の実施形態では、自車位置がカーブ遠方にある時の減速からカーブ近傍に近づいた時の減速へと減速パターンを変化させるに当たり、車両運動情報や路面情報を用いることで、よりドライバフィーリングにあった前後加速度制御を実現することができる。また、最大横加速度推定値やドライバのアクセル操作、道路の横勾配、旋回方向といった他の情報を利用して比例ゲインを補正することで、ドライバフィーリングをより一層向上させることができる。
【０２００】
（発明を実施するための第３の実施形態）
以下、図２７及び図２８を用いて、本発明の第３の実施形態とその変形形態による車両運動制御装置の構成及び動作について説明する。なお、第１，２の実施形態と同様の構成については同符号を付してその詳細な説明を省略する。
【０２０１】
最初に、図２７を用いて、本発明の第３の実施形態による車両運動制御装置の構成について説明する。
【０２０２】
図２７は、本発明の第３の実施形態による車両運動制御装置の構成を示すシステムブロック図を示したものである。
【０２０３】
第３の実施形態の車両運動制御装置１″は、自車両前方のカーブ形状を取得するカーブ形状取得手段２と、自車位置を取得する自車位置取得手段３と、車載電子制御器１２と通信する車両通信手段１１と、前記カーブ形状取得手段２と前記自車位置取得手段３、および前記車両通信手段１１により得られた情報に基づいて車両に発生させる前後加速度を演算する車両運動制御演算手段４″を備える。
【０２０４】
また、前記車両運動制御演算手段４″の演算結果は、車両通信手段１１および車載電子制御器１２を介して前後加速度発生手段５および情報提示器１０に送られ、車両に前後加速度を発生させることのできるアクチュエータの駆動を行う。ここで、車載電子制御器１２は、車両運動制御装置１″と通信する手段であり、且つ前後加速度発生手段５および情報提示器１０を駆動制御可能な車載の電子制御器である。また、前後加速度発生手段５を駆動制御する際に、車両に前後加速度を発生させる加減速アクチュエータを車載電子制御器１２が直接駆動制御しても、加減速アクチュエータを制御する電子制御器との通信により、加減速アクチュエータを駆動制御してもよい。同様に、情報提示器１０を駆動制御する際に、情報提示器を車載電子制御器１２が直接駆動制御しても、情報提示器を制御する電子制御器との通信により、情報提示器を駆動制御してもよい。また、本第３の実施形態の車両運動制御装置１″は、必ずしも車両に組込まれている必要はなく、ドライバが容易に持ち出し可能な形状であってもよい。このように、車載電子制御器１２を設けることにより、車両運動制御装置１″の小型化を実現することができる。
【０２０５】
ここで、カーブ形状取得手段２、自車位置を取得する自車位置取得手段３、および前後加速度発生手段５、情報提示器１０は上述の第１，２の実施形態と同様であるため、その説明は省略する。
【０２０６】
車両運動制御演算手段４″は、前記カーブ形状取得手段２と前記自車位置取得手段３、前記車両通信手段１１により得られた情報に基づいて車両に発生させる前後加速度指令値を作成し、前記車両通信手段１１を介して、車載電子制御器１２と通信をすることで、車両の前後加速度制御を行う。ここで、本実施形態での前後加速度指令値の作成方法は、上述の第１の実施形態と同様であるため、その説明は省略する。
【０２０７】
車両通信手段１１は、車両に搭載された車載電子制御器１２と通信する手段である。例えば、車両運動制御装置１″と車載電子制御器１２をコネクタにより結線することで、車両に搭載された電子制御器と通信する方法であっても、予め車両運動制御装置１″の識別符号を車両に搭載された車載電子制御器１２に登録しておき、無線通信により車載電子制御器１２と通信する方法であってもよい。
【０２０８】
ここで、前後加速度発生手段５および情報提示器１０が車両通信手段１１と通信する手段を備える場合、図２８に示すように、第３の実施形態の変形形態として、車両運動制御装置１″が車両通信手段１１を介して、直接前後加速度発生手段５および情報提示器１０と通信して前後加速度発生手段５および情報提示器１０の駆動制御をしてもよい。
【０２０９】
これにより、ＧＰＳ搭載の携帯電話、もしくは小型の携帯ナビゲーション機器等に本実施形態を組込むことが可能となり、ドライバは自分の携帯電話、もしくは小型の携帯ナビゲーション機器を車両に持ち込むことで、本実施形態の前後加速度制御を実現することができる。
【０２１０】
（発明を実施するための第４の実施形態）
以下、図２９を用いて、本発明の第４の実施形態による車両運動制御装置の構成及び動作について説明する。なお、第１〜３の実施形態と同様の構成については同符号を付してその詳細な説明を省略する。
【０２１１】
図２９は、本発明の第４の実施形態による車両運動制御装置の構成を示すシステムブロック図を示したものである。
【０２１２】
第４の実施形態の車両運動制御装置１′′′は、自車両前方のカーブ形状を取得するカーブ形状取得手段２と、自車位置を取得する自車位置取得手段３と、車載電子制御器１２と通信する車両通信手段１１と、設定情報取得手段１３とを備え、前記カーブ形状取得手段２、前記自車位置取得手段３、前記設定情報取得手段１３、および前記車両通信手段１１により得られた情報に基づいて車両に発生させる前後加速度を演算する車両運動制御演算手段４′′′を備える。
【０２１３】
また、前記車両運動制御演算手段４′′′の演算結果は、車両通信手段１１および車載電子制御器１２を介して前後加速度発生手段５および情報提示器１０に送られ、車両に前後加速度を発生させることのできるアクチュエータの駆動を行う。また、本第４の実施形態の車両運動制御装置１′′′は、必ずしも車両に組込まれている必要はなく、ドライバが容易に持ち出し可能な形状であってもよい。
【０２１４】
ここで、カーブ形状取得手段２、自車位置を取得する自車位置取得手段３、および前後加速度発生手段５、情報提示器１０、車両通信手段１１、車載電子制御器１２は上述の第１，２，３の実施形態と同様であるため、その説明は省略する。
【０２１５】
設定情報取得手段１３は、上述の前方注視時間ＴPP0，ＴPP1，ＴPP2や横加速度設定値ＧySET等、ドライバが設定可能な定数の設定情報、もしくは予めいくつかの設定された定数の組合せにより、複数の制御モードを備える場合は、その制御モードの選択した設定情報を取得する。例えば、上記前方注視時間ＴPP0，ＴPP1，ＴPP2や横加速度設定値ＧySETをある範囲内でドライバが直接入力し、その入力された値を設定情報としてもよい。
【０２１６】
また、“スポーツモード”や“ノーマルモード”といったいくつかの定数の組合せによる制御モードを有し、ドライバが選択した制御モードに対応する定数を設定情報としてもよい。
【０２１７】
車両運動制御演算手段４′′′は、前記設定情報取得手段１３により取得した設定情報を記憶する手段を備え、前記カーブ形状取得手段２と前記自車位置取得手段３、前記設定情報取得手段１３、前記車両通信手段１１により得られた情報に基づいて車両に発生させる前後加速度指令値を作成し、前記車両通信手段１１を介して車載電子制御器１２と通信をすることで車両の前後加速度制御を行う。ここで、本実施形態での前後加速度指令値の作成方法は、上述の実施形態１，２と同様であるため、その説明は省略する。
【０２１８】
これにより、ＧＰＳ搭載の携帯電話、もしくは小型の携帯ナビゲーション機器等に本実施形態を組込むことが可能となり、更にドライバ毎にその設定を変更することが可能となる。これにより、一台の車両を複数人でシェアする状況にあっても、ドライバは自分で定数を設定した携帯電話、もしくは小型の携帯ナビゲーション機器を車両に持ち込むことで、自分で設定した本実施形態の前後加速度制御を実現することができる。
【０２１９】
（発明を実施するための第５の実施形態）
以下、図３０〜３４を用いて、本発明の第５の実施形態による車両運動制御装置の構成及び動作について説明する。
【０２２０】
第５の実施形態による車両運動制御装置の構成は、第１の実施形態による車両運動制御装置１の構成と同様であるものの、前後加速度指令値を演算する際の前方注視点の数が異なる。
【０２２１】
図３０は、第５の実施形態による前記車両運動制御装置１における演算フローチャートを示したものである。
【０２２２】
Ｓ０２０では、第１の実施形態と同様にカーブ形状、および自車位置データを取得して演算を行う。演算後Ｓ１２０へと進む。
【０２２３】
Ｓ１２０でも、第１の実施形態と同様に、ＧＰＳによる自車位置データＰv（Ｘv，Ｙv）が更新されたか否かの判定を行い、データが更新されていればデータ更新フラグＦGPSrefを１、されていなければデータ更新フラグＦGPSrefを０とする。演算後Ｓ２２０へと進む。
【０２２４】
Ｓ２２０でも、第１の実施形態と同様に、自車位置の時間変化から車両速度の算出を行う。演算後Ｓ３２０へと進む。
【０２２５】
Ｓ３２０では、前方注視距離の演算を行う。図３１に示すように、自車両進行方向のコース上に自車両の極近傍から遠方まで前方注視点ＰＰ０，ＰＰ３という２つの前方注視点を設定し、自車両から前方注視点ＰＰ０、ＰＰ３までの前方注視距離ＬPP0，ＬPP3を算出する。
【０２２６】
ここで、前方注視距離ＬPP0，ＬPP3は、予め設定される前方注視時間ＴPP0，ＴPP3（ただしＴPP0＜ＴPP3）と車両速度Ｖ、および前方注視点の移動速度ＶPP0，ＶPP3を用いて、式（３３）により与えられる。
【０２２７】
【数３３】
0005417386.tif 000034
【０２２８】
ここで、ＬPP0_z1，ＬPP3_z1は前方注視距離ＬPP0，ＬPP3それぞれの前回値、κPP0_z1，κPP3_z1はカーブ曲率κPP0，κPP3それぞれの前回値、Δｔは演算の単位ステップ時間であり、ｍｉｎ（Ａ，Ｂ）はＡとＢのうちの小さい方の値を選択する関数である。また、前方注視点の移動速度ＶPP0、ＶPP3は、車両速度Ｖを微分して得られる車両前後加速度Ｇx、および前方注視点の移動速度制限値ＶPPlmt0，ＶPPlmt3を用いて、以下の式（３４）で与えられる。ここで、他の制御器との通信や、加速度センサによる直接測定により前後加速度を取得する手段を備える構成であれば、それにより得られた前後加速度から車両前後加速度Ｇxを作成してもよい。
【０２２９】
また、前方注視点の移動速度制限値ＶPPlmt0，ＶPPlmt3は、前方注視距離の前回値ＬPP0_z1，ＬPP3_z1に基づいて予め設定される値であり、図３２に示すように、ＬPP0_z1，ＬPP3_z1がＬPP_nearより小さければＶppmax、ＬPP_near以上ＬPP_lmt以下では、ＬPP0_z1，ＬPP3_z1の増加に応じて下に凸の曲線でその値が減少し、ＬPP_lmtより大きければＶPPminとなるように設定してもよい。
【０２３０】
また、図３３に示すように、前方注視点位置でのカーブ曲率の時間変化制限値ｄκPPlmt0／ｄｔ，ｄκPPlmt3／ｄｔを、ＬPP0_z1，ＬPP3_z1がＬPP_nearより小さければｄκPPmax／ｄｔ、ＬPP_near以上ＬPP_lmt以下ではＬPP0_z1，ＬPP3_z1の増加に応じて下に凸の曲線でその値が減少し、ＬPP_lmtより大きければ０となるように設定し、前方注視点の移動速度制限値ＶPPlmt0，ＶPPlmt3を、それぞれｄκPPlmt0／ｄｔ，ｄκPPlmt3／ｄｔおよび前方注視点位置でのカーブ曲率変化の前回値ｄκPP0_z1／ｄｘ，ｄκPP3_z1／ｄｘを用いて以下の式（３５）で与えてもよい。演算後Ｓ４２０へと進む。
【０２３１】
【数３４】
0005417386.tif 000035
【０２３２】
【数３５】
0005417386.tif 000036
【０２３３】
Ｓ４２０では、第１の実施形態と同様に前後加速度制御許可フラグの演算を行う。演算後Ｓ５２０へと進む。
【０２３４】
Ｓ５２０では、ノード点位置データＰn（Ｘn，Ｙn）からｎが１以上の点における各ノード点位置のカーブ曲率κn、および自車位置のカーブ曲率κvと、ノード点間のカーブ曲率変化ｄκn／ｄｘを算出し、前方注視距離ＬPP0，ＬPP3でのカーブ曲率κPP0，κPP3、およびカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP3／ｄｘを算出する。ここで、カーブ曲率の算出方法としては、連続する３点のノード点Ｐn-1，Ｐn，Ｐn+1を通る円弧のカーブ曲率半径を求め、その逆数をとることでノード点Ｐnのカーブ曲率κnを求めることができる。
【０２３５】
上述の第１の実施形態と同様に、各ノード点のカーブ曲率κn及びカーブ曲率変化ｄκn／ｄｘを算出した後、前方注視距離ＬPP0，ＬPP3に対応したカーブ曲率κPP0，κPP3及びカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP3／ｄｘを算出する。例えば、図３１に示すように、前方注視点ＰＰ０がＰvとＰ1の間、ＰＰ３がＰnとＰn+1の間にある場合には、カーブ曲率κPP0，κPP3及びカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP3／ｄｘは、以下の式（３６）〜（３９）で与えられる。
【０２３６】
【数３６】
0005417386.tif 000037
【０２３７】
【数３７】
0005417386.tif 000038
【０２３８】
【数３８】
0005417386.tif 000039
【０２３９】
【数３９】
0005417386.tif 000040
【０２４０】
ここで、各ノード点のカーブ曲率κn、およびカーブ曲率変化ｄκn／ｄｘの算出方法は上記方法に限らず、各ノード点でのカーブ曲率、およびカーブ曲率変化を算出可能な方法であればよい。演算後Ｓ６２０へと進む。
【０２４１】
Ｓ６２０では、上述の式（４）に示したように、前方注視距離ＬPP0，ＬPP3でのカーブ曲率の時間変化および車両速度Ｖに基づいて前後加速度指令値初期値を作成する。ここで、上述の式（５）で示したように、前方注視点でのカーブ曲率の時間変化は、前方注視点でのカーブ曲率変化ｄκPP／ｄｘ、および前方注視点の移動速度ＶPPにより表わすことができ、前後加速度指令値初期値ＧxREQiniPP0，ＧxREQiniPP3は、上述の式（４）〜（６），（３３）〜（３９）を用いて以下の式（４０）により演算することができる。
【０２４２】
【数４０】
0005417386.tif 000041
【０２４３】
ここで、Ｃxy0，Ｃxy3は、予め設定される定数Ｃxy00，Ｃxy30に上述の図６に示した補正ゲインのうち、利用可能なもの（例えば最大横加速度推定値による補正ゲインＣadjGy）を積算することで得られる値である。ここで、Ｃxy00，Ｃxy30は他の条件に応じて変更する値であってもよい。例えば、ｄκPPm／ｄｘが正の場合とｄκPPm／ｄｘが負の場合とで異なる値としてもよい。演算後、Ｓ７２０へと進む。
【０２４４】
Ｓ７２０では、前後加速度指令値初期値ＧxREQiniPP0，ＧxREQiniPP3に前後加速度制御の介入閾値による処理や、フィルタ処理，セレクト処理，加算処理等を行い、最終的な前後加速度指令値ＧxREQfinを作成する。例えば、前後加速度指令値初期値ＧxREQiniPP0，ＧxREQiniPP3に対して、その符号や増減方向に応じた時定数をそれぞれ設定したフィルタ処理を行い、その値に応じたセレクト処理や加算処理を行う。
【０２４５】
更に、減速側の前後加速度制御介入閾値ＧxBRKs、および加速側の前後加速度制御介入閾値ＧxACCsとし、これらの値による前後加速度制御の介入閾値による処理を行う。ここで、前後加速度制御介入閾値ＧxBRKs，ＧxACCsは予め設定される値である。
【０２４６】
また、前後加速度指令値初期値ＧxREQiniPP0，ＧxREQiniPP3が同時に０以外の値となっている領域では、両者が同符号である場合には、その絶対値が大きい方の値とし、異符合である場合には、両者を加算した値とする。これにより、ＧxREQiniPP0が正でＧxREQiniPP3が負、すなわち自車両極近傍の位置ではカーブ曲率変化が負で、自車両前方にカーブ曲率変化が正となるカーブが存在する場合での減速度を小さくすることができ、連続カーブを走行している際の減速フィーリングを向上させることができる。
【０２４７】
また、ここで加算をする際に、その符号に応じて重み付けをしてもよい。例えば、減速を優先したければ、正となっている値が小さくなるような係数を積算して加算し、逆に加速を優先するのであれば、負となっている値が小さくなるような係数を積算して加算してもよい。
【０２４８】
これにより、図３４に示すようなカーブ曲率κPP0，κPP3、およびカーブ曲率変化ｄκPP0／ｄｘ，ｄκPP3／ｄｘとなるカーブを走行し、点線で示すＧxREQiniPP0、および一点鎖線で示すＧxREQiniPP3が得られた場合には、実線で示したような前後加速度指令値ＧxREQfinが得られる。また、この時の前後加加速度は、負の前後加速度指令値が最初に演算された際の増減に加えて、カーブ進入前からカーブ曲率最大値となる前に再度前後加加速度の増減が発生している。ここで、ＧxREQiniPP0，ＧxREQiniPP3からＧxREQfinを作成する方法は上記内容に限ったものではないが、図３４のＴ３０に示した負の前後加速度、すなわち減速している際のＧxREQiniPP3からＧxREQiniPP0へと遷移する区間において、減速度が過度に減少しないようにする。演算後Ｓ８２０へと進む。
【０２４９】
Ｓ８２０では、第１の実施形態と同様に、前後加速度制御許可フラグが１であれば、前後加速度指令値ＧxREQfinを実現する指令値を、前後加速度制御許可フラグが０であれば、前後加速度制御を行わないようにする指令値を前記前後加速度発生手段５へ送信する。
【０２５０】
ここで、前後加速度制御許可フラグが１の時に送信する信号としては、第１の実施形態と同様に、前後加速度指令値ＧxREQfinを送信することで前記前後加速度発生手段５により前後加速度指令値ＧxREQfinを実現することができる場合には、前後加速度指令値ＧxREQfinを制御指令値として送信する。
【０２５１】
以上のように、前方注視点の移動速度をカーブまでの距離に応じて変化させることで、ドライバがカーブ曲率の時間変化を詳細に認識できないと考えられるカーブ遠方において過度の減速を行うことなく、ドライバがカーブ曲率の時間変化を詳細に認識し始めるカーブ近傍において減速度を増加させることができ、ドライバの期待した減速を実現してドライバフィーリングを向上させることができる。また、最大横加速度推定値やドライバのアクセル操作、道路勾配、旋回方向といった他の情報を利用して比例ゲインを補正することで、ドライバフィーリングをより一層向上させることができる。また、本第５の実施形態を上述の第２〜４の実施形態の構成において実現することも可能である。
【０２５２】
なお、本発明は上記した第１〜５の実施形態に限定されるものではなく、様々な変形形態が含まれる。例えば、上記した第１〜５の実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。また、各第１〜５の実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。
【０２５３】
また、上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリや、ハードディスク、ＳＳＤ（Solid State Drive）等の記憶装置、または、ＩＣカード、ＳＤカード、ＤＶＤ等の記録媒体に置くことができる。
【０２５４】
また、制御線や情報線は説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えてもよい。
【符号の説明】
【０２５５】
１  車両運動制御装置
２  カーブ形状取得手段
３  自車位置取得手段
４  車両運動制御演算手段
５  前後加速度発生手段
６  車両運動情報取得手段
７  ドライバ入力情報取得手段
８  横運動連係前後加速度取得手段
９  路面情報取得手段
１０  情報提示器
１１  車両通信手段
１２  車載電子制御器
１３  設定情報取得手段
２１  補正ゲイン演算部（最大横加速度推定値）
２２  補正ゲイン演算部（道路勾配）
２３  補正ゲイン演算部（旋回方向）
２４  補正ゲイン演算部（ペダル操作量）
２５  比例ゲイン演算部
【図１】
0005417386.tif 000042
【図２】
0005417386.tif 000043
【図３】
0005417386.tif 000044
【図４】
0005417386.tif 000045
【図５】
0005417386.tif 000046
【図６】
0005417386.tif 000047
【図７】
0005417386.tif 000048
【図８】
0005417386.tif 000049
【図９】
0005417386.tif 000050
【図１０】
0005417386.tif 000051
【図１１】
0005417386.tif 000052
【図１２】
0005417386.tif 000053
【図１３】
0005417386.tif 000054
【図１４】
0005417386.tif 000055
【図１５】
0005417386.tif 000056
【図１６】
0005417386.tif 000057
【図１７】
0005417386.tif 000058
【図１８】
0005417386.tif 000059
【図１９】
0005417386.tif 000060
【図２０】
0005417386.tif 000061
【図２１】
0005417386.tif 000062
【図２２】
0005417386.tif 000063
【図２３】
0005417386.tif 000064
【図２４】
0005417386.tif 000065
【図２５】
0005417386.tif 000066
【図２６】
0005417386.tif 000067
【図２７】
0005417386.tif 000068
【図２８】
0005417386.tif 000069
【図２９】
0005417386.tif 000070
【図３０】
0005417386.tif 000071
【図３１】
0005417386.tif 000072
【図３２】
0005417386.tif 000073
【図３３】
0005417386.tif 000074
【図３４】
0005417386.tif 000075