車両運動制御装置及びプログラム
【課題】車体合成力の最大値が楕円で制限される場合において、簡単な構成のマップを用いて所望の縦移動距離に対する横移動距離を最大にする軌道及び車体合成力を導出する。
【解決手段】車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値及び所望の縦移動距離Xeを設定して、車体合成加速度の最大値の車体前後方向の成分F1/m、縦横比γ0、縦移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び車体横方向の成分vy0により演算される第1及び第2のパラメータと、横移動距離Yeを最大にする軌道を導出するために導入された第1の導入パラメータμ1に関する値、第2の導入パラメータμ2に関する値、及び特定の条件の下、XsとYeとで示される位置に到達する時間との関係を定めたマップを用いて、所望の縦移動距離に対して横移動距離が最大となる軌道及び車体合成力を導出する。
【解決手段】車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値及び所望の縦移動距離Xeを設定して、車体合成加速度の最大値の車体前後方向の成分F1/m、縦横比γ0、縦移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び車体横方向の成分vy0により演算される第1及び第2のパラメータと、横移動距離Yeを最大にする軌道を導出するために導入された第1の導入パラメータμ1に関する値、第2の導入パラメータμ2に関する値、及び特定の条件の下、XsとYeとで示される位置に到達する時間との関係を定めたマップを用いて、所望の縦移動距離に対して横移動距離が最大となる軌道及び車体合成力を導出する。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、車両運動制御装置及びプログラムに係り、特に、簡単な構成のマップを用いて所望の縦移動距離及び速度方向に対して、横移動距離を最大化にするため車体合成力を導出する車両運動制御装置及びプログラムに関する。
【背景技術】
【0002】
従来、車体に加える目標合成力と、各車輪の限界摩擦円の大きさから推定される限界合成力との比をμ利用率として設定し、限界摩擦円の大きさとμ利用率とからタイヤ発生力の大きさ、及び各制御対象車輪で発生するタイヤ発生力の方向を設定し、設定されタイヤ発生力の大きさ、及び設定されたタイヤ発生力の方向に基づいて、各制御対象車輪の操舵と制動又は操舵と駆動との協調制御を行なう車両制御装置が提案されている(特許文献1参照)。
【0003】
また、車両よりも前方の道路上に存在する障害物を回避するための回避操作量を、車両に生じる加速力、減速力および横力の合成力が車両のタイヤのグリップ力の最大値よりも小さくなる範囲内で算出する回避操作算出装置が提案されている(特許文献2参照)。
【0004】
また、車両が走行する道路上に存在する障害物を検出し、検出現在時刻から評価終了時刻後の自車両の予測位置及び外部環境に基づいて、自車両の回避後の目標姿勢角を設定し、現在時刻の外部環境及び障害物の状態量に基づいてリスクポテンシャル関数を設定し、そのリスクと運転操作量の時間積分値、目標姿勢角と自車両の姿勢角との差などに基づく評価値を算出し、評価値が最小となる軌道を導出する回避操作算出装置が提案されている(特許文献3参照)。
【0005】
また、自車両と障害物との間の距離および自車両の障害物に対する相対速度、そして回避するための横移動距離に基づいて定まる物理量を導入し、その物理量と自車両の重量および車体合成力の最大値により最短距離で回避するための車体合成力の向きを導出するマップを予め記憶しておき、直進制動での最短回避距離と単純横移動における最短回避距離と、現時刻の自車両と障害物の状態に基づいてマップより得られる最短回避距離を比較して、最も短くなる回避軌道を選択し、その軌道に基づいて現時刻の車体合成力を算出する車両制御装置が提案されている(特許文献4参照)。
【0006】
また、ロボットの位置、ロボットが到達目標とする目標到達位置、ロボットが目標到達位置へ到達する時に目標とする目標速度、およびロボットの制限最高速度又は制限最高加速度の各値を用いて、ロボットが制限最高速度又は制限最高加速度を越えない速度をとるとともにロボットの初期位置から目標位置へ到達するのに要する時間が等しい軌道の中ではロボットの加速度の二乗総和が最小となるようにするロボットの制御装置が提案されている(特許文献5参照)。
【0007】
また、車両がスタート位置Pに停止したとき、物体検出手段で検出した周囲の物体の状況から最適目標位置と、最適目標位置を通る一定半径rの円弧よりなる第1の移動軌跡とを設定し、第1の移動軌跡上に所定位置Sを選択し、スタート位置Pから所定位置Sまでの第2の移動軌跡を設定し、所定位置Sは、第2の移動軌跡での車両の移動距離が最小になるように選択される車両の自動操舵装置が提案されている(特許文献6参照)。
【先行技術文献】
【特許文献】
【0008】
【特許文献1】特開2004−249971号公報
【特許文献2】特開2007−253746号公報
【特許文献3】特開2007−253745号公報
【特許文献4】特開2006−347236号公報
【特許文献5】特開平7−32277号公報
【特許文献6】特開2001−063597号公報
【発明の概要】
【発明が解決しようとする課題】
【0009】
しかしながら、特許文献1〜4の技術では、回避軌道や車体合成力を導出してはいるが、与えられた車体合成力の限界値を用いて横移動距離を最大化する車体合成力の導出については記載されていない。
【0010】
また、特許文献5の技術では、加速度の2乗和が最小化される回避軌道を導出すること、また、特許文献6の技術では、自車両を目標位置に到達させる移動距離が最小となる軌道を導出することが記載されているが、所望の縦移動距離に対して横移動距離を最大化する軌道を導出することは記載されていない。
【0011】
本発明は、車体合成力の最大値が楕円で制限される場合において、最適制御法によって作成した簡単な構成のマップを用いて所望の縦移動距離及び速度方向に対して、横移動距離を最大化する軌道及び車体合成力を導出することができる車両運動制御装置及びプログラムを提供することを目的とする。
【課題を解決するための手段】
【0012】
上記目的を達成するために、第1の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、前記移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Xe、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力を求めるために導入した第1の導入パラメータμ1の、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、・前記第1のパラメータと、前記第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力を求めるために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1及び前記成分F2に基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、を含んで構成されている。
【0013】
また、第2の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、前記移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Xe、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成加速度の方向θの、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’と、の関係を定めたマップを記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1及び前記成分F2に基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、を含んで構成されている。
【0014】
また、第3の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離が最短となる車体合成力を求めるために導入した第1の導入パラメータμ1の、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、・前記第1のパラメータと、前記第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離が最短となる車体合成力を求めるために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Yeに対して車体前後方向の移動距離が最短となる最短距離Xs及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて前記最短距離Xsを求め、求めた前記最短距離Xsと前記移動距離Xeとの差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記最短距離Xsを求め、前記最短距離Xsと前記距離の車体前後方向の成分Xeとの差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、を含んで構成されている。
【0015】
また、第4の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離Xeが最短となる車体合成加速度の方向θの、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’と、の関係を定めた第1のマップ、及び・前記第1のパラメータと、前記第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対する車体前後方向の移動距離の最短距離Xsの、前記仮定の下での値Xs’と、の関係を定めた第2のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、及び前記第2のマップを用いて前記最短距離Xsを求め、求めた前記最短距離Xsと前記移動距離Xeとの差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記最短距離Xsを求め、前記最短距離Xsと前記距離の車体前後方向の成分Xeとの差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、を含んで構成されている。
【0016】
また、第1または第2の発明において、前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記成分F1及び前記成分F2を一定値として前記移動距離Xeを変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記移動距離Xeに基づいて、設定した前記移動距離Yeに対して前記移動距離Xeが最短となる最短回避軌道を導出するようにすることができる。
【0017】
また、第1または第2の発明において、前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記比γ0を一定値として前記成分F1及び前記成分F2の設定を変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記成分F1及び前記成分F2に基づいて、車体合成力の最大値が最小となる軌道を導出するようにすることができる。
【0018】
また、第1または第2の発明において、前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記成分F1または前記成分F2の一方を一定値として前記比γ0を変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記比γ0に基づいて、前記成分F1または前記成分F2の他方が最小となる軌道を導出するようにすることができる。
【0019】
また、第5の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0と、自車両の速度の車体前後方向の成分vx0と前記速度の車体横方向の成分vy0との比と、の積で定められた第1のパラメータと、前記比γ0と、前記移動距離Xeと車体横方向の移動距離Yeとの比と、の積で定められた第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値を最小にするために導入した第1の導入パラメータμ1の、前記比γ0、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値を最小にするために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるための車体合成力の最大値が最小となる車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、を含んで構成されている。
【0020】
また、第6の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0と、自車両の速度の車体前後方向の成分vx0と前記速度の車体横方向の成分vy0との比と、の積で定められた第1のパラメータと、前記比γ0と、前記移動距離Xeと車体横方向の移動距離Yeとの比と、の積で定められた第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値が最小となる車体合成加速度の方向θの、前記比γ0、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’との関係を定めた第1のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために最大値が最小となる車体合成加速度F1/mの、前記仮定の下での車体合成加速度F1’/m’と、の関係を定めた第2のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、及び前記第2のマップを用いて前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるための車体合成力の最大値が最小となる車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、を含んで構成されている。
【0021】
また、第7の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/mまたは車体横方向の成分F2/m、前記移動距離Xe、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、車体合成力の最大値の車体前後方向の成分F1または車体横方向の成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方を最小にするために導入した第1の導入パラメータμ1の、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、・前記第1のパラメータと、前記第2のパラメータと、前記成分F1または前記成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方を最小にするために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて、設定した前記成分F1または前記成分F2の一方に対して前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小になる車体合成力の最大値の車体前後方向の成分と車体横方向の成分との比γfを求め、求めた前記比γfと設定した前記成分F1と前記成分F2との比γ0との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記比γfを求め、求めた前記比γfと前記比γ0との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、を含んで構成されている。
また、第8の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/mまたは車体横方向の成分F2/m、前記移動距離Xe、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、車体合成力の最大値の車体前後方向の成分F1または車体横方向の成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小となる車体合成加速度の方向θの、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’との関係を定めた第1のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記成分F1と前記成分F2との比γ0の、前記仮定の下での比γ0’と、の関係を定めた第2のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、及び前記第2のマップを用いて、設定した前記成分F1または前記成分F2の一方に対して前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小になる車体合成力の最大値の車体前後方向の成分と車体横方向の成分との比γfを求め、求めた前記比γfと設定した前記成分F1と前記成分F2との比γ0との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記比γfを求め、求めた前記比γfと前記比γ0との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻における車体合成力を導出する導出手段と、を含んで構成されている。
【0022】
また、前記導出手段で導出された前記車体合成力に基づいて、操舵角、制動力、及び駆動力の少なくとも一つを制御する制御手段を更に含んで構成することができる。
【0023】
また、操舵角、制動力、及び駆動力の少なくとも一つを制御する制御手段を含んで構成し、前記設定手段は、障害物の位置及び大きさに基づいて、前記障害物を回避すべき横移動距離を設定し、前記制御手段は、前記導出手段により導出された最大化された移動距離Yeと、前記設定手段で設定された回避すべき横移動距離とを比較し、前記最大化された移動距離Yeの方が小さい場合には、急制動または衝突被害推定値を最小にする制御を行い、前記回避すべき横移動距離の方が小さい場合には、前記導出手段で導出された前記車体合成力に基づいた回避制御を行うようにすることができる。
【0024】
また、前記第1のパラメータ、及び前記第2のパラメータを、各マップの特異点が該マップの縦軸又は横軸と平行になるように変更することができる。
【0025】
また、前記設定手段は、障害物の位置及び大きさに基づいて、前記車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定し、前記検出手段は、自車両の前記障害物に対する相対速度を検出するようにすることができる。
【0026】
また、前記導出手段で導出された前記車体合成力に基づいて、ドライバに車両運動状態を報知する報知手段を更に含んで構成することができる。
【0027】
また、第9の発明の車両運動制御プログラムは、コンピュータを、第1〜第8の発明の車両運動制御装置を構成する各手段として機能させるためのプログラムである。
【発明の効果】
【0028】
以上説明したように本発明によれば、車体合成力の最大値が縦横比の楕円で制限される場合において、車体合成力の最大値を設定して、自車両と所望の位置との距離、自車両の速度により演算されるパラメータを用いた簡単な構成のマップを用いて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力を導出することができる、という効果が得られる。
【図面の簡単な説明】
【0029】
【図1】車両運動制御の概略を示す図である。
【図2】xy座標の設定を説明するための図である。
【図3】第1の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図4】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図5】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図6】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図7】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図8】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図9】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図10】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図11】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図12】第1の実施の形態の車両運動制御装置の構成を示すブロック図である。
【図13】第1の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図14】第2の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図15】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図16】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図17】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図18】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図19】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図20】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図21】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図22】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図23】第2の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図24】第3の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図25】第3の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図26】第4の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図27】第5の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図28】第8の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図29】第8の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図30】第9の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図31】第10の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図32】第10の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図33】第11の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【発明を実施するための形態】
【0030】
以下、図面を参照して本発明の実施の形態を詳細に説明する。本実施の形態では、車両が走行する道路上の障害物を回避する場合を想定し、障害物の横を通過する位置における速度方向を車体前後方向とする場合について説明する。
【0031】
第1の実施の形態の車両運動制御装置における車体合成力及び回避軌道の導出の概略について説明する。
【0032】
図1に示すように、設定したxy座標での時刻t(現在時刻をt=0として、現在時刻からt秒後)における車体合成加速度のx成分をux(t)、車体合成加速度のy成分をuy(t)、車体合成力の大きさのx成分をFx(t)、車体合成力の大きさのy成分をFy(t)、車体合成力の方向をθ0(t)、及び自車両の重量をmとすると、車体合成加速度のx成分ux(t)及びy成分uy(t)は、下記(1)式及び(2)式で示される。また、(1)式及び(2)式を積分して、下記(3)式及び(4)式に示すように、自車両の路面に対する速度のx成分vx(t)、及び速度のy成分vy(t)が得られる。また、(3)式及び(4)式を積分して、下記(5)式及び(6)式に示すように、自車両のt秒間の移動距離のx成分X(t)、及び移動距離のy成分Y(t)が得られる。このX(t)及びY(t)により回避軌道が得られる。
【0033】
【数1】
【0034】
なお、xy座標は、t=0における自車両の位置を原点とし、障害物の横を通過する位置における速度方向(車体前後方向)をx軸、x軸に直交する軸(車体横方向)をy軸として設定する(図2参照)。
【0035】
そして、現在時刻(t=0)におけるxy座標上の目標位置を(Xe,Ye)、自車両の路面に対する速度をvx(0)=vx0、vy(0)=vy0、目標位置及び目標位置における速度方向に到達する時刻をteとした場合に、車体合成力の最大値のx成分及びy成分を設定して、目標位置までの縦移動距離Xe(自車両と目標位置との距離のx成分)に対する横移動距離Ye(自車両と目標位置との距離のy成分)が最大となるような車体合成加速度ux(t)及びuy(t)((1)式、及び(2)式)を、各輪の限界摩擦円の大きさから推定される限界合成力の大きさFmax、及び縦移動距離Xeをある値に設定した場面において、vx0及びvy0をパラメータとするマップを用いて導出する。
【0036】
なお、縦移動距離Xe及び縦移動距離Xeに対して最大化された横移動距離Yeで定まる位置が目標位置であり、導出の初期段階で設定する所望の縦移動距離Xeで定まる位置は所望位置と呼ぶ。所望位置においては、横移動距離は不定である。
【0037】
次に、第1の実施の形態で用いられるマップについて説明する。
【0038】
まず、x1=X(t)、x2=vx(t)、x3=Y(t)、x4=vy(t)、u1=ux(t)、u2=uy(t)とおくと、(1)式及び(2)式の運動方程式は、下記(7)式のような状態方程式に変形できる。なお、Tはベクトル及び行列の転置記号である。
【0039】
【数2】
【0040】
次に、限界合成力の大きさFmax及びμ利用率(γ1、γ2)が-既知であると仮定して、横方向の移動距離に−1を掛けた値を最小化する最適制御問題として考える。なお、μ利用率は、車体に与える目標合成力と限界合成力Fmaxとの比として設定される物理指標であり、γ1が車両前後方向に対するμ利用率、γ2が車両横方向に対するμ利用率である。
【0041】
ここで、本実施の形態では、車両が発生することができる車体合成力の最大値を、車両前後方向(x軸)を長軸(または短軸)とする楕円で制限し、μ利用率(γ1、γ2)と限界合成力の大きさFmaxとに基づいて、楕円で制限されたx成分(楕円の長軸(または短軸)方向)の最大値、及びy成分(楕円の短軸(または長軸)方向)の最大値を定める。
【0042】
目標位置に到達する時刻をteとおけば、評価関数Iを下記(8)式で表した場合、下記(9)式で表される終端条件、及び下記(10)式で表される楕円で制限される車体合成力の大きさに関する入力制約条件の下で、評価関数Iを最小化する制御入力を求めよという制御問題に帰着される。
【0043】
【数3】
【0044】
ここで、特開2007−283910号公報等の公知の技術を用いると、下記(11)式のような制御入力が導出される。
【0045】
【数4】
【0046】
ただし、ν1及びν2は最適解を求めるために導入した第1の導入パラメータ及び第2の導入パラメータである。また、γ1≠γ2の場合には、θ(t)の値によって車体合成力の大きさが変化することを示しており、(11)式で示す入力の大きさ|u(t)|は時変となる。γ1=γ2の場合には、(11)式で示す|u(t)|の値は時不変となる。
【0047】
ここで、下記(12)式のように変数変換する。
【0048】
【数5】
【0049】
そして、(7)式に適用して(1)式〜(6)式に従って時間積分し、さらに、Y(te)=Yeとおくと、初期条件及び終端条件により、(11)式において必要となるte 、ν1、ν2は、下記(13)式、(14)式、及び(16)式の非線形方程式にm、vx0、vy0、F1、γ0、及びXeを代入して解くことにより得られる。また、縦移動距離Xeに対して横移動距離が最大となるときの横移動距離Yeは、(15)式の関係を満たす。
【0050】
【数6】
【0051】
この方程式の解を求めるために、低次元化したマップを導出する。まず、(13)式、(14)式、及び(16)式に着眼して、任意の正数aを導入して下記(17)式の関係を満足する2組のパラメータP及びP’を考えると、P及びP’に対応する解 {μ1、μ2、te}及び{μ1’、μ2’、te’}は、下記(18)式の関係を満たす。
【0052】
【数7】
【0053】
(17)式の最後の式より、aを下記(19)式のようにおくと、(17)式よりvx0’ 及びvy0’は(20)式のように変形できる。
【0054】
【数8】
【0055】
この関係より、γ0’、F1’/m’及びXe’に任意の正数を設定することにより、現在時刻のパラメータPによってvx0’及びvy0’が求まる。よって、γ0’、F1’/m’及びXe’をある値に設定した場合において、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとしたマップを予め用意しておけばよい。なお、このγ0’、F1’/m’及びXe’の値は、マップ作成時に設計者が自由に設定できる。
【0056】
ここでは、一例として、γ0’=F1’/m’=Xe’=1とした場合のvx0’及びvy0’に関するマップを作成する。図3に示すように、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとして、(13)式、(14)式、及び(16)式に基づいて得られるμ1’の値をマッピングした第1のマップ、μ2’の値をマッピングした第2のマップ、及びte’の値をマッピングした第3のマップを作成する。
【0057】
そして、これらのマップを用いて{μ1,μ2,te}を求めるには、γ0’=F1’/m’=Xe’=1、既知のm、vx0、vy0、Xe、限界合成力の大きさFmaxとμ利用率γ1とで定まる車体合成力の最大値のx成分F1、及びμ利用率γ1とγ2とで定まるγ0から(20)式に従って第1のパラメータvx0’及び第2のパラメータvy0’を演算し、演算されたパラメータに対する出力{μ1’,μ2’,te’}を各マップから得て、(18)式及び(19)式に従って{μ1’,μ2’,te’}を{μ1,μ2,te}に変換し、(11)式及び(12)式に従って入力の時間関数を、(15)式に従って、所望の縦移動距離Xeに対して最大となる横移動距離Yeを演算する。
【0058】
ただし、vy0<0 の場合は、vy0→−vy0、Ye→−Yeに変換して、マップより{−μ1’,−μ2’,te’}を求め、−μ1’→ μ1’、−μ2’→ μ2’の処理を行って{μ1,μ2,te}を得ればよい。
【0059】
この結果、(1)式〜(6)式の積分計算により、縦移動距離Xe、及び車両の速度から、縦移動距離Xeに対して横移動距離が最大となる横移動距離最大化回避軌道が導出される。
【0060】
なお、上記のマップでは、第1のパラメータ及び第2のパラメータを(20)式のように定めた場合について説明したが、任意の正数aを、(17)式の1番目の式を用いて下記(21)式のようにおいて、下記(22)式に示すvy0’を第1のパラメータ、及びXe’を第2のパラメータとし、例えば、γ0’=F1’/m’=vx0’=1として、図4に示すようなマップを作成することができる。
【0061】
【数9】
【0062】
また、(22)式の第2式を下記(23)式のように変更すると、aは下記(24)式のように変形される。そして、(22)式のvy0’及び(23)式のF1’/m’を第1及び第2のパラメータとし、γ0’=Xe’=vx0’=1としてマップを作成してもよい(図5)。
【0063】
【数10】
【0064】
また、別のパラメータを用いる場合として、任意の正数aを、(17)式の2番目の式を用いて下記(25)式のようにおいて、下記(26)式に示すvx0’を第1のパラメータ、及びXe’を第2のパラメータとし、上記と同様に、例えば、γ0’=F1’/m’=1、vy0’=±1として、図6、7に示すようなマップを作成することができる。ここで、vy0>0の場合には、図6に示すマップを用い、vy0<0の場合には、図7に示すマップを用いる。
【0065】
【数11】
【0066】
また、(26)式の第2式を下記(27)式のように変更すると、aは下記(28)式のように変形される。そして、(26)式のvx0及び(27)式のF1’/m’を第1及び第2のパラメータとし、γ0’=Xe’=1、vy0’=±1としてするマップを作成してもよい(図8,9)。
【0067】
【数12】
【0068】
また、マップの軸の取り方を変更して、特異点を縦軸又は横軸と平行になるように移動させたマップを用いてもよい。
【0069】
具体的には、図3に示すマップの軸の取り方を下記(29)式または(30)式のように変更し、(29)式に示すvx0’’を第1のパラメータ、及びvy0’を第2のパラメータとし、上記と同様に、γ0’=F1’/m’=Xe’=1として、図10に示すようなマップを作成することができる。同様に、(30)式に示すvx0’を第1のパラメータ、及びvy0’’を第2のパラメータとし、上記と同様に、γ0’=F1’/m’=Xe’=1として、図11に示すようなマップを作成することができる。
【0070】
【数13】
【0071】
このように、特異点のラインが縦軸又は横軸と平行になるようにマップの軸を変更することにより、マップの精度を保ちつつマップを記憶する容量を図3に示したマップに比べて小さく抑えることが容易になる。
【0072】
さらに、図4のマップの軸の取り方を変更して、下記(31)式または(32)式に示すような第1及び第2のパラメータを用いて特異点を縦軸又は横軸と平行になるように移動させたマップを作成したり、図5のマップの軸の取り方を変更して、下記(33)式または(34)式に示すような第1及び第2のパラメータを用いて特異点を縦軸又は横軸と平行になるように移動させたマップを作成したり、図6及び7のマップの軸の取り方を変更して、下記(35)式または(36)式に示すような第1及び第2のパラメータを用いて特異点を縦軸又は横軸と平行になるように移動させたマップを作成したり、図8及び9のマップの軸の取り方を変更して、下記(37)式または(38)式に示すような第1及び第2のパラメータを用いて特異点を縦軸又は横軸と平行になるように移動させたマップを作成したりしてもよい。
【0073】
【数14】
【0074】
以下、上記のマップを用いた第1の実施の形態について詳細に説明する。図12に示すように、第1の実施の形態の車両運動制御装置には、自車両の走行状態を検出する走行状態検出手段として車両に搭載されたセンサ群、外部環境状態を検出する外部環境検出手段として車両に搭載されたセンサ群、及びこれらのセンサ群からの検出データに基づいて、自車両が運動するように自車両に搭載された車載機器を制御することによって目標位置へ到達するように車両運動を制御する制御装置20、ドライバに車両運動制御状態を報知する表示装置30が設けられている。
【0075】
車両運動制御装置の自車両の走行状態を検出するセンサ群としては、車速を検出する車速センサ10、操舵角を検出する操舵角センサ12、及びスロットル弁の開度を検出するスロットル開度センサ14が設けられている。また、図示しないGPS装置からの情報を加えるようにしてもよい。
【0076】
また、外部環境状態を検出するセンサ群としては、自車両の前方を撮影する前方カメラ16、及び自車両の前方の障害物を検出するレーザレーダ18が設けられている。なお、レーザレーダ18に代えて、又はレーザレーダ18と共にミリ波レーダを設けるようにしてもよい。また、図示しないGPS装置からの情報を加えるようにしてもよい。
【0077】
前方カメラ16は、車両の前方を撮影するように車両のフロントウインドウ上部等に取り付けられている。前方カメラ16は、小型のCCDカメラ又はCMOSカメラで構成され、自車両の前方の道路状況を含む領域を撮影し、撮影により得られた画像データを出力する。出力された画像データは、マイクロコンピュータ等で構成された制御装置20に入力される。なお、カメラとして、前方カメラ16に加えて、前方赤外線カメラを設けるのが好ましい。赤外線カメラを用いることにより、歩行者を障害物として確実に検出することができる。なお、上記の赤外線カメラに代えて近赤外線カメラを用いることができ、この場合においても同様に歩行者を確実に検出することができる。
【0078】
レーザレーダ18は、赤外光パルスを照射する半導体レーザからなる発光素子、赤外光パルスを水平方向に走査する走査装置、及び前方の障害物(歩行者、前方車両等)から反射された赤外光パルスを受光する受光素子を含んで構成され、車両の前方グリル又はバンパに取り付けられている。このレーザレーダ18では、発光素子から発光された時点を基準として受光素子で受光されるまでの反射赤外光パルスの到達時間に基づいて、自車両から前方の障害物までの距離を検出することができる。レーザレーダ18で検出された障害物までの距離を示すデータは制御装置20に入力される。制御装置20は、RAM、ROM、及びCPUを含むマイクロコンピュータ等で構成され、ROMには以下で説明する車両運動制御ルーチンのプログラムが記憶されている。
【0079】
また、制御装置20は、自車両の操舵角、制動力、及び駆動力の少なくとも1つを制御することによって、目標位置へ到達するように車両運動を制御するための車両搭載機器に接続されている。この車両搭載機器としては、車輪の操舵角を制御するための電動パワーステアリング等の操舵角制御装置22、ブレーキ油圧を制御することによって制動力を制御する制動力制御装置24、及び駆動力を制御する駆動力制御装置26が設けられている。制動力制御装置24には、制動力を検出する検出センサ24Aが取り付けられている。また、制御装置20には、演算された制御入力の方向θ等を表示することによって車両運動制御情報をドライバに報知する表示装置30が接続されている。なお、車両運動制御を行なっていることを、ドライバだけでなく車両外部の目標位置方向に向かって報知するようにしてもよい。
【0080】
操舵角制御装置22としては、ドライバのステアリングホイール操作に重畳して前輪及び後輪の少なくとも一方の車輪の操舵角を制御する制御手段、ドライバ操作とは機械的に分離され、ステアリングホイールの操作とは独立して前輪及び後輪の少なくとも一方の車輪の操舵角を制御する制御手段(いわゆるステア・バイ・ワイヤ)等を用いることができる。
【0081】
制動力制御装置24としては、ドライバ操作とは独立して各車輪の制動力を個別に制御する、いわゆるESC(Electronic Stability Control)に用いられる制御装置、ドライバ操作とは機械的に分離され、各車輪の制動力を信号線を介して任意に制御する制御装置(いわゆるブレーキ・バイ・ワイヤ)等を用いることができる。
【0082】
駆動力制御装置26としては、スロットル開度、点火進角の遅角、又は燃料噴射量を制御することによって駆動力を制御する制御装置、変速機の変速位置を制御することによって駆動力を制御する制御装置、トルクトランスファを制御することによって前後方向及び左右方向の少なくとも一方の駆動力を制御する制御装置等を用いることができる。
【0083】
また、制御装置20には、制御入力を求めるためのマップを記憶したマップ記憶装置28が接続されている。第1の実施の形態のマップとしては、図3に示すマップを用いる場合について説明する。なお、他の例として示した図4、図5、図6及び7、図8及び9、図10、または図11のいずれかのマップをマップ記憶装置28に記憶しておき、そのマップを使用してもよい。その場合、マップ記憶装置28に記憶されたマップに応じた第1のパラメータ及び第2のパラメータを演算して用いるようにする。
【0084】
また、制御装置20には、ドライバに警報を発する図示しない警報装置が接続されている。警報装置としては、音や音声によって警報を発する装置、光や視覚的な表示によって警報を発する装置、振動によって警報を発する装置、又は操舵反力のような物理量をドライバに与えてドライバの操作を誘導する物理量付与装置を用いることができる。また、表示装置30を警報装置として用いるようにしてもよい。
【0085】
以下、図13を参照して第1の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。
【0086】
ステップ100で、車速センサ10等で検出された自車両の走行状態、及びレーザレーダ18等で検出された外部環境状態に関する検出データを取り込む。次に、ステップ102で、取り込んだ検出データに基づいて、車両が走行している道路上の障害物の位置及び大きさを含む環境マップを作成する。
【0087】
次に、ステップ104で、環境マップを用いて障害物を回避して走行するための所望位置及び所望位置における速度方向を設定する。ここでは、所望位置を障害物の横を通過する位置とし、所望位置における速度方向を車体前後方向とする。なお、本実施の形態では、所望位置での車体横方向の距離を最大化した位置が、車両運動制御のための最終的な目標位置となる。
【0088】
次に、ステップ106で、設定された速度方向をx軸、x軸に直交する方向をy軸、及び車両の現在位置を原点とするxy座標を設定する。すなわち、所望位置における車体前後方向がx軸方向となり、所望位置における速度方向のy成分は0となる。
【0089】
次に、ステップ108で、上記ステップ100で走行状態として取り込まれた自車両の速度、及び外部環境状態として取り込まれた自車両と障害物との距離を設定された座標に対応させて変換し、縦移動距離Xe、速度のx成分vx0、y成分vy0を演算する。
【0090】
次に、ステップ110で、外部環境及び自車両の構造と状態に基づいて、限界合成力の大きさFmax、及び楕円で制限される車体合成力の最大値のx成分F1とy成分F2を設定する。このとき、車体合成力の最大値のμ利用率γ1及びγ2も自ずと定まる。この車体合成力の最大値は、x軸を長軸または短軸とする楕円で制限されている。なお、F2は、F2=γ2Fmaxであり、これより(12)式の第2式の関係が導かれる。従って、本ステップにおいて、F1及びF2を設定する代わりに、F1及びγ0を設定するようにしてもよい。
【0091】
次に、ステップ112で、(20)式に従って、第1のパラメータvx0’、及び第2のパラメータvy0’を演算する。次に、ステップ114で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、上記ステップ110で設定された車体合成力の最大値、並びに上記ステップ112で演算された第1のパラメータvx0’及び第2のパラメータvy0’を入力として、縦移動距離Xeに対する横移動距離が最大となる軌道、及び車体合成力の時系列データを導出する。
【0092】
具体的には、第1のマップ、第1のパラメータvx0’、及び第2のパラメータvy0’に基づいてμ1’を得て、第2のマップ、第1のパラメータvx0’、及び第2のパラメータvy0’に基づいてμ2’を得て、第3のマップ、第1のパラメータvx0’、及び第2のパラメータvy0’に基づいてte’を得る。そして、{μ1’,μ2’,te’}を(18)式及び(19)式に従って{μ1,μ2,te}に変換し、(11)式及び(12)式に従って入力の時間関数を、(15)式に従って最大となる横移動距離Yeを演算する。そして、(1)式〜(6)式に従って、縦移動距離Xeに対する横移動距離が最大となる横移動距離最大軌道が導出される。
【0093】
次に、ステップ116で、上記ステップ114で導出された車体合成力の時系列データに従って、横移動距離最大化回避軌道に沿った走行を実現するために必要な各車輪のタイヤ発生力を演算し、各車輪のタイヤ発生力が得られるように操舵角制御装置22、制動力制御装置24、及び駆動力制御装置26の少なくとも1つを制御すると共に、車両運動制御情報を表示装置30に表示する。また、障害物を回避するように制御する際には無条件で警報装置から警報を発したり、障害物を回避するための車両運動制御を行っていることを表示装置に表示したりすることにより警報を行ってもよい。各車輪のタイヤ発生力が得られるように制御することにより、目的とする車体発生力が得られるように制御することができる。
【0094】
以上説明したように第1の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分及びy成分を設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成のマップを用いて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力の時系列データを導出することができる。
【0095】
なお、第1の実施の形態では、F1及びγ0を用いて車体合成力の向きを求める場合について説明したが、F2及びγ0を用いて求めてもよい。なぜなら、F1=F2/γ0及びF1’=F2’/γ0’の関係を、(20)式などの軸の取り方や(19)式などのパラメータaに代入すれば、本実施の形態内で示したマップをそのまま適用することができるためである。
【0096】
また、図1で示したように、車両進行方向に対して左方向に障害物を回避する場合において、横移動距離が最大となるように回避する手法について説明したが、右方向に回避する場合にも適用可能である。自車両の速度のy成分をvy0→−vy0に変換して、マップより{−μ1’,−μ2’,te’}を求め、−μ1’→ μ1’、−μ2’→ μ2’の処理を行うことで、右方向に対応した{μ1,μ2,te}を得ることができる。
【0097】
また、第1の実施の形態では、自車両の路面に対する速度を用いた場合について説明したが、自車両の所望位置に対する相対速度を用いてもよい。このとき、(9)式の終端条件も相対速度になるため、終端速度のy成分は相対速度に関して0となる。
【0098】
また、第1の実施の形態では、導出された車体合成力に基づいて、障害物を回避するための回避制御を行う場合について説明したが、上記ステップ102障害物の位置及び大きさを含む環境マップに基づいて回避すべき横移動距離Yaが与えられたときに、導出された最大化された横移動距離Yeと比較し、Ye<Yaの場合には、急制動制御により障害物の手前で車両が停止するように制動力制御装置24を制御するか、推定される衝突被害が最小化されるように操舵角制御装置22及び制動力制御装置24を制御するようにしてもよい。このような制御は、例えば、WO2006−070865記載の技術のような公知の技術を用いることができる。
【0099】
次に、第2の実施の形態について説明する。第1の実施の形態では、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第2の実施の形態では、第1の実施の形態とは異なるマップを用いて、縦移動距離Xeに対する横移動距離を最大にする現在時刻の車体合成力の大きさ及び方向を導出する場合について説明する。なお、第2の実施の形態の車両運動制御装置について、第1の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0100】
ここで、第2の実施の形態で用いられるマップについて説明する。
【0101】
まず、第1の実施の形態と同様に、(20)式まで展開する。そして、一例として、γ0’=F1’/m’=Xe’=1とした場合のvx0’及びvy0’に関するマップを作成する。図14に示すように、vx0’を第1のパラメータ、 及びvy0’を第2のパラメータとして、上記(13)式、(14)式、及び(16)式に基づいて得られる車体合成加速度の方向θ’の値をマッピングしたマップを作成する。
【0102】
そして、このマップを用いて{θ’}を求めるには、γ0’=F1’/m’=Xe’=1、既知のm、vx0、vy0、Xe、車体合成力の最大値のx成分F1、及びy成分F2から(20)式に従って第1のパラメータvx0’及び第2のパラメータvy0’を演算し、演算されたパラメータに対する出力{θ’}をマップから得て、下記(39)式により、縦移動距離Xeに対して横移動距離を最大にする現在時刻の車体合成力の大きさ及び向きが得られる。
【0103】
【数15】
【0104】
ただし、vy0<0 の場合は、vy0→−vy0、Ye→−Yeに変換して、マップより{−θ’}を求め、−θ’→θ’の処理を行ってθを得ればよい。
【0105】
また、θ’のマップと併せて、図14の破線内のマップのように、γ0’=F1’/m’=Xe’=1とした場合のYe’を求めるマップを作成しておいてもよい。このマップから得られるYe’を、下記(40)式により変換して縦移動距離Yeを求めてもよい。
【0106】
【数16】
【0107】
なお、上記のマップでは、第1のパラメータ及び第2のパラメータを(20)式のように定めた場合について説明したが、第1の実施の形態と同様に、(22)式に示すvy0’を第1のパラメータ及びXe’を第2のパラメータとし、γ0’=F1’/m’=vx0’=1とした場合のマップを作成してもよい(図15)。この場合において、上記と同様にYe’を求めるマップも用いる場合には、下記(41)式によりマップから求めたYe’をYeに変換することができる。
【0108】
また同様に、(22)式に示すvy0’を第1のパラメータ及び(23)式に示すF1’/m’を第2のパラメータとし、γ0’=vx0’=Xe’=1とした場合のマップを作成してもよい(図16)。この場合において、上記と同様にYe’を求めるマップも用いる場合には、(40)式によりマップから求めたYe’をYeに変換することができる。
【0109】
また同様に、(26)式に示すvx0’を第1のパラメータ及びXe’を第2のパラメータとし、γ0’=F1’/m’=1、vy0’=±1とした場合のマップを作成してもよい(図17、18)。この場合において、上記と同様にYe’を求めるマップも用いる場合には、(42)式によりマップから求めたYe’をYeに変換することができる。
【0110】
また同様に、(26)式に示すvx0’を第1のパラメータ、及び(27)式に示すF1’/m’を第2のパラメータとし、γ0’=Xe’=1、vy0’=±1とした場合のマップを作成してもよい(図19、20)。この場合において、上記と同様にYe’を求めるマップも用いる場合には、(40)式によりマップから求めたYe’をYeに変換することができる。
【0111】
【数17】
【0112】
また、第1の実施の形態でマップの軸の取り方を変更した手法と同様の手法により、特異点のラインが縦軸又は横軸と平行になるようにマップの軸の取り方を変更したマップを作成してもよい。例えば、図14に示すマップの軸の取り方を(29)式のように変更した場合のマップを図21に、(30)式のように変更した場合のマップを図23に示す。
【0113】
以下、図23を参照して第2の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。ここでは、図14に示すマップを用いる場合について説明する。
【0114】
ステップ100〜ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を得る。
【0115】
次に、ステップ200で、マップ記憶装置28に記憶されたマップを読み出し、上記ステップ110で設定された車体合成力の最大値、並びに上記ステップ112で演算された第1のパラメータvx0’及び第2のパラメータvy0’を入力として、縦移動距離Xeに対して横移動距離が最大になるための現在時刻の車体合成力を導出する。
【0116】
具体的には、θ’のマップ、第1のパラメータvx0’、及び第2のパラメータvy0’に基づいて車体合成加速度の向きθ’を得て、(39)式により縦移動距離Xeに対して横移動距離が最大となる現在時刻の車体合成力が導出される。
【0117】
以上説明したように第2の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分及びy成分を設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成のマップを用いて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる現在時刻の車体合成力を導出することができる。また、車体合成力の時系列データを導出する場合と比べ、用いるマップが少ないため、マップを記憶するための容量を削減できる。
【0118】
次に、第3の実施の形態について説明する。第1の実施の形態では、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第3の実施の形態では、障害物を回避するための縦移動距離が最短となる車体合成力を求めるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明する。なお、第3の実施の形態の車両運動制御装置について、第1または第2の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0119】
第3の実施の形態では、図1のような場面において、回避すべき横移動距離Yeが与えられ、また評価関数Iを下記(43)式で表した場合、下記(44)式で表される終端条件、及び(10)式で表される楕円で制限される車体合成力の大きさに関する入力制約条件の下で、評価関数Iを最小化する制御入力を求めよという制御問題に帰着される。
【0120】
【数18】
【0121】
ここで、特開2007−283910号公報等の公知の技術を用いると、下記(45)式のような制御入力が導出される。
【0122】
【数19】
ここで、下記(46)式のように変数変換する。
【0123】
【数20】
【0124】
すると、(45)式において必要となるte、ν1、ν2は、下記(47)式〜(49)式の非線形方程式にm、vx0、vy0、F1、γ0、及びYeを代入してμ1、μ2、teを解くことにより得られる。また、設定された横移動距離Yeに対して縦移動距離が最短となるときの最短距離Xsは、(50)式の関係を満たす。
【0125】
【数21】
【0126】
この方程式の解を求めるために、低次元化したマップを導出する。まず、(47)式〜(49)式に着眼して、任意の正数aを導入して下記(51)式の関係を満足する2組のパラメータP及びP’を考えると、P及びP’に対応する解 {μ1、μ2、te}及び{μ1’、μ2’、te’}は、(18)式の関係を満たす。
【0127】
【数22】
【0128】
(51)式の最後の式より、aを下記(52)式のようにおくと、(51)式よりvx0’ 及びvy0’は下記(53)式のように変形できる。
【0129】
【数23】
【0130】
この関係より、γ0’、F1’/m’及びYe’に任意の正数を設定することにより、現在時刻のパラメータPによってvx0’及びvy0’が求まる。よって、γ0’、F1’/m’及びYe’をある値に設定した場合において、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとしたマップを予め用意しておけばよい。なお、このγ0’、F1’/m’及びYe’の値は、マップ作成時に設計者が自由に設定できる。
【0131】
ここでは、一例として、γ0’=F1’/m’=Ye’=1とした場合のvx0’及びvy0’に関するマップを作成する。図24に示すように、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとして、(47)式〜(49)式に基づいて得られるμ1’の値をマッピングした第1のマップ、μ2’の値をマッピングした第2のマップ、及びte’の値をマッピングした第3のマップを作成する。
【0132】
そして、これらのマップを用いて{μ1,μ2,te}を求めるには、γ0’=F1’/m’=Ye’=1、既知のm、vx0、vy0、Ye、限界合成力の大きさFmaxとμ利用率γ1とで定まる車体合成力の最大値のx成分F1、及びμ利用率γ1とγ2とで定まるγ0から(53)式に従って第1のパラメータvx0’及び第2のパラメータvy0’を演算し、演算されたパラメータに対する出力{μ1’,μ2’,te’}を各マップから得て、(18)式及び(52)式に従って{μ1’,μ2’,te’}を{μ1,μ2,te}に変換し、(45)式及び(46)式に従って入力の時間関数を、(50)式に従って最短の縦移動距離Xsを演算する。
【0133】
ただし、Ye<0の場合は、vy0→−vy0、Ye→−Yeに変換して、マップより{−μ1’,−μ2’,te’}を求め、−μ1’→ μ1’、−μ2’→ μ2’の処理を行って{μ1,μ2,te}を得ればよい。
【0134】
この結果、(1)式〜(6)式の積分計算により、横移動距離Ye、及び車両の速度から、横移動距離Yeに対して縦移動距離が最短となる最短回避軌道が導出される。
【0135】
次に、図25を参照して第3の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。ここでは、図24に示すマップを用いる場合について説明する。
【0136】
ステップ100〜ステップ110を経て、ステップ300で、横移動距離Yeに任意の値を設定する。例えば、上記ステップ102で作成した環境マップを用いて、障害物の横を通過する位置のy成分を横移動距離Yeとしたり、そのy成分に予め定めた距離を加算した距離を横移動距離Yeとしたりすることができる。
【0137】
次に、ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を演算する。
【0138】
次に、ステップ302で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、第1のパラメータvx0’、及び第2のパラメータvy0’を入力として、上記ステップ300で設定した横移動距離Yeに対して縦移動距離が最短となる最短縦移動距離Xsを導出する。
【0139】
次に、ステップ304で、上記ステップ302で導出された横移動距離Yeに対する最短縦移動距離Xsと上記ステップ108で演算された縦移動距離Xeとが等しくなったか否かを判定する。Xs=Xeの場合には、ステップ308へ移行し、Xs≠Xeの場合には、ステップ306へ移行する。なお、ここでは、Xs=Xeか否かを判定する場合について説明するが、XsとXeとが等しい場合だけでなく、XsとXeとの差が所定値(例えば、Xeの5%等)以下の場合も肯定判定されるようにしてもよい。
【0140】
ステップ306では、Yeの値をXsがXeに近づくように修正する。そして、ステップ304でXs=Xeと判定されるまで、ステップ302〜ステップ306の処理を繰り返す。
【0141】
ステップ308では、Xs=Xeと判定されたときのYeの値を用いて上記ステップ302で得られた{μ1,μ2,te}の値を(45)式及び(46)式に適用して、制御入力である車体合成加速度を得る。また、(1)式〜(6)式に従って、縦移動距離Xeに対する横移動距離Yeが最大となる車体合成力の時系列データ及び横移動距離最大化回避軌道が導出される。
【0142】
以上説明したように第3の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の横移動距離に対する縦移動距離を最短にするマップを用いて、横移動距離Yeの設定を修正しながら繰り返し縦移動距離を求めて、求めた縦移動距離と障害物までの距離のx成分との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力の時系列データを導出することができる。
【0143】
次に、第4の実施の形態について説明する。第3の実施の形態では、障害物を回避するための縦移動距離が最短となる車体合成力を求めるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第4の実施の形態では、第3の実施の形態とは異なる縦移動距離が最短となる車体合成力を求めるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする現在時刻の車体合成力を導出する場合について説明する。なお、第4の実施の形態の車両運動制御装置について、第1〜第3の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0144】
ここで、第4の実施の形態で用いられるマップについて説明する。
【0145】
まず、第3の実施の形態と同様に、(53)式まで展開する。そして、一例として、γ0’=F1’/m’=Ye’=1とした場合のvx0’及びvy0’に関するマップを作成する。図26に示すように、vx0’を第1のパラメータ、 及びvy0’を第2のパラメータとして、上記(47)式〜(49)式に基づいて得られる車体合成加速度の方向θ’及び最短縦移動距離Xs’の値をマッピングしたマップを作成する。
【0146】
そして、このマップを用いて{θ’,Xs’}を求めるには、γ0’=F1’/m’=Ye’=1、既知のm、vx0、vy0、Ye、車体合成力の最大値のx成分F1、及びy成分F2から(53)式に従って第1のパラメータvx0’及び第2のパラメータvy0’を演算し、演算されたパラメータに対する出力{θ’,Xs’}をマップから得て、(39)式により、横移動距離Yeに対して縦移動距離を最短にする現在時刻の車体合成力の大きさ及び向きが得られ、また下記(54)式によりXsが得られる。
【0147】
ただし、Ye<0の場合は、vy0→−vy0、Ye→−Yeに変換して、マップより{−θ’}を求め、−θ’→θ’の処理を行ってθを得ればよい。
【0148】
【数24】
【0149】
次に、第4の実施形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。第4の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンは、第3の実施の形態における車両運動制御ルーチン(図25)のステップ302で用いるマップ(例えば、図26のマップ)が異なる点、及びステップ308で(39)式に従って現在時刻の車体合成力大きさ及び向きを導出する点が異なり、他の処理は第3の実施の形態における車両運動制御ルーチンと同様である。
【0150】
以上説明したように第4の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の横移動距離に対する縦移動距離を最短にするマップを用いて、横移動距離Yeの設定を修正しながら繰り返し縦移動距離を求めて、求めた縦移動距離と障害物までの距離のx成分との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる現在時刻の車体合成力を導出することができる。また、車体合成力の時系列データを導出する場合と比べ、用いるマップが少ないため、マップを記憶するための容量を削減できる。
【0151】
次に、第5の実施の形態について説明する。第5の実施の形態では、回避すべき横移動距離を設定した場合において、第1または第2の実施の形態で説明したマップを用いて、縦移動距離の設定を修正しながら収束演算を行い、マップから求めた横移動距離と設定された横移動距離との差が所定値以下となったときに設定された縦移動距離に基づいて、回避すべき横移動距離に対する縦移動距離を最短にする最短回避軌道及び車体合成力を導出する場合について説明する。なお、第5の実施の形態の車両運動制御装置について、第1〜第4の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0152】
図27を参照して第5の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1〜第4の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。また、本実施の形態では、第1及び第2の実施の形態で示したマップを用いることができるが、ここでは、図3に示すマップを用いる場合について説明する。
【0153】
ステップ100〜ステップ106を経て、ステップ400で、上記ステップ100で走行状態として取り込まれた自車両の速度、及び外部環境状態として取り込まれた自車両と障害物との距離を設定された座標に対応させて変換し、横移動距離Ye、速度のx成分vx0、y成分vy0を演算する。
【0154】
次に、ステップ110で、楕円で制限された車体合成力の最大値を設定し、次に、ステップ402で、縦移動距離Xeに任意の値を設定する。例えば、上記ステップ102で作成した環境マップを用いて、自車両と障害物との距離のx成分の値を設定することができる。
【0155】
次に、ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を演算する。
【0156】
次に、ステップ404で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、第1のパラメータvx0’、及び第2のパラメータvy0’を入力として、上記ステップ402で設定した縦移動距離Xeに対して横移動距離が最大となる横移動距離yeを導出する。
【0157】
次に、ステップ406で、上記ステップ404で導出された横移動距離yeと上記ステップ400で演算された横移動距離Yeとが等しくなったか否かを判定する。ye=Yeの場合には、ステップ410へ移行し、ye≠Yeの場合には、ステップ408へ移行する。なお、ここでは、ye=Yeか否かを判定する場合について説明するが、yeとYeとが等しい場合だけでなく、yeとYeとの差が所定値(例えば、Yeの5%等)以下の場合も肯定判定されるようにしてもよい。
【0158】
ステップ408では、Xeの値をyeがYeに近づくように修正する。そして、ステップ406でye=Yeと判定されるまで、ステップ404〜ステップ408の処理を繰り返す。
【0159】
ステップ410では、ye=Yeと判定されたときのXeの値を用いて上記ステップ404で得られた{μ1,μ2,te}の値を(11)式及び(12)式に適用して、制御入力である車体合成加速度を得る。また、(1)式〜(6)式に従って、横移動距離に対する縦移動距離が最短となる車体合成力の時系列データ及び最短回避軌道が導出される。
【0160】
次に、第6の実施の形態について説明する。第6の実施の形態では、自車両の目標位置を設定した場合において、第1または第2の実施の形態で説明したマップを用いて、車体合成力の最大値の設定を修正しながら収束演算を行い、マップから求めた横移動距離と目標位置に基づいた横移動距離との差が所定値以下となったときに設定された車体合成力の最大値に基づいて、目標位置と速度方向に対して車体合成力の最大値を最小化する最適軌道及び車体合成力の時系列データを導出する場合について説明する。
【0161】
第6の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて、図27に示す第5の実施の形態の車両運動制御ルーチンと異なる点について説明する。
【0162】
ステップ400では、縦移動距離Xeも演算する。ステップ402の処理は行わず、ステップ404で、上記ステップ400で演算されたXeに対して横移動距離が最大となる横移動距離yeを導出する。ステップ408では、上記ステップ110で設定した車体合成力の最大値の値をyeがYeに近づくように修正する。
【0163】
次に、第7の実施の形態について説明する。第7の実施の形態では、目標位置及び車体合成力の最大値のx成分F1またはy成分F2の一方を設定した場合において、第1または第2の実施の形態で説明したマップを用いて、F1またはF2の他方の設定を修正しながら収束演算を行い、マップから求めた横移動距離と目標位置に基づいた横移動距離との差が所定値以下となったときに設定されたF1またはF2の一方に基づいて、F1またはF2の他方を最小化する最適軌道及び車体合成力の時系列データを導出する場合について説明する。
【0164】
第7の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて、図27に示す第5の実施の形態の車両運動制御ルーチンと異なる点について説明する。
【0165】
ステップ400では、自車両と障害物との距離のx成分Xeも演算する。ステップ110では、F1またはF2の一方を設定する。ステップ402の処理は行わず、ステップ404で、上記ステップ400で演算されたXeに対して横移動距離が最大となる横移動距離yeを導出する。ステップ408では、上記ステップ110で設定したF1またはF2の一方を一定値としてF1とF2との比γ0をyeがYeに近づくように修正する。
【0166】
次に、第8の実施の形態について説明する。第1の実施の形態では、縦移動距離Xeに対して横移動距離が最大になる車体合成力を導出するためのマップを用いて、また第3の実施の形態では、縦移動距離を最短にする車体合成力を導出するためのマップを用いて、車体合成力の時系列データを導出する場合について説明したが、第8の実施の形態では、第1及び第3の実施の形態のマップとは異なり、車体合成力の最大値を最小化するマップを用いて、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対して横移動距離が最大になる車体合成力を導出する場合について説明する。なお、第8の実施の形態の車両運動制御装置について、第1〜第7の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0167】
ここで、第8の実施の形態で用いられるマップについて説明する。
【0168】
車体合成力の最大値を最小化する最適制御は、車体合成力の最大値のx成分F1及びy成分F2が既知であると仮定して、第3の実施の形態と同様に、(7)式、(43)式、(44)式、及び(10)式で定式化でき、その制御入力は(45)式として導出される。ここでは、縦移動距離Xe、横移動距離Ye、及び車体合成力の最大値の縦横比γ0を設定して、最小化されたIが既知の距離のx成分Xeと等しくなるようなF1を求めれば、結果的に車体合成力の最大値が最小となる最適軌道が導出されることを示している。よって、x1(te)=Xeの関係を導入することにより、Xs→Xeに変換された非線型方程式(46)式〜(50)式から(45)式で必要となるμ1、μ2、teが求まる。ここでは、限界合成力の大きさFmax、縦移動距離Xe、横移動距離Ye、及び車体合成力の最大値の縦横比γ0(γ2/γ1)が既知であるとして、(47)式〜(50)式を満足するF1、μ1、μ2、teを求めることで、γ1及びγ2が得られる。これは、最小化されたIとXeとが等しくなるようなγ1Fmax及びγ2Fmaxが求められることを意味し、結果的に、予め与えられた車体合成力の最大値の縦横比γ0に対して、車体合成力の最大値が最小化される最適軌道が得られる。従って、Xs→Xeに変換された(47)式〜(50)式に対して、m、vx0、vy0、Xe、Ye、及びγ0を代入して、F1、μ1、μ2、teを求めることを考える。
【0169】
まず、(47)式を下記(55)式のように変形する。
【0170】
【数25】
【0171】
(55)式を(48)式〜(50)式へ代入して、下記(56)式〜(58)式を得る。
【0172】
【数26】
【0173】
ここで、任意の正数aを導入して下記(59)式の関係を満足する2組のパラメータP及びP’を考えると、P及びP’に対応する解 {μ1、μ2、te}及び{μ1’、μ2’、te’}は、(18)式の関係を満たす。
【0174】
【数27】
【0175】
(59)式の最後の式より、aを下記(60)式のようにおくと、(59)式よりvy0’及びYe’は下記(61)式のように変形できる。
【0176】
【数28】
【0177】
この関係より、γ0’、vx0’及びXe’に任意の正数を設定することにより、現在時刻のパラメータPによってvy0’及びYe’が求まる。よって、γ0’、vx0’及びXe’をある正数に設定した場合において、vy0’を第1のパラメータ、及びYe’を第2のパラメータとしたマップを予め用意しておけばよい。なお、このγ0’、vx0’及びXe’の値はマップ作成時に設計者が自由に設定できる。
【0178】
マップの作成は、第1の実施の形態と同様の手法で、図28に示すように、例えば、γ0’=vx0’=Xe’=1とした場合のvx0’及びvy0’に関するマップを作成する。
【0179】
そして、これらのマップから{μ1’,μ2’,te’}を得て、(18)式及び(60)式により{μ1,μ2,te}に変換して、(45)式及び(46)式に代入して、入力の時間関数が得られる。また、(55)式に代入して得られるF1と、既知のFmax及びγ0を用いて、車体合成力の最大値が最小となるγ1及びγ2が得られる。
【0180】
次に、図29を参照して第8の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1〜第7の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。ここでは、図28に示すマップを用いる場合について説明する。
【0181】
ステップ100〜ステップ108を経て、ステップ110で、車体合成力の最大値のx成分F1及びy成分F2を設定する。これにより、同時に車体合成力の最大値の縦横比γ0が定まる。
【0182】
次に、ステップ300で、横移動距離Yeに任意の距離に設定し、次に、ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を演算する。
【0183】
次に、ステップ500で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、第1のパラメータvx0’、及び第2のパラメータvy0’を入力として、上記ステップ108で演算したXe及び上記ステップ300で設定したYeで定まる目標位置及び上記ステップ110で定まるγ0に対して、車体合成力の最大値のx成分f1を導出する。
【0184】
次に、ステップ502で、上記ステップ500で導出された車体合成力f1と上記ステップ110で設定した車体合成力の最大値のx成分F1とが等しくなったか否かを判定する。f1=F1の場合には、ステップ504へ移行し、f1≠F1の場合には、ステップ306へ移行する。なお、ここでは、f1=F1か否かを判定する場合について説明するが、f1とF1とが等しい場合だけでなく、f1とF1との差が所定値(例えば、F1の5%等)以下の場合も肯定判定されるようにしてもよい。
【0185】
ステップ306では、上記ステップ300で設定した横移動距離Yeをf1がF1に近づくように修正する。そして、ステップ504でf1=F1と判定されるまで、ステップ500、502及び306の処理を繰り返す。
【0186】
ステップ504では、f1=F1と判定されたときのYeの値を用いて上記ステップ500で得られた{μ1,μ2,te}の値を(45)式及び(46)式に適用して、制御入力である車体合成加速度を得る。また、(1)式〜(6)式に従って、縦移動距離に対する横移動距離が最大となる車体合成力の時系列データ及び横移動距離最大化回避軌道が導出される。
【0187】
以上説明したように第8の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の車体合成力の最大値を最小化するマップを用いて、横移動距離Yeの設定を修正しながら繰り返し車体合成力の最大値のx成分f1を求めて、求めたf1と設定された車体合成力の最大値のx成分F1との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力の時系列データを導出することができる。
【0188】
なお、(46)式の第1式の代わりにF1=F2/γ0を(47)〜(50)式に代入して、Xs→Xeに変化した非線型方程式を用いて同様の流れで式展開を行い、{μ1’,μ2’,te’}に関するマップを作成してもよい。この場合、繰り返し求められる車体合成力の最大値のy成分f2と設定された車体合成力のy成分F2との差が所定値以下となるような収束演算を導入する。
【0189】
次に、第9の実施の形態について説明する。第8の実施の形態では、最大値が最小となる車体合成力を求めるためのマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第9の実施の形態では、第8の実施の形態とは異なるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする現在時刻の車体合成力を導出する場合について説明する。なお、第9の実施の形態の車両運動制御装置について、第1〜第8の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0190】
ここで、第9の実施の形態で用いられるマップについて説明する。
【0191】
まず、第8の実施の形態と同様に、(61)式まで展開する。そして、一例として、vx0’=Xe’=1 とした場合のvy0’及びYe’に関するマップを作成する。図30に示すように、vy0’を第1のパラメータ、 及びYe’を第2のパラメータとして、上記(55)式〜(58)式、(45)式、及び(46)式に基づいて得られる車体合成力の方向θ’の値をマッピングした第1のマップ、及びF1’/m’の値をマッピングした第2のマップを作成する。
【0192】
そして、これらのマップを用いて{θ,F1/m}を求めるには、vx0’=Xe’=1、既知のγ0、m、vx0、vy0、Xe、及びYeから(61)式に従って第1のパラメータvy0’及び第2のパラメータYe’を演算し、演算されたパラメータに対する出力{θ’,F1’/m’}を各マップから得て、(55)式、(18)式、及び(60)式の関係から得られる下記(62)式に従ってF1を演算する。そして、(39)式を適用すれば、現在時刻の車体合成加速度が得られる。
【0193】
【数29】
【0194】
この結果、縦移動距離Xe、横移動距離Ye、及び自車両の速度から、目標位置及び目標位置における速度方向に到達するために最大値が最小となる現在時刻での車体合成力が導出される。
【0195】
次に、第9の実施形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。第9の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンは、第8の実施の形態における車両運動制御ルーチン(図29)のステップ500で用いるマップ(例えば、図30のマップ)が異なる点、及びステップ504で(39)式に従って現在時刻の車体合成力大きさ及び向きを導出する点が異なり、他の処理は第9の実施の形態における車両運動制御ルーチンと同様である。
【0196】
以上説明したように第9の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の車体合成力の最大値を最小化するマップを用いて、横移動距離Yeの設定を修正しながら繰り返し車体合成力の最大値のx成分f1を求めて、求めたf1と設定された車体合成力の最大値のx成分F1との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる現在時刻の車体合成力の大きさ及び向きを導出することができる。また、車体合成力の時系列データを導出する場合と比べ、用いるマップが少ないため、マップを記憶するための容量を削減できる。
【0197】
なお、(46)式の第1式の代わりにF1=F2/γ0を(47)〜(50)式に代入して、Xs→Xeに変換した非線型方程式を用いて同様の流れで式展開を行い、{θ’,F1’/m’}に関するマップを作成してもよい。
【0198】
次に、第10の実施の形態について説明する。第1の実施の形態では、縦移動距離Xeに対して横移動距離が最大になる車体合成力を導出するためのマップを用いて、また第3の実施の形態では、縦移動距離を最短にする車体合成力を導出するためのマップを用いて、さらに第8の実施の形態では、最大値を最小にする車体合成力を導出するためのマップを用いて、車体合成力の時系列データを導出する場合について説明したが、第10の実施の形態では、車体合成力の最大値のx成分またはy成分の一方を与えた場合に、他方を最小化するマップを用いて、縦移動距離Xeに対して横移動距離が最大になる車体合成力を導出する場合について説明する。なお、第10の実施の形態の車両運動制御装置について、第1〜第9の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0199】
ここで、第10の実施の形態で用いられるマップについて説明する。ここでは、車体合成力の最大値のx成分を与え、y成分を最小化する場合を考える。
【0200】
車体合成力の最大値のy成分を最小化する最適制御は、第3の実施の形態と同様に、(7)式、(43)式、(44)式、及び(10)式で定式化でき、その制御入力は(45)式として導出される。ここでは、限界合成力の大きさFmax、縦移動距離Xe、横移動距離Ye、及び車体合成力の最大値のx成分F1が既知であるとして、(47)式〜(50)式を満足するγ0、μ1、μ2、teを求めることでγ2が得られる。
【0201】
まず、(48)式を下記(63)式のように変形する。
【0202】
【数30】
【0203】
(63)式を(47)式、(49)式及び(50)式へ代入して、下記(64)式〜(66)式を得る。
【0204】
【数31】
【0205】
ここで、任意の正数aを導入して下記(67)式の関係を満足する2組のパラメータP及びP’を考えると、P及びP’に対応する解 {μ1、μ2、te}及び{μ1’、μ2’、te’}は、(18)式の関係を満たす。
【0206】
【数32】
【0207】
(67)式の最後の式より、aを下記(68)式のようにおくと、(67)式よりvx0’及びvy0’は下記(69)式のように変形できる。
【0208】
【数33】
【0209】
この関係より、F1’/m’、Xe’及びYe’に任意の正数を設定することにより、現在時刻のパラメータPによってvx0’及びvy0’が求まる。よって、F1’/m’、Xe’及びYe’をある値に設定した場合において、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとしたマップを予め用意しておけばよい。なお、このF1’/m’、Xe’及びYe’の値はマップ作成時に設計者が自由に設定できる。
【0210】
マップの作成は、第1の実施の形態と同様の手法で、図31に示すように、例えば、F1’/m’=Xe’=Ye’=1とした場合のvx0’及びvy0’に関するマップを作成する。
【0211】
そして、これらのマップから{μ1’,μ2’,te’}を得て、(18)式及び(68)式により{μ1,μ2,te}に変換して、(63)式よりγ0を求める。そして、(45)式及び(46)式に代入して、入力の時間関数が得られる。
【0212】
次に、図32を参照して第10の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1〜第9の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。ここでは、図31に示すマップを用いる場合について説明する。
【0213】
ステップ100〜ステップ108を経て、次に、ステップ110で、車体合成力の最大値のx成分F1及びy成分F2を設定する。これにより、同時に車体合成力の最大値の縦横比γ0が定まる。
【0214】
次に、ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を演算し、次に、ステップ604で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、第1のパラメータvx0’、及び第2のパラメータvy0’を入力として、目標位置として上記ステップ108で演算したXe及び上記ステップ300で設定したYeで定まる位置を設定した場合における車体合成力の最大値のy成分を最小化する車体合成力の縦横比γfを導出する。
【0215】
次に、ステップ606で、上記ステップ604で導出した縦横比γfと上記ステップ600で設定した車体合成力の最大値の縦横比γ0とが等しくなったか否かを判定する。γf=γ0の場合には、ステップ504へ移行し、γf≠γ0の場合には、ステップ306へ移行する。なお、ここでは、γf=γ0か否かを判定する場合について説明するが、γfとγ0とが等しい場合だけでなく、γfとγ0との差が所定値(例えば、γ0の5%等)以下の場合も肯定判定されるようにしてもよい。
【0216】
ステップ306では、上記ステップ300で設定した横移動距離Yeをγfがγ0に近づくように修正する。そして、ステップ606でγf=γ0と判定されるまで、ステップ604、606及び306の処理を繰り返す。
【0217】
ステップ504では、γf=γ0と判定されたときのYeの値を用いて上記ステップ604で得られた{μ1,μ2,te}の値を(45)式及び(46)式に適用して、制御入力である車体合成加速度を得る。また、(1)式〜(6)式に従って、縦移動距離に対する横移動距離が最大となる車体合成力の時系列データ及び横移動距離最大化回避軌道が導出される。
【0218】
以上説明したように第10の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の車体合成力の最大値のy成分を最小化するマップを用いて、横移動距離Yeの設定を修正しながら繰り返し車体合成力の縦横比γfを求めて、求めたγfと設定された縦横比γ0との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力の時系列データを導出することができる。
【0219】
次に、第11の実施の形態について説明する。第10の実施の形態では、車体合成力の最大値のx成分またはy成分の一方が最小となる車体合成力を求めるためのマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第11の実施の形態では、第10の実施の形態とは異なるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする現在時刻の車体合成力を導出する場合について説明する。なお、第11の実施の形態の車両運動制御装置について、第1〜第10の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0220】
ここで、第11の実施の形態ので用いられるマップについて説明する。
【0221】
まず、第10の実施の形態と同様に、(69)式まで展開する。そして、一例として、F1’/m’=Xe’=Ye’=1 とした場合のvx0’及びvy0’に関するマップを作成する。図33に示すように、vx0’を第1のパラメータ、 及びvy0’を第2のパラメータとして、上記(63)式〜(66)式、(45)式、及び(46)式に基づいて得られる車体合成力の方向θ’の値をマッピングした第1のマップ、及びγ0’の値をマッピングした第2のマップを作成することができる。
【0222】
そして、車体合成加速度のy成分の大きさを下記(70)式で求めて、(39)式に適用することにより、現在時刻のm、vx0、vy0、Xe、Ye及びF1に対して、目標位置と目標位置における速度方向に到達する際に、車体合成力の最大値のy成分を最小にする現在時刻の車体合成力の大きさと向きが得られる。
【0223】
【数34】
【0224】
次に、第11の実施形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。第11の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンは、第10の実施の形態における車両運動制御ルーチン(図32)のステップ604で用いるマップ(例えば、図33のマップ)が異なる点、及びステップ504で(39)式に従って現在時刻の車体合成力大きさ及び向きを導出する点が異なり、他の処理は第10の実施の形態における車両運動制御ルーチンと同様である。
【0225】
以上説明したように第11の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の車体合成力の最大値のy成分を最小化するマップを用いて、横移動距離Yeの設定を修正しながら繰り返し車体合成力の縦横比γfを求めて、求めたγfと設定された縦横比γ0との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる現在時刻の車体合成力の大きさ及び向きを導出することができる。また、車体合成力の時系列データを導出する場合と比べ、用いるマップが少ないため、マップを記憶するための容量を削減できる。
【0226】
なお、第10及び第11の実施の形態では、車体合成力の最大値のx成分を設定した場合に、y成分を最小化するマップを用いたが、同様の手法により車体合成力の最大値のy成分を設定した場合に、x成分を最小化するマップを作成して用いてもよい。
【0227】
また、上記第3〜第11の実施の形態においても、第1及び第2の実施の形態と同様の手法により、導入した任意の正数aの取り方を変えたり、F1’/m’、vy0’、vx0’、Xe’、及びYe’のそれぞれに着目して式を変形したりして、第1のパラメータ及び第2のパラメータを求めることができる。それぞれ得られた第1のパラメータ及び第2のパラメータに応じて、F1’/m’、vy0’、vx0’、Xe’、及びYe’の内必要な値に任意の値を設定してマップを作成することができる。また、第1の実施の形態でマップの軸の取り方を変更した手法と同様の手法により、特異点のラインが縦軸又は横軸と平行になるように各マップの軸の取り方を変更したマップを作成することもできる。
【0228】
また、上記第2〜第11の実施の形態においても、第1の実施の形態と同様に、F1及びγ0を用いるのではなく、F2及びγ0を用いて式展開を行い、各実施の形態で示したマップを適用してもよい。
【符号の説明】
【0229】
10 車速センサ
12 操舵角センサ
14 スロットル開度センサ
16 前方カメラ
18 レーザレーダ
20 制御装置
22 操舵角制御装置
24 制動力制御装置
26 駆動力制御装置
28 マップ記憶装置
30 表示装置
【技術分野】
【0001】
本発明は、車両運動制御装置及びプログラムに係り、特に、簡単な構成のマップを用いて所望の縦移動距離及び速度方向に対して、横移動距離を最大化にするため車体合成力を導出する車両運動制御装置及びプログラムに関する。
【背景技術】
【0002】
従来、車体に加える目標合成力と、各車輪の限界摩擦円の大きさから推定される限界合成力との比をμ利用率として設定し、限界摩擦円の大きさとμ利用率とからタイヤ発生力の大きさ、及び各制御対象車輪で発生するタイヤ発生力の方向を設定し、設定されタイヤ発生力の大きさ、及び設定されたタイヤ発生力の方向に基づいて、各制御対象車輪の操舵と制動又は操舵と駆動との協調制御を行なう車両制御装置が提案されている(特許文献1参照)。
【0003】
また、車両よりも前方の道路上に存在する障害物を回避するための回避操作量を、車両に生じる加速力、減速力および横力の合成力が車両のタイヤのグリップ力の最大値よりも小さくなる範囲内で算出する回避操作算出装置が提案されている(特許文献2参照)。
【0004】
また、車両が走行する道路上に存在する障害物を検出し、検出現在時刻から評価終了時刻後の自車両の予測位置及び外部環境に基づいて、自車両の回避後の目標姿勢角を設定し、現在時刻の外部環境及び障害物の状態量に基づいてリスクポテンシャル関数を設定し、そのリスクと運転操作量の時間積分値、目標姿勢角と自車両の姿勢角との差などに基づく評価値を算出し、評価値が最小となる軌道を導出する回避操作算出装置が提案されている(特許文献3参照)。
【0005】
また、自車両と障害物との間の距離および自車両の障害物に対する相対速度、そして回避するための横移動距離に基づいて定まる物理量を導入し、その物理量と自車両の重量および車体合成力の最大値により最短距離で回避するための車体合成力の向きを導出するマップを予め記憶しておき、直進制動での最短回避距離と単純横移動における最短回避距離と、現時刻の自車両と障害物の状態に基づいてマップより得られる最短回避距離を比較して、最も短くなる回避軌道を選択し、その軌道に基づいて現時刻の車体合成力を算出する車両制御装置が提案されている(特許文献4参照)。
【0006】
また、ロボットの位置、ロボットが到達目標とする目標到達位置、ロボットが目標到達位置へ到達する時に目標とする目標速度、およびロボットの制限最高速度又は制限最高加速度の各値を用いて、ロボットが制限最高速度又は制限最高加速度を越えない速度をとるとともにロボットの初期位置から目標位置へ到達するのに要する時間が等しい軌道の中ではロボットの加速度の二乗総和が最小となるようにするロボットの制御装置が提案されている(特許文献5参照)。
【0007】
また、車両がスタート位置Pに停止したとき、物体検出手段で検出した周囲の物体の状況から最適目標位置と、最適目標位置を通る一定半径rの円弧よりなる第1の移動軌跡とを設定し、第1の移動軌跡上に所定位置Sを選択し、スタート位置Pから所定位置Sまでの第2の移動軌跡を設定し、所定位置Sは、第2の移動軌跡での車両の移動距離が最小になるように選択される車両の自動操舵装置が提案されている(特許文献6参照)。
【先行技術文献】
【特許文献】
【0008】
【特許文献1】特開2004−249971号公報
【特許文献2】特開2007−253746号公報
【特許文献3】特開2007−253745号公報
【特許文献4】特開2006−347236号公報
【特許文献5】特開平7−32277号公報
【特許文献6】特開2001−063597号公報
【発明の概要】
【発明が解決しようとする課題】
【0009】
しかしながら、特許文献1〜4の技術では、回避軌道や車体合成力を導出してはいるが、与えられた車体合成力の限界値を用いて横移動距離を最大化する車体合成力の導出については記載されていない。
【0010】
また、特許文献5の技術では、加速度の2乗和が最小化される回避軌道を導出すること、また、特許文献6の技術では、自車両を目標位置に到達させる移動距離が最小となる軌道を導出することが記載されているが、所望の縦移動距離に対して横移動距離を最大化する軌道を導出することは記載されていない。
【0011】
本発明は、車体合成力の最大値が楕円で制限される場合において、最適制御法によって作成した簡単な構成のマップを用いて所望の縦移動距離及び速度方向に対して、横移動距離を最大化する軌道及び車体合成力を導出することができる車両運動制御装置及びプログラムを提供することを目的とする。
【課題を解決するための手段】
【0012】
上記目的を達成するために、第1の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、前記移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Xe、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力を求めるために導入した第1の導入パラメータμ1の、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、・前記第1のパラメータと、前記第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力を求めるために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1及び前記成分F2に基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、を含んで構成されている。
【0013】
また、第2の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、前記移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Xe、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成加速度の方向θの、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’と、の関係を定めたマップを記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1及び前記成分F2に基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、を含んで構成されている。
【0014】
また、第3の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離が最短となる車体合成力を求めるために導入した第1の導入パラメータμ1の、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、・前記第1のパラメータと、前記第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離が最短となる車体合成力を求めるために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Yeに対して車体前後方向の移動距離が最短となる最短距離Xs及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて前記最短距離Xsを求め、求めた前記最短距離Xsと前記移動距離Xeとの差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記最短距離Xsを求め、前記最短距離Xsと前記距離の車体前後方向の成分Xeとの差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、を含んで構成されている。
【0015】
また、第4の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離Xeが最短となる車体合成加速度の方向θの、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’と、の関係を定めた第1のマップ、及び・前記第1のパラメータと、前記第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対する車体前後方向の移動距離の最短距離Xsの、前記仮定の下での値Xs’と、の関係を定めた第2のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、及び前記第2のマップを用いて前記最短距離Xsを求め、求めた前記最短距離Xsと前記移動距離Xeとの差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記最短距離Xsを求め、前記最短距離Xsと前記距離の車体前後方向の成分Xeとの差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、を含んで構成されている。
【0016】
また、第1または第2の発明において、前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記成分F1及び前記成分F2を一定値として前記移動距離Xeを変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記移動距離Xeに基づいて、設定した前記移動距離Yeに対して前記移動距離Xeが最短となる最短回避軌道を導出するようにすることができる。
【0017】
また、第1または第2の発明において、前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記比γ0を一定値として前記成分F1及び前記成分F2の設定を変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記成分F1及び前記成分F2に基づいて、車体合成力の最大値が最小となる軌道を導出するようにすることができる。
【0018】
また、第1または第2の発明において、前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記成分F1または前記成分F2の一方を一定値として前記比γ0を変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記比γ0に基づいて、前記成分F1または前記成分F2の他方が最小となる軌道を導出するようにすることができる。
【0019】
また、第5の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0と、自車両の速度の車体前後方向の成分vx0と前記速度の車体横方向の成分vy0との比と、の積で定められた第1のパラメータと、前記比γ0と、前記移動距離Xeと車体横方向の移動距離Yeとの比と、の積で定められた第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値を最小にするために導入した第1の導入パラメータμ1の、前記比γ0、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値を最小にするために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるための車体合成力の最大値が最小となる車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、を含んで構成されている。
【0020】
また、第6の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0と、自車両の速度の車体前後方向の成分vx0と前記速度の車体横方向の成分vy0との比と、の積で定められた第1のパラメータと、前記比γ0と、前記移動距離Xeと車体横方向の移動距離Yeとの比と、の積で定められた第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値が最小となる車体合成加速度の方向θの、前記比γ0、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’との関係を定めた第1のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために最大値が最小となる車体合成加速度F1/mの、前記仮定の下での車体合成加速度F1’/m’と、の関係を定めた第2のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、及び前記第2のマップを用いて前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるための車体合成力の最大値が最小となる車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、を含んで構成されている。
【0021】
また、第7の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/mまたは車体横方向の成分F2/m、前記移動距離Xe、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、車体合成力の最大値の車体前後方向の成分F1または車体横方向の成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方を最小にするために導入した第1の導入パラメータμ1の、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、・前記第1のパラメータと、前記第2のパラメータと、前記成分F1または前記成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方を最小にするために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて、設定した前記成分F1または前記成分F2の一方に対して前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小になる車体合成力の最大値の車体前後方向の成分と車体横方向の成分との比γfを求め、求めた前記比γfと設定した前記成分F1と前記成分F2との比γ0との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記比γfを求め、求めた前記比γfと前記比γ0との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、を含んで構成されている。
また、第8の発明の車両運動制御装置は、車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、自車両の速度を検出する検出手段と、・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/mまたは車体横方向の成分F2/m、前記移動距離Xe、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、車体合成力の最大値の車体前後方向の成分F1または車体横方向の成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小となる車体合成加速度の方向θの、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’との関係を定めた第1のマップ、並びに・前記第1のパラメータと、前記第2のパラメータと、前記成分F1と前記成分F2との比γ0の、前記仮定の下での比γ0’と、の関係を定めた第2のマップ、を記憶した記憶手段と、前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、及び前記第2のマップを用いて、設定した前記成分F1または前記成分F2の一方に対して前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小になる車体合成力の最大値の車体前後方向の成分と車体横方向の成分との比γfを求め、求めた前記比γfと設定した前記成分F1と前記成分F2との比γ0との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記比γfを求め、求めた前記比γfと前記比γ0との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻における車体合成力を導出する導出手段と、を含んで構成されている。
【0022】
また、前記導出手段で導出された前記車体合成力に基づいて、操舵角、制動力、及び駆動力の少なくとも一つを制御する制御手段を更に含んで構成することができる。
【0023】
また、操舵角、制動力、及び駆動力の少なくとも一つを制御する制御手段を含んで構成し、前記設定手段は、障害物の位置及び大きさに基づいて、前記障害物を回避すべき横移動距離を設定し、前記制御手段は、前記導出手段により導出された最大化された移動距離Yeと、前記設定手段で設定された回避すべき横移動距離とを比較し、前記最大化された移動距離Yeの方が小さい場合には、急制動または衝突被害推定値を最小にする制御を行い、前記回避すべき横移動距離の方が小さい場合には、前記導出手段で導出された前記車体合成力に基づいた回避制御を行うようにすることができる。
【0024】
また、前記第1のパラメータ、及び前記第2のパラメータを、各マップの特異点が該マップの縦軸又は横軸と平行になるように変更することができる。
【0025】
また、前記設定手段は、障害物の位置及び大きさに基づいて、前記車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定し、前記検出手段は、自車両の前記障害物に対する相対速度を検出するようにすることができる。
【0026】
また、前記導出手段で導出された前記車体合成力に基づいて、ドライバに車両運動状態を報知する報知手段を更に含んで構成することができる。
【0027】
また、第9の発明の車両運動制御プログラムは、コンピュータを、第1〜第8の発明の車両運動制御装置を構成する各手段として機能させるためのプログラムである。
【発明の効果】
【0028】
以上説明したように本発明によれば、車体合成力の最大値が縦横比の楕円で制限される場合において、車体合成力の最大値を設定して、自車両と所望の位置との距離、自車両の速度により演算されるパラメータを用いた簡単な構成のマップを用いて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力を導出することができる、という効果が得られる。
【図面の簡単な説明】
【0029】
【図1】車両運動制御の概略を示す図である。
【図2】xy座標の設定を説明するための図である。
【図3】第1の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図4】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図5】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図6】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図7】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図8】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図9】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図10】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図11】第1の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図12】第1の実施の形態の車両運動制御装置の構成を示すブロック図である。
【図13】第1の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図14】第2の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図15】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図16】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図17】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図18】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図19】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図20】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図21】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図22】第2の実施の形態の車両運動制御装置で用いられるマップの他の例を表す線図である。
【図23】第2の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図24】第3の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図25】第3の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図26】第4の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図27】第5の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図28】第8の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図29】第8の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図30】第9の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図31】第10の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【図32】第10の実施の形態の車両運動制御ルーチンを示すフローチャートである。
【図33】第11の実施の形態の車両運動制御装置で用いられるマップを表す線図である。
【発明を実施するための形態】
【0030】
以下、図面を参照して本発明の実施の形態を詳細に説明する。本実施の形態では、車両が走行する道路上の障害物を回避する場合を想定し、障害物の横を通過する位置における速度方向を車体前後方向とする場合について説明する。
【0031】
第1の実施の形態の車両運動制御装置における車体合成力及び回避軌道の導出の概略について説明する。
【0032】
図1に示すように、設定したxy座標での時刻t(現在時刻をt=0として、現在時刻からt秒後)における車体合成加速度のx成分をux(t)、車体合成加速度のy成分をuy(t)、車体合成力の大きさのx成分をFx(t)、車体合成力の大きさのy成分をFy(t)、車体合成力の方向をθ0(t)、及び自車両の重量をmとすると、車体合成加速度のx成分ux(t)及びy成分uy(t)は、下記(1)式及び(2)式で示される。また、(1)式及び(2)式を積分して、下記(3)式及び(4)式に示すように、自車両の路面に対する速度のx成分vx(t)、及び速度のy成分vy(t)が得られる。また、(3)式及び(4)式を積分して、下記(5)式及び(6)式に示すように、自車両のt秒間の移動距離のx成分X(t)、及び移動距離のy成分Y(t)が得られる。このX(t)及びY(t)により回避軌道が得られる。
【0033】
【数1】
【0034】
なお、xy座標は、t=0における自車両の位置を原点とし、障害物の横を通過する位置における速度方向(車体前後方向)をx軸、x軸に直交する軸(車体横方向)をy軸として設定する(図2参照)。
【0035】
そして、現在時刻(t=0)におけるxy座標上の目標位置を(Xe,Ye)、自車両の路面に対する速度をvx(0)=vx0、vy(0)=vy0、目標位置及び目標位置における速度方向に到達する時刻をteとした場合に、車体合成力の最大値のx成分及びy成分を設定して、目標位置までの縦移動距離Xe(自車両と目標位置との距離のx成分)に対する横移動距離Ye(自車両と目標位置との距離のy成分)が最大となるような車体合成加速度ux(t)及びuy(t)((1)式、及び(2)式)を、各輪の限界摩擦円の大きさから推定される限界合成力の大きさFmax、及び縦移動距離Xeをある値に設定した場面において、vx0及びvy0をパラメータとするマップを用いて導出する。
【0036】
なお、縦移動距離Xe及び縦移動距離Xeに対して最大化された横移動距離Yeで定まる位置が目標位置であり、導出の初期段階で設定する所望の縦移動距離Xeで定まる位置は所望位置と呼ぶ。所望位置においては、横移動距離は不定である。
【0037】
次に、第1の実施の形態で用いられるマップについて説明する。
【0038】
まず、x1=X(t)、x2=vx(t)、x3=Y(t)、x4=vy(t)、u1=ux(t)、u2=uy(t)とおくと、(1)式及び(2)式の運動方程式は、下記(7)式のような状態方程式に変形できる。なお、Tはベクトル及び行列の転置記号である。
【0039】
【数2】
【0040】
次に、限界合成力の大きさFmax及びμ利用率(γ1、γ2)が-既知であると仮定して、横方向の移動距離に−1を掛けた値を最小化する最適制御問題として考える。なお、μ利用率は、車体に与える目標合成力と限界合成力Fmaxとの比として設定される物理指標であり、γ1が車両前後方向に対するμ利用率、γ2が車両横方向に対するμ利用率である。
【0041】
ここで、本実施の形態では、車両が発生することができる車体合成力の最大値を、車両前後方向(x軸)を長軸(または短軸)とする楕円で制限し、μ利用率(γ1、γ2)と限界合成力の大きさFmaxとに基づいて、楕円で制限されたx成分(楕円の長軸(または短軸)方向)の最大値、及びy成分(楕円の短軸(または長軸)方向)の最大値を定める。
【0042】
目標位置に到達する時刻をteとおけば、評価関数Iを下記(8)式で表した場合、下記(9)式で表される終端条件、及び下記(10)式で表される楕円で制限される車体合成力の大きさに関する入力制約条件の下で、評価関数Iを最小化する制御入力を求めよという制御問題に帰着される。
【0043】
【数3】
【0044】
ここで、特開2007−283910号公報等の公知の技術を用いると、下記(11)式のような制御入力が導出される。
【0045】
【数4】
【0046】
ただし、ν1及びν2は最適解を求めるために導入した第1の導入パラメータ及び第2の導入パラメータである。また、γ1≠γ2の場合には、θ(t)の値によって車体合成力の大きさが変化することを示しており、(11)式で示す入力の大きさ|u(t)|は時変となる。γ1=γ2の場合には、(11)式で示す|u(t)|の値は時不変となる。
【0047】
ここで、下記(12)式のように変数変換する。
【0048】
【数5】
【0049】
そして、(7)式に適用して(1)式〜(6)式に従って時間積分し、さらに、Y(te)=Yeとおくと、初期条件及び終端条件により、(11)式において必要となるte 、ν1、ν2は、下記(13)式、(14)式、及び(16)式の非線形方程式にm、vx0、vy0、F1、γ0、及びXeを代入して解くことにより得られる。また、縦移動距離Xeに対して横移動距離が最大となるときの横移動距離Yeは、(15)式の関係を満たす。
【0050】
【数6】
【0051】
この方程式の解を求めるために、低次元化したマップを導出する。まず、(13)式、(14)式、及び(16)式に着眼して、任意の正数aを導入して下記(17)式の関係を満足する2組のパラメータP及びP’を考えると、P及びP’に対応する解 {μ1、μ2、te}及び{μ1’、μ2’、te’}は、下記(18)式の関係を満たす。
【0052】
【数7】
【0053】
(17)式の最後の式より、aを下記(19)式のようにおくと、(17)式よりvx0’ 及びvy0’は(20)式のように変形できる。
【0054】
【数8】
【0055】
この関係より、γ0’、F1’/m’及びXe’に任意の正数を設定することにより、現在時刻のパラメータPによってvx0’及びvy0’が求まる。よって、γ0’、F1’/m’及びXe’をある値に設定した場合において、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとしたマップを予め用意しておけばよい。なお、このγ0’、F1’/m’及びXe’の値は、マップ作成時に設計者が自由に設定できる。
【0056】
ここでは、一例として、γ0’=F1’/m’=Xe’=1とした場合のvx0’及びvy0’に関するマップを作成する。図3に示すように、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとして、(13)式、(14)式、及び(16)式に基づいて得られるμ1’の値をマッピングした第1のマップ、μ2’の値をマッピングした第2のマップ、及びte’の値をマッピングした第3のマップを作成する。
【0057】
そして、これらのマップを用いて{μ1,μ2,te}を求めるには、γ0’=F1’/m’=Xe’=1、既知のm、vx0、vy0、Xe、限界合成力の大きさFmaxとμ利用率γ1とで定まる車体合成力の最大値のx成分F1、及びμ利用率γ1とγ2とで定まるγ0から(20)式に従って第1のパラメータvx0’及び第2のパラメータvy0’を演算し、演算されたパラメータに対する出力{μ1’,μ2’,te’}を各マップから得て、(18)式及び(19)式に従って{μ1’,μ2’,te’}を{μ1,μ2,te}に変換し、(11)式及び(12)式に従って入力の時間関数を、(15)式に従って、所望の縦移動距離Xeに対して最大となる横移動距離Yeを演算する。
【0058】
ただし、vy0<0 の場合は、vy0→−vy0、Ye→−Yeに変換して、マップより{−μ1’,−μ2’,te’}を求め、−μ1’→ μ1’、−μ2’→ μ2’の処理を行って{μ1,μ2,te}を得ればよい。
【0059】
この結果、(1)式〜(6)式の積分計算により、縦移動距離Xe、及び車両の速度から、縦移動距離Xeに対して横移動距離が最大となる横移動距離最大化回避軌道が導出される。
【0060】
なお、上記のマップでは、第1のパラメータ及び第2のパラメータを(20)式のように定めた場合について説明したが、任意の正数aを、(17)式の1番目の式を用いて下記(21)式のようにおいて、下記(22)式に示すvy0’を第1のパラメータ、及びXe’を第2のパラメータとし、例えば、γ0’=F1’/m’=vx0’=1として、図4に示すようなマップを作成することができる。
【0061】
【数9】
【0062】
また、(22)式の第2式を下記(23)式のように変更すると、aは下記(24)式のように変形される。そして、(22)式のvy0’及び(23)式のF1’/m’を第1及び第2のパラメータとし、γ0’=Xe’=vx0’=1としてマップを作成してもよい(図5)。
【0063】
【数10】
【0064】
また、別のパラメータを用いる場合として、任意の正数aを、(17)式の2番目の式を用いて下記(25)式のようにおいて、下記(26)式に示すvx0’を第1のパラメータ、及びXe’を第2のパラメータとし、上記と同様に、例えば、γ0’=F1’/m’=1、vy0’=±1として、図6、7に示すようなマップを作成することができる。ここで、vy0>0の場合には、図6に示すマップを用い、vy0<0の場合には、図7に示すマップを用いる。
【0065】
【数11】
【0066】
また、(26)式の第2式を下記(27)式のように変更すると、aは下記(28)式のように変形される。そして、(26)式のvx0及び(27)式のF1’/m’を第1及び第2のパラメータとし、γ0’=Xe’=1、vy0’=±1としてするマップを作成してもよい(図8,9)。
【0067】
【数12】
【0068】
また、マップの軸の取り方を変更して、特異点を縦軸又は横軸と平行になるように移動させたマップを用いてもよい。
【0069】
具体的には、図3に示すマップの軸の取り方を下記(29)式または(30)式のように変更し、(29)式に示すvx0’’を第1のパラメータ、及びvy0’を第2のパラメータとし、上記と同様に、γ0’=F1’/m’=Xe’=1として、図10に示すようなマップを作成することができる。同様に、(30)式に示すvx0’を第1のパラメータ、及びvy0’’を第2のパラメータとし、上記と同様に、γ0’=F1’/m’=Xe’=1として、図11に示すようなマップを作成することができる。
【0070】
【数13】
【0071】
このように、特異点のラインが縦軸又は横軸と平行になるようにマップの軸を変更することにより、マップの精度を保ちつつマップを記憶する容量を図3に示したマップに比べて小さく抑えることが容易になる。
【0072】
さらに、図4のマップの軸の取り方を変更して、下記(31)式または(32)式に示すような第1及び第2のパラメータを用いて特異点を縦軸又は横軸と平行になるように移動させたマップを作成したり、図5のマップの軸の取り方を変更して、下記(33)式または(34)式に示すような第1及び第2のパラメータを用いて特異点を縦軸又は横軸と平行になるように移動させたマップを作成したり、図6及び7のマップの軸の取り方を変更して、下記(35)式または(36)式に示すような第1及び第2のパラメータを用いて特異点を縦軸又は横軸と平行になるように移動させたマップを作成したり、図8及び9のマップの軸の取り方を変更して、下記(37)式または(38)式に示すような第1及び第2のパラメータを用いて特異点を縦軸又は横軸と平行になるように移動させたマップを作成したりしてもよい。
【0073】
【数14】
【0074】
以下、上記のマップを用いた第1の実施の形態について詳細に説明する。図12に示すように、第1の実施の形態の車両運動制御装置には、自車両の走行状態を検出する走行状態検出手段として車両に搭載されたセンサ群、外部環境状態を検出する外部環境検出手段として車両に搭載されたセンサ群、及びこれらのセンサ群からの検出データに基づいて、自車両が運動するように自車両に搭載された車載機器を制御することによって目標位置へ到達するように車両運動を制御する制御装置20、ドライバに車両運動制御状態を報知する表示装置30が設けられている。
【0075】
車両運動制御装置の自車両の走行状態を検出するセンサ群としては、車速を検出する車速センサ10、操舵角を検出する操舵角センサ12、及びスロットル弁の開度を検出するスロットル開度センサ14が設けられている。また、図示しないGPS装置からの情報を加えるようにしてもよい。
【0076】
また、外部環境状態を検出するセンサ群としては、自車両の前方を撮影する前方カメラ16、及び自車両の前方の障害物を検出するレーザレーダ18が設けられている。なお、レーザレーダ18に代えて、又はレーザレーダ18と共にミリ波レーダを設けるようにしてもよい。また、図示しないGPS装置からの情報を加えるようにしてもよい。
【0077】
前方カメラ16は、車両の前方を撮影するように車両のフロントウインドウ上部等に取り付けられている。前方カメラ16は、小型のCCDカメラ又はCMOSカメラで構成され、自車両の前方の道路状況を含む領域を撮影し、撮影により得られた画像データを出力する。出力された画像データは、マイクロコンピュータ等で構成された制御装置20に入力される。なお、カメラとして、前方カメラ16に加えて、前方赤外線カメラを設けるのが好ましい。赤外線カメラを用いることにより、歩行者を障害物として確実に検出することができる。なお、上記の赤外線カメラに代えて近赤外線カメラを用いることができ、この場合においても同様に歩行者を確実に検出することができる。
【0078】
レーザレーダ18は、赤外光パルスを照射する半導体レーザからなる発光素子、赤外光パルスを水平方向に走査する走査装置、及び前方の障害物(歩行者、前方車両等)から反射された赤外光パルスを受光する受光素子を含んで構成され、車両の前方グリル又はバンパに取り付けられている。このレーザレーダ18では、発光素子から発光された時点を基準として受光素子で受光されるまでの反射赤外光パルスの到達時間に基づいて、自車両から前方の障害物までの距離を検出することができる。レーザレーダ18で検出された障害物までの距離を示すデータは制御装置20に入力される。制御装置20は、RAM、ROM、及びCPUを含むマイクロコンピュータ等で構成され、ROMには以下で説明する車両運動制御ルーチンのプログラムが記憶されている。
【0079】
また、制御装置20は、自車両の操舵角、制動力、及び駆動力の少なくとも1つを制御することによって、目標位置へ到達するように車両運動を制御するための車両搭載機器に接続されている。この車両搭載機器としては、車輪の操舵角を制御するための電動パワーステアリング等の操舵角制御装置22、ブレーキ油圧を制御することによって制動力を制御する制動力制御装置24、及び駆動力を制御する駆動力制御装置26が設けられている。制動力制御装置24には、制動力を検出する検出センサ24Aが取り付けられている。また、制御装置20には、演算された制御入力の方向θ等を表示することによって車両運動制御情報をドライバに報知する表示装置30が接続されている。なお、車両運動制御を行なっていることを、ドライバだけでなく車両外部の目標位置方向に向かって報知するようにしてもよい。
【0080】
操舵角制御装置22としては、ドライバのステアリングホイール操作に重畳して前輪及び後輪の少なくとも一方の車輪の操舵角を制御する制御手段、ドライバ操作とは機械的に分離され、ステアリングホイールの操作とは独立して前輪及び後輪の少なくとも一方の車輪の操舵角を制御する制御手段(いわゆるステア・バイ・ワイヤ)等を用いることができる。
【0081】
制動力制御装置24としては、ドライバ操作とは独立して各車輪の制動力を個別に制御する、いわゆるESC(Electronic Stability Control)に用いられる制御装置、ドライバ操作とは機械的に分離され、各車輪の制動力を信号線を介して任意に制御する制御装置(いわゆるブレーキ・バイ・ワイヤ)等を用いることができる。
【0082】
駆動力制御装置26としては、スロットル開度、点火進角の遅角、又は燃料噴射量を制御することによって駆動力を制御する制御装置、変速機の変速位置を制御することによって駆動力を制御する制御装置、トルクトランスファを制御することによって前後方向及び左右方向の少なくとも一方の駆動力を制御する制御装置等を用いることができる。
【0083】
また、制御装置20には、制御入力を求めるためのマップを記憶したマップ記憶装置28が接続されている。第1の実施の形態のマップとしては、図3に示すマップを用いる場合について説明する。なお、他の例として示した図4、図5、図6及び7、図8及び9、図10、または図11のいずれかのマップをマップ記憶装置28に記憶しておき、そのマップを使用してもよい。その場合、マップ記憶装置28に記憶されたマップに応じた第1のパラメータ及び第2のパラメータを演算して用いるようにする。
【0084】
また、制御装置20には、ドライバに警報を発する図示しない警報装置が接続されている。警報装置としては、音や音声によって警報を発する装置、光や視覚的な表示によって警報を発する装置、振動によって警報を発する装置、又は操舵反力のような物理量をドライバに与えてドライバの操作を誘導する物理量付与装置を用いることができる。また、表示装置30を警報装置として用いるようにしてもよい。
【0085】
以下、図13を参照して第1の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。
【0086】
ステップ100で、車速センサ10等で検出された自車両の走行状態、及びレーザレーダ18等で検出された外部環境状態に関する検出データを取り込む。次に、ステップ102で、取り込んだ検出データに基づいて、車両が走行している道路上の障害物の位置及び大きさを含む環境マップを作成する。
【0087】
次に、ステップ104で、環境マップを用いて障害物を回避して走行するための所望位置及び所望位置における速度方向を設定する。ここでは、所望位置を障害物の横を通過する位置とし、所望位置における速度方向を車体前後方向とする。なお、本実施の形態では、所望位置での車体横方向の距離を最大化した位置が、車両運動制御のための最終的な目標位置となる。
【0088】
次に、ステップ106で、設定された速度方向をx軸、x軸に直交する方向をy軸、及び車両の現在位置を原点とするxy座標を設定する。すなわち、所望位置における車体前後方向がx軸方向となり、所望位置における速度方向のy成分は0となる。
【0089】
次に、ステップ108で、上記ステップ100で走行状態として取り込まれた自車両の速度、及び外部環境状態として取り込まれた自車両と障害物との距離を設定された座標に対応させて変換し、縦移動距離Xe、速度のx成分vx0、y成分vy0を演算する。
【0090】
次に、ステップ110で、外部環境及び自車両の構造と状態に基づいて、限界合成力の大きさFmax、及び楕円で制限される車体合成力の最大値のx成分F1とy成分F2を設定する。このとき、車体合成力の最大値のμ利用率γ1及びγ2も自ずと定まる。この車体合成力の最大値は、x軸を長軸または短軸とする楕円で制限されている。なお、F2は、F2=γ2Fmaxであり、これより(12)式の第2式の関係が導かれる。従って、本ステップにおいて、F1及びF2を設定する代わりに、F1及びγ0を設定するようにしてもよい。
【0091】
次に、ステップ112で、(20)式に従って、第1のパラメータvx0’、及び第2のパラメータvy0’を演算する。次に、ステップ114で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、上記ステップ110で設定された車体合成力の最大値、並びに上記ステップ112で演算された第1のパラメータvx0’及び第2のパラメータvy0’を入力として、縦移動距離Xeに対する横移動距離が最大となる軌道、及び車体合成力の時系列データを導出する。
【0092】
具体的には、第1のマップ、第1のパラメータvx0’、及び第2のパラメータvy0’に基づいてμ1’を得て、第2のマップ、第1のパラメータvx0’、及び第2のパラメータvy0’に基づいてμ2’を得て、第3のマップ、第1のパラメータvx0’、及び第2のパラメータvy0’に基づいてte’を得る。そして、{μ1’,μ2’,te’}を(18)式及び(19)式に従って{μ1,μ2,te}に変換し、(11)式及び(12)式に従って入力の時間関数を、(15)式に従って最大となる横移動距離Yeを演算する。そして、(1)式〜(6)式に従って、縦移動距離Xeに対する横移動距離が最大となる横移動距離最大軌道が導出される。
【0093】
次に、ステップ116で、上記ステップ114で導出された車体合成力の時系列データに従って、横移動距離最大化回避軌道に沿った走行を実現するために必要な各車輪のタイヤ発生力を演算し、各車輪のタイヤ発生力が得られるように操舵角制御装置22、制動力制御装置24、及び駆動力制御装置26の少なくとも1つを制御すると共に、車両運動制御情報を表示装置30に表示する。また、障害物を回避するように制御する際には無条件で警報装置から警報を発したり、障害物を回避するための車両運動制御を行っていることを表示装置に表示したりすることにより警報を行ってもよい。各車輪のタイヤ発生力が得られるように制御することにより、目的とする車体発生力が得られるように制御することができる。
【0094】
以上説明したように第1の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分及びy成分を設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成のマップを用いて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力の時系列データを導出することができる。
【0095】
なお、第1の実施の形態では、F1及びγ0を用いて車体合成力の向きを求める場合について説明したが、F2及びγ0を用いて求めてもよい。なぜなら、F1=F2/γ0及びF1’=F2’/γ0’の関係を、(20)式などの軸の取り方や(19)式などのパラメータaに代入すれば、本実施の形態内で示したマップをそのまま適用することができるためである。
【0096】
また、図1で示したように、車両進行方向に対して左方向に障害物を回避する場合において、横移動距離が最大となるように回避する手法について説明したが、右方向に回避する場合にも適用可能である。自車両の速度のy成分をvy0→−vy0に変換して、マップより{−μ1’,−μ2’,te’}を求め、−μ1’→ μ1’、−μ2’→ μ2’の処理を行うことで、右方向に対応した{μ1,μ2,te}を得ることができる。
【0097】
また、第1の実施の形態では、自車両の路面に対する速度を用いた場合について説明したが、自車両の所望位置に対する相対速度を用いてもよい。このとき、(9)式の終端条件も相対速度になるため、終端速度のy成分は相対速度に関して0となる。
【0098】
また、第1の実施の形態では、導出された車体合成力に基づいて、障害物を回避するための回避制御を行う場合について説明したが、上記ステップ102障害物の位置及び大きさを含む環境マップに基づいて回避すべき横移動距離Yaが与えられたときに、導出された最大化された横移動距離Yeと比較し、Ye<Yaの場合には、急制動制御により障害物の手前で車両が停止するように制動力制御装置24を制御するか、推定される衝突被害が最小化されるように操舵角制御装置22及び制動力制御装置24を制御するようにしてもよい。このような制御は、例えば、WO2006−070865記載の技術のような公知の技術を用いることができる。
【0099】
次に、第2の実施の形態について説明する。第1の実施の形態では、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第2の実施の形態では、第1の実施の形態とは異なるマップを用いて、縦移動距離Xeに対する横移動距離を最大にする現在時刻の車体合成力の大きさ及び方向を導出する場合について説明する。なお、第2の実施の形態の車両運動制御装置について、第1の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0100】
ここで、第2の実施の形態で用いられるマップについて説明する。
【0101】
まず、第1の実施の形態と同様に、(20)式まで展開する。そして、一例として、γ0’=F1’/m’=Xe’=1とした場合のvx0’及びvy0’に関するマップを作成する。図14に示すように、vx0’を第1のパラメータ、 及びvy0’を第2のパラメータとして、上記(13)式、(14)式、及び(16)式に基づいて得られる車体合成加速度の方向θ’の値をマッピングしたマップを作成する。
【0102】
そして、このマップを用いて{θ’}を求めるには、γ0’=F1’/m’=Xe’=1、既知のm、vx0、vy0、Xe、車体合成力の最大値のx成分F1、及びy成分F2から(20)式に従って第1のパラメータvx0’及び第2のパラメータvy0’を演算し、演算されたパラメータに対する出力{θ’}をマップから得て、下記(39)式により、縦移動距離Xeに対して横移動距離を最大にする現在時刻の車体合成力の大きさ及び向きが得られる。
【0103】
【数15】
【0104】
ただし、vy0<0 の場合は、vy0→−vy0、Ye→−Yeに変換して、マップより{−θ’}を求め、−θ’→θ’の処理を行ってθを得ればよい。
【0105】
また、θ’のマップと併せて、図14の破線内のマップのように、γ0’=F1’/m’=Xe’=1とした場合のYe’を求めるマップを作成しておいてもよい。このマップから得られるYe’を、下記(40)式により変換して縦移動距離Yeを求めてもよい。
【0106】
【数16】
【0107】
なお、上記のマップでは、第1のパラメータ及び第2のパラメータを(20)式のように定めた場合について説明したが、第1の実施の形態と同様に、(22)式に示すvy0’を第1のパラメータ及びXe’を第2のパラメータとし、γ0’=F1’/m’=vx0’=1とした場合のマップを作成してもよい(図15)。この場合において、上記と同様にYe’を求めるマップも用いる場合には、下記(41)式によりマップから求めたYe’をYeに変換することができる。
【0108】
また同様に、(22)式に示すvy0’を第1のパラメータ及び(23)式に示すF1’/m’を第2のパラメータとし、γ0’=vx0’=Xe’=1とした場合のマップを作成してもよい(図16)。この場合において、上記と同様にYe’を求めるマップも用いる場合には、(40)式によりマップから求めたYe’をYeに変換することができる。
【0109】
また同様に、(26)式に示すvx0’を第1のパラメータ及びXe’を第2のパラメータとし、γ0’=F1’/m’=1、vy0’=±1とした場合のマップを作成してもよい(図17、18)。この場合において、上記と同様にYe’を求めるマップも用いる場合には、(42)式によりマップから求めたYe’をYeに変換することができる。
【0110】
また同様に、(26)式に示すvx0’を第1のパラメータ、及び(27)式に示すF1’/m’を第2のパラメータとし、γ0’=Xe’=1、vy0’=±1とした場合のマップを作成してもよい(図19、20)。この場合において、上記と同様にYe’を求めるマップも用いる場合には、(40)式によりマップから求めたYe’をYeに変換することができる。
【0111】
【数17】
【0112】
また、第1の実施の形態でマップの軸の取り方を変更した手法と同様の手法により、特異点のラインが縦軸又は横軸と平行になるようにマップの軸の取り方を変更したマップを作成してもよい。例えば、図14に示すマップの軸の取り方を(29)式のように変更した場合のマップを図21に、(30)式のように変更した場合のマップを図23に示す。
【0113】
以下、図23を参照して第2の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。ここでは、図14に示すマップを用いる場合について説明する。
【0114】
ステップ100〜ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を得る。
【0115】
次に、ステップ200で、マップ記憶装置28に記憶されたマップを読み出し、上記ステップ110で設定された車体合成力の最大値、並びに上記ステップ112で演算された第1のパラメータvx0’及び第2のパラメータvy0’を入力として、縦移動距離Xeに対して横移動距離が最大になるための現在時刻の車体合成力を導出する。
【0116】
具体的には、θ’のマップ、第1のパラメータvx0’、及び第2のパラメータvy0’に基づいて車体合成加速度の向きθ’を得て、(39)式により縦移動距離Xeに対して横移動距離が最大となる現在時刻の車体合成力が導出される。
【0117】
以上説明したように第2の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分及びy成分を設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成のマップを用いて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる現在時刻の車体合成力を導出することができる。また、車体合成力の時系列データを導出する場合と比べ、用いるマップが少ないため、マップを記憶するための容量を削減できる。
【0118】
次に、第3の実施の形態について説明する。第1の実施の形態では、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第3の実施の形態では、障害物を回避するための縦移動距離が最短となる車体合成力を求めるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明する。なお、第3の実施の形態の車両運動制御装置について、第1または第2の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0119】
第3の実施の形態では、図1のような場面において、回避すべき横移動距離Yeが与えられ、また評価関数Iを下記(43)式で表した場合、下記(44)式で表される終端条件、及び(10)式で表される楕円で制限される車体合成力の大きさに関する入力制約条件の下で、評価関数Iを最小化する制御入力を求めよという制御問題に帰着される。
【0120】
【数18】
【0121】
ここで、特開2007−283910号公報等の公知の技術を用いると、下記(45)式のような制御入力が導出される。
【0122】
【数19】
ここで、下記(46)式のように変数変換する。
【0123】
【数20】
【0124】
すると、(45)式において必要となるte、ν1、ν2は、下記(47)式〜(49)式の非線形方程式にm、vx0、vy0、F1、γ0、及びYeを代入してμ1、μ2、teを解くことにより得られる。また、設定された横移動距離Yeに対して縦移動距離が最短となるときの最短距離Xsは、(50)式の関係を満たす。
【0125】
【数21】
【0126】
この方程式の解を求めるために、低次元化したマップを導出する。まず、(47)式〜(49)式に着眼して、任意の正数aを導入して下記(51)式の関係を満足する2組のパラメータP及びP’を考えると、P及びP’に対応する解 {μ1、μ2、te}及び{μ1’、μ2’、te’}は、(18)式の関係を満たす。
【0127】
【数22】
【0128】
(51)式の最後の式より、aを下記(52)式のようにおくと、(51)式よりvx0’ 及びvy0’は下記(53)式のように変形できる。
【0129】
【数23】
【0130】
この関係より、γ0’、F1’/m’及びYe’に任意の正数を設定することにより、現在時刻のパラメータPによってvx0’及びvy0’が求まる。よって、γ0’、F1’/m’及びYe’をある値に設定した場合において、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとしたマップを予め用意しておけばよい。なお、このγ0’、F1’/m’及びYe’の値は、マップ作成時に設計者が自由に設定できる。
【0131】
ここでは、一例として、γ0’=F1’/m’=Ye’=1とした場合のvx0’及びvy0’に関するマップを作成する。図24に示すように、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとして、(47)式〜(49)式に基づいて得られるμ1’の値をマッピングした第1のマップ、μ2’の値をマッピングした第2のマップ、及びte’の値をマッピングした第3のマップを作成する。
【0132】
そして、これらのマップを用いて{μ1,μ2,te}を求めるには、γ0’=F1’/m’=Ye’=1、既知のm、vx0、vy0、Ye、限界合成力の大きさFmaxとμ利用率γ1とで定まる車体合成力の最大値のx成分F1、及びμ利用率γ1とγ2とで定まるγ0から(53)式に従って第1のパラメータvx0’及び第2のパラメータvy0’を演算し、演算されたパラメータに対する出力{μ1’,μ2’,te’}を各マップから得て、(18)式及び(52)式に従って{μ1’,μ2’,te’}を{μ1,μ2,te}に変換し、(45)式及び(46)式に従って入力の時間関数を、(50)式に従って最短の縦移動距離Xsを演算する。
【0133】
ただし、Ye<0の場合は、vy0→−vy0、Ye→−Yeに変換して、マップより{−μ1’,−μ2’,te’}を求め、−μ1’→ μ1’、−μ2’→ μ2’の処理を行って{μ1,μ2,te}を得ればよい。
【0134】
この結果、(1)式〜(6)式の積分計算により、横移動距離Ye、及び車両の速度から、横移動距離Yeに対して縦移動距離が最短となる最短回避軌道が導出される。
【0135】
次に、図25を参照して第3の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。ここでは、図24に示すマップを用いる場合について説明する。
【0136】
ステップ100〜ステップ110を経て、ステップ300で、横移動距離Yeに任意の値を設定する。例えば、上記ステップ102で作成した環境マップを用いて、障害物の横を通過する位置のy成分を横移動距離Yeとしたり、そのy成分に予め定めた距離を加算した距離を横移動距離Yeとしたりすることができる。
【0137】
次に、ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を演算する。
【0138】
次に、ステップ302で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、第1のパラメータvx0’、及び第2のパラメータvy0’を入力として、上記ステップ300で設定した横移動距離Yeに対して縦移動距離が最短となる最短縦移動距離Xsを導出する。
【0139】
次に、ステップ304で、上記ステップ302で導出された横移動距離Yeに対する最短縦移動距離Xsと上記ステップ108で演算された縦移動距離Xeとが等しくなったか否かを判定する。Xs=Xeの場合には、ステップ308へ移行し、Xs≠Xeの場合には、ステップ306へ移行する。なお、ここでは、Xs=Xeか否かを判定する場合について説明するが、XsとXeとが等しい場合だけでなく、XsとXeとの差が所定値(例えば、Xeの5%等)以下の場合も肯定判定されるようにしてもよい。
【0140】
ステップ306では、Yeの値をXsがXeに近づくように修正する。そして、ステップ304でXs=Xeと判定されるまで、ステップ302〜ステップ306の処理を繰り返す。
【0141】
ステップ308では、Xs=Xeと判定されたときのYeの値を用いて上記ステップ302で得られた{μ1,μ2,te}の値を(45)式及び(46)式に適用して、制御入力である車体合成加速度を得る。また、(1)式〜(6)式に従って、縦移動距離Xeに対する横移動距離Yeが最大となる車体合成力の時系列データ及び横移動距離最大化回避軌道が導出される。
【0142】
以上説明したように第3の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の横移動距離に対する縦移動距離を最短にするマップを用いて、横移動距離Yeの設定を修正しながら繰り返し縦移動距離を求めて、求めた縦移動距離と障害物までの距離のx成分との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力の時系列データを導出することができる。
【0143】
次に、第4の実施の形態について説明する。第3の実施の形態では、障害物を回避するための縦移動距離が最短となる車体合成力を求めるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第4の実施の形態では、第3の実施の形態とは異なる縦移動距離が最短となる車体合成力を求めるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする現在時刻の車体合成力を導出する場合について説明する。なお、第4の実施の形態の車両運動制御装置について、第1〜第3の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0144】
ここで、第4の実施の形態で用いられるマップについて説明する。
【0145】
まず、第3の実施の形態と同様に、(53)式まで展開する。そして、一例として、γ0’=F1’/m’=Ye’=1とした場合のvx0’及びvy0’に関するマップを作成する。図26に示すように、vx0’を第1のパラメータ、 及びvy0’を第2のパラメータとして、上記(47)式〜(49)式に基づいて得られる車体合成加速度の方向θ’及び最短縦移動距離Xs’の値をマッピングしたマップを作成する。
【0146】
そして、このマップを用いて{θ’,Xs’}を求めるには、γ0’=F1’/m’=Ye’=1、既知のm、vx0、vy0、Ye、車体合成力の最大値のx成分F1、及びy成分F2から(53)式に従って第1のパラメータvx0’及び第2のパラメータvy0’を演算し、演算されたパラメータに対する出力{θ’,Xs’}をマップから得て、(39)式により、横移動距離Yeに対して縦移動距離を最短にする現在時刻の車体合成力の大きさ及び向きが得られ、また下記(54)式によりXsが得られる。
【0147】
ただし、Ye<0の場合は、vy0→−vy0、Ye→−Yeに変換して、マップより{−θ’}を求め、−θ’→θ’の処理を行ってθを得ればよい。
【0148】
【数24】
【0149】
次に、第4の実施形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。第4の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンは、第3の実施の形態における車両運動制御ルーチン(図25)のステップ302で用いるマップ(例えば、図26のマップ)が異なる点、及びステップ308で(39)式に従って現在時刻の車体合成力大きさ及び向きを導出する点が異なり、他の処理は第3の実施の形態における車両運動制御ルーチンと同様である。
【0150】
以上説明したように第4の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の横移動距離に対する縦移動距離を最短にするマップを用いて、横移動距離Yeの設定を修正しながら繰り返し縦移動距離を求めて、求めた縦移動距離と障害物までの距離のx成分との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる現在時刻の車体合成力を導出することができる。また、車体合成力の時系列データを導出する場合と比べ、用いるマップが少ないため、マップを記憶するための容量を削減できる。
【0151】
次に、第5の実施の形態について説明する。第5の実施の形態では、回避すべき横移動距離を設定した場合において、第1または第2の実施の形態で説明したマップを用いて、縦移動距離の設定を修正しながら収束演算を行い、マップから求めた横移動距離と設定された横移動距離との差が所定値以下となったときに設定された縦移動距離に基づいて、回避すべき横移動距離に対する縦移動距離を最短にする最短回避軌道及び車体合成力を導出する場合について説明する。なお、第5の実施の形態の車両運動制御装置について、第1〜第4の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0152】
図27を参照して第5の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1〜第4の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。また、本実施の形態では、第1及び第2の実施の形態で示したマップを用いることができるが、ここでは、図3に示すマップを用いる場合について説明する。
【0153】
ステップ100〜ステップ106を経て、ステップ400で、上記ステップ100で走行状態として取り込まれた自車両の速度、及び外部環境状態として取り込まれた自車両と障害物との距離を設定された座標に対応させて変換し、横移動距離Ye、速度のx成分vx0、y成分vy0を演算する。
【0154】
次に、ステップ110で、楕円で制限された車体合成力の最大値を設定し、次に、ステップ402で、縦移動距離Xeに任意の値を設定する。例えば、上記ステップ102で作成した環境マップを用いて、自車両と障害物との距離のx成分の値を設定することができる。
【0155】
次に、ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を演算する。
【0156】
次に、ステップ404で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、第1のパラメータvx0’、及び第2のパラメータvy0’を入力として、上記ステップ402で設定した縦移動距離Xeに対して横移動距離が最大となる横移動距離yeを導出する。
【0157】
次に、ステップ406で、上記ステップ404で導出された横移動距離yeと上記ステップ400で演算された横移動距離Yeとが等しくなったか否かを判定する。ye=Yeの場合には、ステップ410へ移行し、ye≠Yeの場合には、ステップ408へ移行する。なお、ここでは、ye=Yeか否かを判定する場合について説明するが、yeとYeとが等しい場合だけでなく、yeとYeとの差が所定値(例えば、Yeの5%等)以下の場合も肯定判定されるようにしてもよい。
【0158】
ステップ408では、Xeの値をyeがYeに近づくように修正する。そして、ステップ406でye=Yeと判定されるまで、ステップ404〜ステップ408の処理を繰り返す。
【0159】
ステップ410では、ye=Yeと判定されたときのXeの値を用いて上記ステップ404で得られた{μ1,μ2,te}の値を(11)式及び(12)式に適用して、制御入力である車体合成加速度を得る。また、(1)式〜(6)式に従って、横移動距離に対する縦移動距離が最短となる車体合成力の時系列データ及び最短回避軌道が導出される。
【0160】
次に、第6の実施の形態について説明する。第6の実施の形態では、自車両の目標位置を設定した場合において、第1または第2の実施の形態で説明したマップを用いて、車体合成力の最大値の設定を修正しながら収束演算を行い、マップから求めた横移動距離と目標位置に基づいた横移動距離との差が所定値以下となったときに設定された車体合成力の最大値に基づいて、目標位置と速度方向に対して車体合成力の最大値を最小化する最適軌道及び車体合成力の時系列データを導出する場合について説明する。
【0161】
第6の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて、図27に示す第5の実施の形態の車両運動制御ルーチンと異なる点について説明する。
【0162】
ステップ400では、縦移動距離Xeも演算する。ステップ402の処理は行わず、ステップ404で、上記ステップ400で演算されたXeに対して横移動距離が最大となる横移動距離yeを導出する。ステップ408では、上記ステップ110で設定した車体合成力の最大値の値をyeがYeに近づくように修正する。
【0163】
次に、第7の実施の形態について説明する。第7の実施の形態では、目標位置及び車体合成力の最大値のx成分F1またはy成分F2の一方を設定した場合において、第1または第2の実施の形態で説明したマップを用いて、F1またはF2の他方の設定を修正しながら収束演算を行い、マップから求めた横移動距離と目標位置に基づいた横移動距離との差が所定値以下となったときに設定されたF1またはF2の一方に基づいて、F1またはF2の他方を最小化する最適軌道及び車体合成力の時系列データを導出する場合について説明する。
【0164】
第7の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて、図27に示す第5の実施の形態の車両運動制御ルーチンと異なる点について説明する。
【0165】
ステップ400では、自車両と障害物との距離のx成分Xeも演算する。ステップ110では、F1またはF2の一方を設定する。ステップ402の処理は行わず、ステップ404で、上記ステップ400で演算されたXeに対して横移動距離が最大となる横移動距離yeを導出する。ステップ408では、上記ステップ110で設定したF1またはF2の一方を一定値としてF1とF2との比γ0をyeがYeに近づくように修正する。
【0166】
次に、第8の実施の形態について説明する。第1の実施の形態では、縦移動距離Xeに対して横移動距離が最大になる車体合成力を導出するためのマップを用いて、また第3の実施の形態では、縦移動距離を最短にする車体合成力を導出するためのマップを用いて、車体合成力の時系列データを導出する場合について説明したが、第8の実施の形態では、第1及び第3の実施の形態のマップとは異なり、車体合成力の最大値を最小化するマップを用いて、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対して横移動距離が最大になる車体合成力を導出する場合について説明する。なお、第8の実施の形態の車両運動制御装置について、第1〜第7の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0167】
ここで、第8の実施の形態で用いられるマップについて説明する。
【0168】
車体合成力の最大値を最小化する最適制御は、車体合成力の最大値のx成分F1及びy成分F2が既知であると仮定して、第3の実施の形態と同様に、(7)式、(43)式、(44)式、及び(10)式で定式化でき、その制御入力は(45)式として導出される。ここでは、縦移動距離Xe、横移動距離Ye、及び車体合成力の最大値の縦横比γ0を設定して、最小化されたIが既知の距離のx成分Xeと等しくなるようなF1を求めれば、結果的に車体合成力の最大値が最小となる最適軌道が導出されることを示している。よって、x1(te)=Xeの関係を導入することにより、Xs→Xeに変換された非線型方程式(46)式〜(50)式から(45)式で必要となるμ1、μ2、teが求まる。ここでは、限界合成力の大きさFmax、縦移動距離Xe、横移動距離Ye、及び車体合成力の最大値の縦横比γ0(γ2/γ1)が既知であるとして、(47)式〜(50)式を満足するF1、μ1、μ2、teを求めることで、γ1及びγ2が得られる。これは、最小化されたIとXeとが等しくなるようなγ1Fmax及びγ2Fmaxが求められることを意味し、結果的に、予め与えられた車体合成力の最大値の縦横比γ0に対して、車体合成力の最大値が最小化される最適軌道が得られる。従って、Xs→Xeに変換された(47)式〜(50)式に対して、m、vx0、vy0、Xe、Ye、及びγ0を代入して、F1、μ1、μ2、teを求めることを考える。
【0169】
まず、(47)式を下記(55)式のように変形する。
【0170】
【数25】
【0171】
(55)式を(48)式〜(50)式へ代入して、下記(56)式〜(58)式を得る。
【0172】
【数26】
【0173】
ここで、任意の正数aを導入して下記(59)式の関係を満足する2組のパラメータP及びP’を考えると、P及びP’に対応する解 {μ1、μ2、te}及び{μ1’、μ2’、te’}は、(18)式の関係を満たす。
【0174】
【数27】
【0175】
(59)式の最後の式より、aを下記(60)式のようにおくと、(59)式よりvy0’及びYe’は下記(61)式のように変形できる。
【0176】
【数28】
【0177】
この関係より、γ0’、vx0’及びXe’に任意の正数を設定することにより、現在時刻のパラメータPによってvy0’及びYe’が求まる。よって、γ0’、vx0’及びXe’をある正数に設定した場合において、vy0’を第1のパラメータ、及びYe’を第2のパラメータとしたマップを予め用意しておけばよい。なお、このγ0’、vx0’及びXe’の値はマップ作成時に設計者が自由に設定できる。
【0178】
マップの作成は、第1の実施の形態と同様の手法で、図28に示すように、例えば、γ0’=vx0’=Xe’=1とした場合のvx0’及びvy0’に関するマップを作成する。
【0179】
そして、これらのマップから{μ1’,μ2’,te’}を得て、(18)式及び(60)式により{μ1,μ2,te}に変換して、(45)式及び(46)式に代入して、入力の時間関数が得られる。また、(55)式に代入して得られるF1と、既知のFmax及びγ0を用いて、車体合成力の最大値が最小となるγ1及びγ2が得られる。
【0180】
次に、図29を参照して第8の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1〜第7の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。ここでは、図28に示すマップを用いる場合について説明する。
【0181】
ステップ100〜ステップ108を経て、ステップ110で、車体合成力の最大値のx成分F1及びy成分F2を設定する。これにより、同時に車体合成力の最大値の縦横比γ0が定まる。
【0182】
次に、ステップ300で、横移動距離Yeに任意の距離に設定し、次に、ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を演算する。
【0183】
次に、ステップ500で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、第1のパラメータvx0’、及び第2のパラメータvy0’を入力として、上記ステップ108で演算したXe及び上記ステップ300で設定したYeで定まる目標位置及び上記ステップ110で定まるγ0に対して、車体合成力の最大値のx成分f1を導出する。
【0184】
次に、ステップ502で、上記ステップ500で導出された車体合成力f1と上記ステップ110で設定した車体合成力の最大値のx成分F1とが等しくなったか否かを判定する。f1=F1の場合には、ステップ504へ移行し、f1≠F1の場合には、ステップ306へ移行する。なお、ここでは、f1=F1か否かを判定する場合について説明するが、f1とF1とが等しい場合だけでなく、f1とF1との差が所定値(例えば、F1の5%等)以下の場合も肯定判定されるようにしてもよい。
【0185】
ステップ306では、上記ステップ300で設定した横移動距離Yeをf1がF1に近づくように修正する。そして、ステップ504でf1=F1と判定されるまで、ステップ500、502及び306の処理を繰り返す。
【0186】
ステップ504では、f1=F1と判定されたときのYeの値を用いて上記ステップ500で得られた{μ1,μ2,te}の値を(45)式及び(46)式に適用して、制御入力である車体合成加速度を得る。また、(1)式〜(6)式に従って、縦移動距離に対する横移動距離が最大となる車体合成力の時系列データ及び横移動距離最大化回避軌道が導出される。
【0187】
以上説明したように第8の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の車体合成力の最大値を最小化するマップを用いて、横移動距離Yeの設定を修正しながら繰り返し車体合成力の最大値のx成分f1を求めて、求めたf1と設定された車体合成力の最大値のx成分F1との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力の時系列データを導出することができる。
【0188】
なお、(46)式の第1式の代わりにF1=F2/γ0を(47)〜(50)式に代入して、Xs→Xeに変化した非線型方程式を用いて同様の流れで式展開を行い、{μ1’,μ2’,te’}に関するマップを作成してもよい。この場合、繰り返し求められる車体合成力の最大値のy成分f2と設定された車体合成力のy成分F2との差が所定値以下となるような収束演算を導入する。
【0189】
次に、第9の実施の形態について説明する。第8の実施の形態では、最大値が最小となる車体合成力を求めるためのマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第9の実施の形態では、第8の実施の形態とは異なるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする現在時刻の車体合成力を導出する場合について説明する。なお、第9の実施の形態の車両運動制御装置について、第1〜第8の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0190】
ここで、第9の実施の形態で用いられるマップについて説明する。
【0191】
まず、第8の実施の形態と同様に、(61)式まで展開する。そして、一例として、vx0’=Xe’=1 とした場合のvy0’及びYe’に関するマップを作成する。図30に示すように、vy0’を第1のパラメータ、 及びYe’を第2のパラメータとして、上記(55)式〜(58)式、(45)式、及び(46)式に基づいて得られる車体合成力の方向θ’の値をマッピングした第1のマップ、及びF1’/m’の値をマッピングした第2のマップを作成する。
【0192】
そして、これらのマップを用いて{θ,F1/m}を求めるには、vx0’=Xe’=1、既知のγ0、m、vx0、vy0、Xe、及びYeから(61)式に従って第1のパラメータvy0’及び第2のパラメータYe’を演算し、演算されたパラメータに対する出力{θ’,F1’/m’}を各マップから得て、(55)式、(18)式、及び(60)式の関係から得られる下記(62)式に従ってF1を演算する。そして、(39)式を適用すれば、現在時刻の車体合成加速度が得られる。
【0193】
【数29】
【0194】
この結果、縦移動距離Xe、横移動距離Ye、及び自車両の速度から、目標位置及び目標位置における速度方向に到達するために最大値が最小となる現在時刻での車体合成力が導出される。
【0195】
次に、第9の実施形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。第9の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンは、第8の実施の形態における車両運動制御ルーチン(図29)のステップ500で用いるマップ(例えば、図30のマップ)が異なる点、及びステップ504で(39)式に従って現在時刻の車体合成力大きさ及び向きを導出する点が異なり、他の処理は第9の実施の形態における車両運動制御ルーチンと同様である。
【0196】
以上説明したように第9の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の車体合成力の最大値を最小化するマップを用いて、横移動距離Yeの設定を修正しながら繰り返し車体合成力の最大値のx成分f1を求めて、求めたf1と設定された車体合成力の最大値のx成分F1との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる現在時刻の車体合成力の大きさ及び向きを導出することができる。また、車体合成力の時系列データを導出する場合と比べ、用いるマップが少ないため、マップを記憶するための容量を削減できる。
【0197】
なお、(46)式の第1式の代わりにF1=F2/γ0を(47)〜(50)式に代入して、Xs→Xeに変換した非線型方程式を用いて同様の流れで式展開を行い、{θ’,F1’/m’}に関するマップを作成してもよい。
【0198】
次に、第10の実施の形態について説明する。第1の実施の形態では、縦移動距離Xeに対して横移動距離が最大になる車体合成力を導出するためのマップを用いて、また第3の実施の形態では、縦移動距離を最短にする車体合成力を導出するためのマップを用いて、さらに第8の実施の形態では、最大値を最小にする車体合成力を導出するためのマップを用いて、車体合成力の時系列データを導出する場合について説明したが、第10の実施の形態では、車体合成力の最大値のx成分またはy成分の一方を与えた場合に、他方を最小化するマップを用いて、縦移動距離Xeに対して横移動距離が最大になる車体合成力を導出する場合について説明する。なお、第10の実施の形態の車両運動制御装置について、第1〜第9の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0199】
ここで、第10の実施の形態で用いられるマップについて説明する。ここでは、車体合成力の最大値のx成分を与え、y成分を最小化する場合を考える。
【0200】
車体合成力の最大値のy成分を最小化する最適制御は、第3の実施の形態と同様に、(7)式、(43)式、(44)式、及び(10)式で定式化でき、その制御入力は(45)式として導出される。ここでは、限界合成力の大きさFmax、縦移動距離Xe、横移動距離Ye、及び車体合成力の最大値のx成分F1が既知であるとして、(47)式〜(50)式を満足するγ0、μ1、μ2、teを求めることでγ2が得られる。
【0201】
まず、(48)式を下記(63)式のように変形する。
【0202】
【数30】
【0203】
(63)式を(47)式、(49)式及び(50)式へ代入して、下記(64)式〜(66)式を得る。
【0204】
【数31】
【0205】
ここで、任意の正数aを導入して下記(67)式の関係を満足する2組のパラメータP及びP’を考えると、P及びP’に対応する解 {μ1、μ2、te}及び{μ1’、μ2’、te’}は、(18)式の関係を満たす。
【0206】
【数32】
【0207】
(67)式の最後の式より、aを下記(68)式のようにおくと、(67)式よりvx0’及びvy0’は下記(69)式のように変形できる。
【0208】
【数33】
【0209】
この関係より、F1’/m’、Xe’及びYe’に任意の正数を設定することにより、現在時刻のパラメータPによってvx0’及びvy0’が求まる。よって、F1’/m’、Xe’及びYe’をある値に設定した場合において、vx0’を第1のパラメータ、及びvy0’を第2のパラメータとしたマップを予め用意しておけばよい。なお、このF1’/m’、Xe’及びYe’の値はマップ作成時に設計者が自由に設定できる。
【0210】
マップの作成は、第1の実施の形態と同様の手法で、図31に示すように、例えば、F1’/m’=Xe’=Ye’=1とした場合のvx0’及びvy0’に関するマップを作成する。
【0211】
そして、これらのマップから{μ1’,μ2’,te’}を得て、(18)式及び(68)式により{μ1,μ2,te}に変換して、(63)式よりγ0を求める。そして、(45)式及び(46)式に代入して、入力の時間関数が得られる。
【0212】
次に、図32を参照して第10の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。なお、第1〜第9の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンと同一の処理については、同一の符号を付して説明を省略する。ここでは、図31に示すマップを用いる場合について説明する。
【0213】
ステップ100〜ステップ108を経て、次に、ステップ110で、車体合成力の最大値のx成分F1及びy成分F2を設定する。これにより、同時に車体合成力の最大値の縦横比γ0が定まる。
【0214】
次に、ステップ112で、第1の実施の形態の場合と同様に処理して第1のパラメータvx0’、及び第2のパラメータvy0’を演算し、次に、ステップ604で、マップ記憶装置28に記憶された第1〜第3のマップを読み出し、第1のパラメータvx0’、及び第2のパラメータvy0’を入力として、目標位置として上記ステップ108で演算したXe及び上記ステップ300で設定したYeで定まる位置を設定した場合における車体合成力の最大値のy成分を最小化する車体合成力の縦横比γfを導出する。
【0215】
次に、ステップ606で、上記ステップ604で導出した縦横比γfと上記ステップ600で設定した車体合成力の最大値の縦横比γ0とが等しくなったか否かを判定する。γf=γ0の場合には、ステップ504へ移行し、γf≠γ0の場合には、ステップ306へ移行する。なお、ここでは、γf=γ0か否かを判定する場合について説明するが、γfとγ0とが等しい場合だけでなく、γfとγ0との差が所定値(例えば、γ0の5%等)以下の場合も肯定判定されるようにしてもよい。
【0216】
ステップ306では、上記ステップ300で設定した横移動距離Yeをγfがγ0に近づくように修正する。そして、ステップ606でγf=γ0と判定されるまで、ステップ604、606及び306の処理を繰り返す。
【0217】
ステップ504では、γf=γ0と判定されたときのYeの値を用いて上記ステップ604で得られた{μ1,μ2,te}の値を(45)式及び(46)式に適用して、制御入力である車体合成加速度を得る。また、(1)式〜(6)式に従って、縦移動距離に対する横移動距離が最大となる車体合成力の時系列データ及び横移動距離最大化回避軌道が導出される。
【0218】
以上説明したように第10の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の車体合成力の最大値のy成分を最小化するマップを用いて、横移動距離Yeの設定を修正しながら繰り返し車体合成力の縦横比γfを求めて、求めたγfと設定された縦横比γ0との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる軌道及び車体合成力の時系列データを導出することができる。
【0219】
次に、第11の実施の形態について説明する。第10の実施の形態では、車体合成力の最大値のx成分またはy成分の一方が最小となる車体合成力を求めるためのマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする横移動距離最大化回避軌道及び車体合成力の時系列データを導出する場合について説明したが、第11の実施の形態では、第10の実施の形態とは異なるマップを用いて収束演算を行うことにより、車体合成力の最大値とその縦横比が与えられた場合に、縦移動距離Xeに対する横移動距離を最大にする現在時刻の車体合成力を導出する場合について説明する。なお、第11の実施の形態の車両運動制御装置について、第1〜第10の実施の形態の車両運動制御装置と同一の構成及び処理については、同一の符号を用いて説明を省略する。
【0220】
ここで、第11の実施の形態ので用いられるマップについて説明する。
【0221】
まず、第10の実施の形態と同様に、(69)式まで展開する。そして、一例として、F1’/m’=Xe’=Ye’=1 とした場合のvx0’及びvy0’に関するマップを作成する。図33に示すように、vx0’を第1のパラメータ、 及びvy0’を第2のパラメータとして、上記(63)式〜(66)式、(45)式、及び(46)式に基づいて得られる車体合成力の方向θ’の値をマッピングした第1のマップ、及びγ0’の値をマッピングした第2のマップを作成することができる。
【0222】
そして、車体合成加速度のy成分の大きさを下記(70)式で求めて、(39)式に適用することにより、現在時刻のm、vx0、vy0、Xe、Ye及びF1に対して、目標位置と目標位置における速度方向に到達する際に、車体合成力の最大値のy成分を最小にする現在時刻の車体合成力の大きさと向きが得られる。
【0223】
【数34】
【0224】
次に、第11の実施形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンについて説明する。第11の実施の形態の車両運動制御装置の制御装置20で実行される車両運動制御ルーチンは、第10の実施の形態における車両運動制御ルーチン(図32)のステップ604で用いるマップ(例えば、図33のマップ)が異なる点、及びステップ504で(39)式に従って現在時刻の車体合成力大きさ及び向きを導出する点が異なり、他の処理は第10の実施の形態における車両運動制御ルーチンと同様である。
【0225】
以上説明したように第11の実施の形態の車両運動制御装置によれば、車体合成力の最大値が縦横比γ0の楕円で制限される場合において、車体合成力の最大値のx成分、y成分、及び横移動距離Yeを設定して、縦移動距離Xe、自車両の速度のx成分vx0、及びy成分vy0により演算されるパラメータを用いた簡単な構成の車体合成力の最大値のy成分を最小化するマップを用いて、横移動距離Yeの設定を修正しながら繰り返し車体合成力の縦横比γfを求めて、求めたγfと設定された縦横比γ0との差が所定値以下になったときの横移動距離Yeに基づいて、所望の縦移動距離及び速度方向に対する横移動距離が最大となる現在時刻の車体合成力の大きさ及び向きを導出することができる。また、車体合成力の時系列データを導出する場合と比べ、用いるマップが少ないため、マップを記憶するための容量を削減できる。
【0226】
なお、第10及び第11の実施の形態では、車体合成力の最大値のx成分を設定した場合に、y成分を最小化するマップを用いたが、同様の手法により車体合成力の最大値のy成分を設定した場合に、x成分を最小化するマップを作成して用いてもよい。
【0227】
また、上記第3〜第11の実施の形態においても、第1及び第2の実施の形態と同様の手法により、導入した任意の正数aの取り方を変えたり、F1’/m’、vy0’、vx0’、Xe’、及びYe’のそれぞれに着目して式を変形したりして、第1のパラメータ及び第2のパラメータを求めることができる。それぞれ得られた第1のパラメータ及び第2のパラメータに応じて、F1’/m’、vy0’、vx0’、Xe’、及びYe’の内必要な値に任意の値を設定してマップを作成することができる。また、第1の実施の形態でマップの軸の取り方を変更した手法と同様の手法により、特異点のラインが縦軸又は横軸と平行になるように各マップの軸の取り方を変更したマップを作成することもできる。
【0228】
また、上記第2〜第11の実施の形態においても、第1の実施の形態と同様に、F1及びγ0を用いるのではなく、F2及びγ0を用いて式展開を行い、各実施の形態で示したマップを適用してもよい。
【符号の説明】
【0229】
10 車速センサ
12 操舵角センサ
14 スロットル開度センサ
16 前方カメラ
18 レーザレーダ
20 制御装置
22 操舵角制御装置
24 制動力制御装置
26 駆動力制御装置
28 マップ記憶装置
30 表示装置
【特許請求の範囲】
【請求項1】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、前記移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Xe、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力を求めるために導入した第1の導入パラメータμ1の、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力を求めるために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1及び前記成分F2に基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、
を含む車両運動制御装置。
【請求項2】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、前記移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Xe、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成加速度の方向θの、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’と、の関係を定めたマップを記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1及び前記成分F2に基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、
を含む車両運動制御装置。
【請求項3】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離が最短となる車体合成力を求めるために導入した第1の導入パラメータμ1の、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離が最短となる車体合成力を求めるために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Yeに対して車体前後方向の移動距離が最短となる最短距離Xs及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて前記最短距離Xsを求め、求めた前記最短距離Xsと前記移動距離Xeとの差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記最短距離Xsを求め、前記最短距離Xsと前記距離の車体前後方向の成分Xeとの差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、
を含む車両運動制御装置。
【請求項4】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離Xeが最短となる車体合成加速度の方向θの、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’と、の関係を定めた第1のマップ、及び
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対する車体前後方向の移動距離の最短距離Xsの、前記仮定の下での値Xs’と、の関係を定めた第2のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、及び前記第2のマップを用いて前記最短距離Xsを求め、求めた前記最短距離Xsと前記移動距離Xeとの差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記最短距離Xsを求め、前記最短距離Xsと前記距離の車体前後方向の成分Xeとの差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、
を含む車両運動制御装置。
【請求項5】
前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記成分F1及び前記成分F2を一定値として前記移動距離Xeを変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記移動距離Xeに基づいて、設定した前記移動距離Yeに対して前記移動距離Xeが最短となる最短回避軌道を導出する請求項1または請求項2記載の車両運動制御装置。
【請求項6】
前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記比γ0を一定値として前記成分F1及び前記成分F2の設定を変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記成分F1及び前記成分F2に基づいて、車体合成力の最大値が最小となる軌道を導出する請求項1または請求項2記載の車両運動制御装置。
【請求項7】
前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記成分F1または前記成分F2の一方を一定値として前記比γ0を変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記比γ0に基づいて、前記成分F1または前記成分F2の他方が最小となる軌道を導出する請求項1または請求項2記載の車両運動制御装置。
【請求項8】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0と、自車両の速度の車体前後方向の成分vx0と前記速度の車体横方向の成分vy0との比と、の積で定められた第1のパラメータと、前記比γ0と、前記移動距離Xeと車体横方向の移動距離Yeとの比と、の積で定められた第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値を最小にするために導入した第1の導入パラメータμ1の、前記比γ0、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値を最小にするために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるための車体合成力の最大値が最小となる車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、
を含む車両運動制御装置。
【請求項9】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0と、自車両の速度の車体前後方向の成分vx0と前記速度の車体横方向の成分vy0との比と、の積で定められた第1のパラメータと、前記比γ0と、前記移動距離Xeと車体横方向の移動距離Yeとの比と、の積で定められた第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値が最小となる車体合成加速度の方向θの、前記比γ0、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’との関係を定めた第1のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために最大値が最小となる車体合成加速度F1/mの、前記仮定の下での車体合成加速度F1’/m’と、の関係を定めた第2のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、及び前記第2のマップを用いて前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるための車体合成力の最大値が最小となる車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、
を含む車両運動制御装置。
【請求項10】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/mまたは車体横方向の成分F2/m、前記移動距離Xe、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、車体合成力の最大値の車体前後方向の成分F1または車体横方向の成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方を最小にするために導入した第1の導入パラメータμ1の、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1または前記成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方を最小にするために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて、設定した前記成分F1または前記成分F2の一方に対して前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小になる車体合成力の最大値の車体前後方向の成分と車体横方向の成分との比γfを求め、求めた前記比γfと設定した前記成分F1と前記成分F2との比γ0との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記比γfを求め、求めた前記比γfと前記比γ0との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、
を含む車両運動制御装置。
【請求項11】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/mまたは車体横方向の成分F2/m、前記移動距離Xe、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、車体合成力の最大値の車体前後方向の成分F1または車体横方向の成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小となる車体合成加速度の方向θの、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’との関係を定めた第1のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1と前記成分F2との比γ0の、前記仮定の下での比γ0’と、の関係を定めた第2のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、及び前記第2のマップを用いて、設定した前記成分F1または前記成分F2の一方に対して前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小になる車体合成力の最大値の車体前後方向の成分と車体横方向の成分との比γfを求め、求めた前記比γfと設定した前記成分F1と前記成分F2との比γ0との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記比γfを求め、求めた前記比γfと前記比γ0との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻における車体合成力を導出する導出手段と、
を含む車両運動制御装置。
【請求項12】
前記導出手段で導出された前記車体合成力に基づいて、操舵角、制動力、及び駆動力の少なくとも一つを制御する制御手段を更に含む請求項1〜請求項11のいずれか1項記載の車両運動制御装置。
【請求項13】
操舵角、制動力、及び駆動力の少なくとも一つを制御する制御手段を含み、
前記設定手段は、障害物の位置及び大きさに基づいて、前記障害物を回避すべき横移動距離を設定し、
前記制御手段は、前記導出手段により導出された最大化された移動距離Yeと、前記設定手段で設定された回避すべき横移動距離とを比較し、前記最大化された移動距離Yeの方が小さい場合には、急制動または衝突被害推定値を最小にする制御を行い、前記回避すべき横移動距離の方が小さい場合には、前記導出手段で導出された前記車体合成力に基づいた回避制御を行う
請求項1〜4、及び請求項8〜11のいずれか1項記載の車両運動制御装置。
【請求項14】
前記第1のパラメータ、及び前記第2のパラメータを、各マップの特異点が該マップの縦軸又は横軸と平行になるように変更した請求項1〜請求項13のいずれか1項記載の車両運動制御装置。
【請求項15】
前記設定手段は、障害物の位置及び大きさに基づいて、前記車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定し、
前記検出手段は、自車両の前記障害物に対する相対速度を検出する
請求項1〜請求項14のいずれか1項記載の車両運動制御装置。
【請求項16】
前記導出手段で導出された前記車体合成力に基づいて、ドライバに車両運動状態を報知する報知手段を更に含む請求項1〜請求項15のいずれか1項記載の車両運動制御装置。
【請求項17】
コンピュータを、請求項1〜請求項15のいずれか1項記載の車両運動制御装置を構成する各手段として機能させるための車両運動制御プログラム。
【請求項1】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、前記移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Xe、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力を求めるために導入した第1の導入パラメータμ1の、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力を求めるために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1及び前記成分F2に基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、
を含む車両運動制御装置。
【請求項2】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、前記移動距離Xe、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Xe、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1及び前記成分F2を設定した場合に、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成加速度の方向θの、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’と、の関係を定めたマップを記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1及び前記成分F2に基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、
を含む車両運動制御装置。
【請求項3】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離が最短となる車体合成力を求めるために導入した第1の導入パラメータμ1の、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離が最短となる車体合成力を求めるために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Yeに対して車体前後方向の移動距離が最短となる最短距離Xs及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて前記最短距離Xsを求め、求めた前記最短距離Xsと前記移動距離Xeとの差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記最短距離Xsを求め、前記最短距離Xsと前記距離の車体前後方向の成分Xeとの差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、
を含む車両運動制御装置。
【請求項4】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/m、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/m、前記比γ0、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対して車体前後方向の移動距離Xeが最短となる車体合成加速度の方向θの、前記成分F1/m、前記比γ0、前記成分Xe、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’と、の関係を定めた第1のマップ、及び
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1、前記成分F2、及び前記移動距離Yeを設定した場合に、前記移動距離Yeに対する車体前後方向の移動距離の最短距離Xsの、前記仮定の下での値Xs’と、の関係を定めた第2のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、及び前記第2のマップを用いて前記最短距離Xsを求め、求めた前記最短距離Xsと前記移動距離Xeとの差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記最短距離Xsを求め、前記最短距離Xsと前記距離の車体前後方向の成分Xeとの差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、
を含む車両運動制御装置。
【請求項5】
前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記成分F1及び前記成分F2を一定値として前記移動距離Xeを変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記移動距離Xeに基づいて、設定した前記移動距離Yeに対して前記移動距離Xeが最短となる最短回避軌道を導出する請求項1または請求項2記載の車両運動制御装置。
【請求項6】
前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記比γ0を一定値として前記成分F1及び前記成分F2の設定を変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記成分F1及び前記成分F2に基づいて、車体合成力の最大値が最小となる軌道を導出する請求項1または請求項2記載の車両運動制御装置。
【請求項7】
前記導出手段は、前記移動距離Xeに対する前記移動距離Yeを設定し、前記成分F1または前記成分F2の一方を一定値として前記比γ0を変更しながら前記移動距離Xeに対する車体横方向の移動距離yeを繰り返し求め、設定した前記移動距離Yeと求めた前記移動距離yeとの差が所定値以内となったときの前記比γ0に基づいて、前記成分F1または前記成分F2の他方が最小となる軌道を導出する請求項1または請求項2記載の車両運動制御装置。
【請求項8】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0と、自車両の速度の車体前後方向の成分vx0と前記速度の車体横方向の成分vy0との比と、の積で定められた第1のパラメータと、前記比γ0と、前記移動距離Xeと車体横方向の移動距離Yeとの比と、の積で定められた第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値を最小にするために導入した第1の導入パラメータμ1の、前記比γ0、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値を最小にするために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるための車体合成力の最大値が最小となる車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、
を含む車両運動制御装置。
【請求項9】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、前記車体合成力の最大値の車体前後方向の成分F1と車体横方向の成分F2との比γ0と、自車両の速度の車体前後方向の成分vx0と前記速度の車体横方向の成分vy0との比と、の積で定められた第1のパラメータと、前記比γ0と、前記移動距離Xeと車体横方向の移動距離Yeとの比と、の積で定められた第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために車体合成力の最大値が最小となる車体合成加速度の方向θの、前記比γ0、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’との関係を定めた第1のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために最大値が最小となる車体合成加速度F1/mの、前記仮定の下での車体合成加速度F1’/m’と、の関係を定めた第2のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、及び設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、及び前記第2のマップを用いて前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるための車体合成力の最大値が最小となる車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記車体合成力fを求め、求めた前記車体合成力fと車体合成力の最大値との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻の車体合成力を導出する導出手段と、
を含む車両運動制御装置。
【請求項10】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/mまたは車体横方向の成分F2/m、前記移動距離Xe、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、車体合成力の最大値の車体前後方向の成分F1または車体横方向の成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方を最小にするために導入した第1の導入パラメータμ1の、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での値μ1’と、の関係を定めた第1のマップ、
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1または前記成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方を最小にするために導入した前記第1の導入パラメータμ1と異なる第2の導入パラメータμ2の、前記仮定の下での値μ2’と、の関係を定めた第2のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記移動距離Xe及び前記移動距離Yeで定まる位置に到達する時刻teの、前記仮定の下での時刻te’と、の関係を定めた第3のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、前記第2のマップ、及び前記第3のマップを用いて、設定した前記成分F1または前記成分F2の一方に対して前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小になる車体合成力の最大値の車体前後方向の成分と車体横方向の成分との比γfを求め、求めた前記比γfと設定した前記成分F1と前記成分F2との比γ0との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記比γfを求め、求めた前記比γfと前記比γ0との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる車体合成力の時系列データを導出する導出手段と、
を含む車両運動制御装置。
【請求項11】
車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定する設定手段と、
自車両の速度を検出する検出手段と、
・前記速度方向を車体前後方向として車体合成力の最大値が楕円で制限されている場合において、車体合成加速度の最大値の車体前後方向の成分F1/mまたは車体横方向の成分F2/m、前記移動距離Xe、車体横方向の移動距離Ye、自車両の速度の車体前後方向の成分vx0、及び前記速度の車体横方向の成分vy0を用いた第1のパラメータと、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0を用いた前記第1のパラメータとは異なる第2のパラメータと、車体合成力の最大値の車体前後方向の成分F1または車体横方向の成分F2の一方を設定した場合に、前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小となる車体合成加速度の方向θの、前記成分F1/mまたは前記成分F2/m、前記移動距離Xe、前記移動距離Ye、前記成分vx0、及び前記成分vy0のうち前記第1のパラメータ及び前記第2のパラメータに応じた3つが特定値であるとの仮定の下での方向θ’との関係を定めた第1のマップ、並びに
・前記第1のパラメータと、前記第2のパラメータと、前記成分F1と前記成分F2との比γ0の、前記仮定の下での比γ0’と、の関係を定めた第2のマップ、を記憶した記憶手段と、
前記設定手段で設定された前記移動距離Xe、前記検出手段で検出された現在の前記速度、設定した前記成分F1、前記成分F2、及び前記移動距離Yeに基づいて、前記第1のパラメータ及び前記第2のパラメータを演算し、演算された第1のパラメータ、第2のパラメータ、前記第1のマップ、及び前記第2のマップを用いて、設定した前記成分F1または前記成分F2の一方に対して前記移動距離Xe及び前記移動距離Yeで定まる位置及び該位置で前記速度方向になるために前記成分F1または前記成分F2の他方が最小になる車体合成力の最大値の車体前後方向の成分と車体横方向の成分との比γfを求め、求めた前記比γfと設定した前記成分F1と前記成分F2との比γ0との差が所定値以内となるまで、前記移動距離Yeの設定を変更しながら繰り返し前記比γfを求め、求めた前記比γfと前記比γ0との差が所定値以内となったときの前記移動距離Yeに基づいて、前記移動距離Xeに対して車体横方向の移動距離Yeが最大となる現在時刻における車体合成力を導出する導出手段と、
を含む車両運動制御装置。
【請求項12】
前記導出手段で導出された前記車体合成力に基づいて、操舵角、制動力、及び駆動力の少なくとも一つを制御する制御手段を更に含む請求項1〜請求項11のいずれか1項記載の車両運動制御装置。
【請求項13】
操舵角、制動力、及び駆動力の少なくとも一つを制御する制御手段を含み、
前記設定手段は、障害物の位置及び大きさに基づいて、前記障害物を回避すべき横移動距離を設定し、
前記制御手段は、前記導出手段により導出された最大化された移動距離Yeと、前記設定手段で設定された回避すべき横移動距離とを比較し、前記最大化された移動距離Yeの方が小さい場合には、急制動または衝突被害推定値を最小にする制御を行い、前記回避すべき横移動距離の方が小さい場合には、前記導出手段で導出された前記車体合成力に基づいた回避制御を行う
請求項1〜4、及び請求項8〜11のいずれか1項記載の車両運動制御装置。
【請求項14】
前記第1のパラメータ、及び前記第2のパラメータを、各マップの特異点が該マップの縦軸又は横軸と平行になるように変更した請求項1〜請求項13のいずれか1項記載の車両運動制御装置。
【請求項15】
前記設定手段は、障害物の位置及び大きさに基づいて、前記車体前後方向の移動距離Xe及び該移動距離Xe移動した位置における速度方向を設定し、
前記検出手段は、自車両の前記障害物に対する相対速度を検出する
請求項1〜請求項14のいずれか1項記載の車両運動制御装置。
【請求項16】
前記導出手段で導出された前記車体合成力に基づいて、ドライバに車両運動状態を報知する報知手段を更に含む請求項1〜請求項15のいずれか1項記載の車両運動制御装置。
【請求項17】
コンピュータを、請求項1〜請求項15のいずれか1項記載の車両運動制御装置を構成する各手段として機能させるための車両運動制御プログラム。
【図1】
【図2】
【図12】
【図13】
【図23】
【図25】
【図27】
【図29】
【図32】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図14】
【図15】
【図16】
【図17】
【図18】
【図19】
【図20】
【図21】
【図22】
【図24】
【図26】
【図28】
【図30】
【図31】
【図33】
【図2】
【図12】
【図13】
【図23】
【図25】
【図27】
【図29】
【図32】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図14】
【図15】
【図16】
【図17】
【図18】
【図19】
【図20】
【図21】
【図22】
【図24】
【図26】
【図28】
【図30】
【図31】
【図33】
【公開番号】特開2011−201363(P2011−201363A)
【公開日】平成23年10月13日(2011.10.13)
【国際特許分類】
【出願番号】特願2010−68691(P2010−68691)
【出願日】平成22年3月24日(2010.3.24)
【新規性喪失の例外の表示】特許法第30条第1項適用申請有り 平成21年12月2日 社団法人 日本機械学会発行の「第18回交通・物流部門大会講演論文集」に発表
【出願人】(000003609)株式会社豊田中央研究所 (4,200)
【Fターム(参考)】
【公開日】平成23年10月13日(2011.10.13)
【国際特許分類】
【出願日】平成22年3月24日(2010.3.24)
【新規性喪失の例外の表示】特許法第30条第1項適用申請有り 平成21年12月2日 社団法人 日本機械学会発行の「第18回交通・物流部門大会講演論文集」に発表
【出願人】(000003609)株式会社豊田中央研究所 (4,200)
【Fターム(参考)】
[ Back to top ]