(57)【特許請求の範囲】
【請求項１】
車体と、
該車体に回転可能に取り付けられた駆動輪と、
走行指令を入力する入力装置と、
該入力装置から入力された走行指令に基づき、前記駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、
該車両制御装置は、車両の動作状態と前記走行指令とに基づいて操縦意図を推定する操縦意図推定手段を備え、該操縦意図推定手段が推定した操縦意図に従って、段差を昇降するための駆動トルクを追加する段差昇降制御を実行又は禁止することを特徴とする車両。
【請求項２】
前記操縦意図推定手段は、車両速度及び車両加速度の目標値に基づいて操縦意図を推定する請求項１に記載の車両。
【請求項３】
前記操縦意図推定手段は、上がり段差への進入時に、車両速度及び車両加速度の目標値が所定の条件を満たしている場合、操縦意図は段差昇降制御の禁止であると推定し、車両速度及び車両加速度の目標値が所定の条件を満たしていない場合、操縦意図は段差昇降制御の実行であると推定する請求項１又は２に記載の車両。
【請求項４】
前記操縦意図推定手段は、車両が停止状態にあり、かつ、車両加速度の目標値が停止状態の維持を指令する値である場合、操縦意図は段差昇降制御の禁止であると推定する請求項３に記載の車両。
【請求項５】
前記段差による抵抗である段差抵抗トルクに応じて、速度閾値を決定する速度閾値決定手段を備え、
前記操縦意図推定手段は、車両速度の絶対値が前記速度閾値以下であり、かつ、走行方向の車両加速度の目標値が走行速度の維持又は制動を指令する値である場合、操縦意図は段差昇降制御の禁止であると推定する請求項３に記載の車両。
【請求項６】
前記車両制御装置は、下がり段差では、前記操縦意図推定手段が推定した操縦意図に係わらず、段差昇降制御を実行する請求項１に記載の車両。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、倒立振り子の姿勢制御を利用した車両に関するものである。
【背景技術】
【０００２】
従来、倒立振り子の姿勢制御を利用した車両に関する技術が提案されている。例えば、同軸上に配置された２つの駆動輪を有し、運転者の重心移動による車体の姿勢変化を感知して駆動する車両、球体状の単一の駆動輪に取り付けられた車体の姿勢を制御しながら移動する車両等の技術が提案されている（例えば、特許文献１参照。）。
【０００３】
この場合、センサで車体のバランスや動作の状態を検出しながら、回転体の動作を制御して車両を停止又は移動させるようになっている。
【特許文献１】特開２００７−２１９９８６号公報
【発明の開示】
【発明が解決しようとする課題】
【０００４】
しかしながら、前記従来の車両においては、車両を操縦している搭乗者の意図に反して、段差を昇降するための駆動トルクを追加する制御動作である段差昇降制御を行ってしまうことがある。例えば、駆動輪が上り段差に接触した状態で停止していると、搭乗者がジョイスティックを操作していなくても、段差昇降制御が実行され、場合によっては車両が段差に乗り上げてしまうことがある。また、例えば、比較的低い車両速度で上り段差に接触した場合、搭乗者がジョイスティックを操作して制動を指令している、すなわち、段差を上るよりも段差に接触して車両が停止した方が望ましいと指令しているにも係わらず、段差昇降制御が実行され、段差を上ってしまうことがある。
【０００５】
一方、搭乗者が制動を指令している場合でも、段差昇降制御を行わない方が良い場合もある。例えば、比較的高い車両速度で上り段差に接触した場合、搭乗者が、停止を意図せずに、単に緩やかに減速させるだけの制動を指令している場合に、段差昇降制御を実行しないと、車両が段差で急停止し、搭乗者の意図に反する。しかし、搭乗者が急停止を意図した制動を指令している場合には、段差昇降制御を実行した方が良い。
【０００６】
また、例えば、車両が下り段差に進入した場合、搭乗者の意図に係わらず、段差昇降制御を行わないと、車両が段差を下りた瞬間に搭乗者が衝撃を受けてしまうことがある。
【０００７】
本発明は、前記従来の車両の問題点を解決して、車両の動作状態と走行指令とに基づいて操縦者の操縦意図を推定し、推定された操縦意図に従って段差を昇降するための駆動トルクを追加する制御動作の実行又は禁止を選択することによって、操縦者の意のままに操縦することができ、段差のある場所でも安全に、かつ、快適に走行することができる車両を提供することを目的とする。
【課題を解決するための手段】
【０００８】
そのために、本発明の車両においては、車体と、該車体に回転可能に取り付けられた駆動輪と、走行指令を入力する入力装置と、該入力装置から入力された走行指令に基づき、前記駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、車両の動作状態と前記走行指令とに基づいて操縦意図を推定する操縦意図推定手段を備え、該操縦意図推定手段が推定した操縦意図に従って、段差を昇降するための駆動トルクを追加する段差昇降制御を実行又は禁止する。
【０００９】
本発明の他の車両においては、さらに、前記操縦意図推定手段は、車両速度及び車両加速度の目標値に基づいて操縦意図を推定する。
【００１０】
本発明の他の車両においては、さらに、前記操縦意図推定手段は、前記車両速度及び車両加速度の目標値に関する複数の所定の関数で領域を示す操縦意図推定マップを備え、前記車両速度及び車両加速度の目標値により定義される点が、該操縦意図推定マップに定義される領域の中にある場合に、操縦意図は段差昇降制御の禁止であると推定する。
【００１１】
本発明の更に他の車両においては、さらに、前記操縦意図推定手段は、上がり段差への進入時において、車両速度及び車両加速度の目標値が所定の条件を満たしている場合、操縦意図は段差昇降制御の禁止であると推定し、車両速度及び車両加速度の目標値が所定の条件を満たしていない場合、操縦意図は段差昇降制御の実行であると推定する。
【００１２】
本発明の更に他の車両においては、さらに、前記操縦意図推定手段は、車両が停止状態にあり、かつ、車両加速度の目標値が車両の停止状態の維持を指令する値である場合、操縦意図は段差昇降制御の禁止であると推定する。
【００１３】
本発明の更に他の車両においては、さらに、前記操縦意図推定手段は、車両速度の絶対値が速度閾値以下であり、かつ、車両加速度の目標値が走行速度の維持又は制動を指令する値である場合、操縦意図は段差昇降制御の禁止であると推定する。
【００１４】
本発明の更に他の車両においては、さらに、前記速度閾値は、段差抵抗トルクの値に応じて決定する。
【００１５】
本発明の更に他の車両においては、さらに、前記操縦意図推定手段は、走行方向の車両加速度の目標値が所定の負の閾値以下である急制動を指令する値である場合、操縦意図は段差昇降制御の禁止であると推定する。
【００１６】
本発明の更に他の車両においては、さらに、前記車両制御装置は、下がり段差では、前記操縦意図推定手段が推定した操縦意図に係わらず、段差昇降制御を実行する。
【００１７】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記段差を昇降するときに、前記車体の姿勢によって前記段差による抵抗である段差抵抗トルクを推定する段差抵抗トルク推定手段を備え、前記操縦意図判定手段は、前記段差抵抗トルクに応じて、段差が上がり段差か下がり段差かを判断し、その判断結果に基づいて前記操縦意図を推定する。
【００１８】
本発明の更に他の車両においては、さらに、前記車両制御手段は、前記操縦意図推定手段が、操縦意図が段差昇降制御の実行であると判断した場合には値が零から１へ、また、操縦意図が段差昇降制御の禁止であると判断した場合には値が１から零へ所定の時間で変化する段差昇降トルク率を決定する段差昇降トルク率決定手段を備え、該段差昇降トルク率と前記段差による抵抗である段差抵抗トルクとの積の値を、段差を昇降するための駆動トルクとして追加する。
【発明の効果】
【００１９】
請求項１の構成によれば、操縦者の意のままに操縦することができ、段差のある場所でも安全に、かつ、快適に走行することができる。
【００２０】
請求項２の構成によれば、操縦意図を適切に推定することができる。
【００２１】
請求項２の構成によれば、設定された操縦意図の複雑な判定条件を簡単に考慮することができる。
【００２２】
請求項３の構成によれば、特に上がり段差への進入時において、操縦意図を適切に推定し、それが段差昇降制御の実行か禁止かを適切に判断することができる。
【００２３】
請求項４の構成によれば、車両が停止しているとき、操縦者の操縦意図を的確に反映した制御が行われるので、操縦者は車両を意のままに操縦することができる。
【００２４】
請求項５の構成によれば、車両が走行しているとき、その走行速度を考慮して、操縦者の操縦意図を的確に反映した制御が行われるので、操縦者は車両を意のままに操縦することができる。
【００２５】
請求項５の構成によれば、走行速度をより適切に考慮して、操縦者の操縦意図を的確に反映した制御が行われるので、操縦者は車両を意のままに操縦することができる。
【００２６】
請求項６の構成によれば、操縦者が急制動を要求したとき、操縦者の操縦意図を的確に反映した制御が行われるので、操縦者は車両を意のままに操縦することができる。
【００２７】
請求項６の構成によれば、段差を下りる際に発生する衝撃を緩和することができ、乗り心地を向上させることができる。
【００２８】
請求項６の構成によれば、段差を下りる際に発生する衝撃を緩和することができ、乗り心地を向上させることができる。
【００２９】
さらに、段差の形状を簡易に、かつ、適切に判断し、それに適した制御が行われるので、操縦者は車両を意のままに操縦することができる。
【００３０】
さらに、操縦者の操縦意図の判定結果が切り替わった瞬間の走行状態や車体の姿勢の急激な変化が抑えられ、乗り心地を向上させることができる。
【発明を実施するための最良の形態】
【００３１】
以下、本発明の実施の形態について図面を参照しながら詳細に説明する。
【００３２】
図１は本発明の第１の実施の形態における車両の構成を示す概略図であり乗員が搭乗した状態で加速前進している状態を示す図、図２は本発明の第１の実施の形態における車両の制御システムの構成を示すブロック図である。
【００３３】
図１において、１０は、本実施の形態における車両であり、車体の本体部１１、駆動輪１２、支持部１３及び乗員１５が搭乗する搭乗部１４を有し、前記車両１０は、車体を前後に傾斜させることができるようになっている。そして、倒立振り子の姿勢制御と同様に車体の姿勢を制御する。図１に示される例においては、車両１０は矢印Ａで示される方向に加速中であり、車体が進行方向に傾斜した状態が示されている。
【００３４】
前記駆動輪１２は、車体の一部である支持部１３に対して回転可能に支持され、駆動アクチュエータとしての駆動モータ５２によって駆動される。なお、駆動輪１２の軸は図１に示す平面に垂直な方向に存在し、駆動輪１２はその軸を中心に回転する。また、前記駆動輪１２は、単数であっても複数であってもよいが、複数である場合、同軸上に並列に配設される。本実施の形態においては、駆動輪１２が２つであるものとして説明する。この場合、各駆動輪１２は個別の駆動モータ５２によって独立して駆動される。なお、駆動アクチュエータとしては、例えば、油圧モータ、内燃機関等を使用することもできるが、ここでは、電気モータである駆動モータ５２を使用するものとして説明する。
【００３５】
また、車体の一部である本体部１１は、支持部１３によって下方から支持され、駆動輪１２の上方に位置する。そして、本体部１１には、能動重量部として機能する搭乗部１４が、車両１０の前後方向へ本体部１１と相対的に移動可能となるように、換言すると、車体回転円の接線方向に相対的に移動可能となるように、取り付けられている。
【００３６】
ここで、能動重量部は、ある程度の質量を有し、本体部１１に対して前後に移動させることによって、車両１０の重心位置を能動的に補正するものである。そして、能動重量部は、必ずしも搭乗部１４である必要はなく、例えば、バッテリ等の重量のある周辺機器を本体部１１に対して移動可能に取り付けた装置であってもよいし、ウェイト、錘（おもり）、バランサ等の専用の重量部材を本体部１１に対して移動可能に取り付けた装置であってもよい。また、搭乗部１４、重量のある周辺機器、専用の重量部材等を併用するものであってもよい。
【００３７】
また、本実施の形態においては、説明の都合上、乗員１５が搭乗した状態の搭乗部１４が能動重量部として機能する例について説明するが、搭乗部１４には必ずしも乗員１５が搭乗している必要はなく、例えば、車両１０がリモートコントロールによって操縦される場合には、搭乗部１４に乗員１５が搭乗していなくてもよいし、乗員１５に代えて、貨物が積載されていてもよい。
【００３８】
前記搭乗部１４は、乗用車、バス等の自動車に使用されるシートと同様のものであり、座面部１４ａ、背もたれ部１４ｂ及びヘッドレスト１４ｃを備え、図示されない移動機構を介して本体部１１に取り付けられている。
【００３９】
前記移動機構は、リニアガイド装置等の低抵抗の直線移動機構、及び、能動重量部アクチュエータとしての能動重量部モータ６２を備え、該能動重量部モータ６２によって搭乗部１４を駆動し、本体部１１に対して車両進行方向に前後させるようになっている。なお、能動重量部アクチュエータとしては、例えば、油圧モータ、リニアモータ等を使用することもできるが、ここでは、回転式の電気モータである能動重量部モータ６２を使用するものとして説明する。
【００４０】
リニアガイド装置は、例えば、本体部１１に取り付けられている案内レールと、搭乗部１４に取り付けられ、案内レールに沿ってスライドするキャリッジと、案内レールとキャリッジとの間に介在するボール、コロ等の転動体とを備える。そして、案内レールには、その左右側面部に２本の軌道溝が長手方向に沿って直線状に形成されている。また、キャリッジの断面はコ字状に形成され、その対向する２つの側面部内側には、２本の軌道溝が、案内レールの軌道溝と各々対向するように形成されている。転動体は、軌道溝の間に組み込まれており、案内レールとキャリッジとの相対的直線運動に伴って軌道溝内を転動するようになっている。なお、キャリッジには、軌道溝の両端をつなぐ戻し通路が形成されており、転動体は軌道溝及び戻し通路を循環するようになっている。
【００４１】
また、リニアガイド装置は、該リニアガイド装置の動きを締結するブレーキ又はクラッチを備える。車両１０が停車しているときのように搭乗部１４の動作が不要であるときには、ブレーキによって案内レールにキャリッジを固定することで、本体部１１と搭乗部１４との相対的位置関係を保持する。そして、動作が必要であるときには、このブレーキを解除し、本体部１１側の基準位置と搭乗部１４側の基準位置との距離が所定値となるように制御される。
【００４２】
前記搭乗部１４の脇（わき）には、目標走行状態取得装置としてのジョイスティック３１を備える入力装置３０が配設されている。乗員１５は、操縦装置であるジョイスティック３１を操作することによって、車両１０を操縦する、すなわち、車両１０の加速、減速、旋回、その場回転、停止、制動等の走行指令を入力するようになっている。なお、乗員１５が操作して走行指令を入力することができる装置であれば、ジョイスティック３１に代えて他の装置、例えば、ペダル、ハンドル、ジョグダイヤル、タッチパネル、押しボタン等の装置を目標走行状態取得装置として使用することもできる。
【００４３】
なお、車両１０がリモートコントロールによって操縦される場合には、前記ジョイスティック３１に代えて、コントローラからの走行指令を有線又は無線で受信する受信装置を目標走行状態取得装置として使用することができる。また、車両１０があらかじめ決められた走行指令データに従って自動走行する場合には、前記ジョイスティック３１に代えて、半導体メモリ、ハードディスク等の記憶媒体に記憶された走行指令データを読み取るデータ読取り装置を目標走行状態取得装置として使用することができる。
【００４４】
また、車両１０は、車両制御装置としての制御ＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ  Ｃｏｎｔｒｏｌ  Ｕｎｉｔ）２０を有し、該制御ＥＣＵ２０は、主制御ＥＣＵ２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３を備える。前記制御ＥＣＵ２０並びに主制御ＥＣＵ２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３は、ＣＰＵ、ＭＰＵ等の演算手段、磁気ディスク、半導体メモリ等の記憶手段、入出力インターフェイス等を備え、車両１０の各部の動作を制御するコンピュータシステムであり、例えば、本体部１１に配設されるが、支持部１３や搭乗部１４に配設されていてもよい。また、前記主制御ＥＣＵ２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３は、それぞれ、別個に構成されていてもよいし、一体に構成されていてもよい。
【００４５】
そして、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、駆動輪センサ５１及び駆動モータ５２とともに、駆動輪１２の動作を制御する駆動輪制御システム５０の一部として機能する。前記駆動輪センサ５１は、レゾルバ、エンコーダ等から成り、駆動輪回転状態計測装置として機能し、駆動輪１２の回転状態を示す駆動輪回転角及び／又は回転角速度を検出し、主制御ＥＣＵ２１に送信する。また、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、該駆動輪制御ＥＣＵ２２は、受信した駆動トルク指令値に相当する入力電圧を駆動モータ５２に供給する。そして、該駆動モータ５２は、入力電圧に従って駆動輪１２に駆動トルクを付与し、これにより、駆動アクチュエータとして機能する。
【００４６】
また、主制御ＥＣＵ２１は、能動重量部制御ＥＣＵ２３、能動重量部センサ６１及び能動重量部モータ６２とともに、能動重量部である搭乗部１４の動作を制御する能動重量部制御システム６０の一部として機能する。前記能動重量部センサ６１は、エンコーダ等から成り、能動重量部移動状態計測装置として機能し、搭乗部１４の移動状態を示す能動重量部位置及び／又は移動速度を検出し、主制御ＥＣＵ２１に送信する。また、該主制御ＥＣＵ２１は、能動重量部推力指令値を能動重量部制御ＥＣＵ２３に送信し、該能動重量部制御ＥＣＵ２３は、受信した能動重量部推力指令値に相当する入力電圧を能動重量部モータ６２に供給する。そして、該能動重量部モータ６２は、入力電圧に従って搭乗部１４を並進移動させる推力を搭乗部１４に付与し、これにより、能動重量部アクチュエータとして機能する。
【００４７】
さらに、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、能動重量部制御ＥＣＵ２３、車体傾斜センサ４１、駆動モータ５２及び能動重量部モータ６２とともに、車体の姿勢を制御する車体制御システム４０の一部として機能する。前記車体傾斜センサ４１は、加速度センサ、ジャイロセンサ等から成り、車体傾斜状態計測装置として機能し、車体の傾斜状態を示す車体傾斜角及び／又は傾斜角速度を検出し、主制御ＥＣＵ２１に送信する。そして、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、能動重量部推力指令値を能動重量部制御ＥＣＵ２３に送信する。
【００４８】
なお、主制御ＥＣＵ２１には、入力装置３０のジョイスティック３１から走行指令が入力される。そして、前記主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、能動重量部推力指令値を能動重量部制御ＥＣＵ２３に送信する。
【００４９】
また、前記制御ＥＣＵ２０は、車両１０の走行状態及び車体姿勢の時間変化に基づいて段差抵抗トルクを推定する段差抵抗トルク推定手段として機能する。また、目標走行状態及び段差抵抗トルクに応じて目標とする車体姿勢、すなわち、車体傾斜状態及び／又は能動重量部移動状態を決定する目標車体姿勢決定手段として機能する。さらに、各センサによって取得した車両１０の走行状態及び車体姿勢、並びに、目標走行状態、目標車体姿勢及び段差抵抗トルクに応じて各アクチュエータの出力を決定するアクチュエータ出力決定手段として機能する。具体的には、段差抵抗トルクに応じて追加する駆動トルクを決定する段差昇降トルク決定手段、及び、段差昇降トルクに応じて車体の重心補正量を決定する重心補正量決定手段として機能する。
【００５０】
なお、各センサは、複数の状態量を取得するものであってもよい。例えば、車体傾斜センサ４１として加速度センサとジャイロセンサとを併用し、両者の計測値から車体傾斜角と車体傾斜角速度を決定してもよい。
【００５１】
次に、前記構成の車両１０の動作について説明する。まず、走行及び姿勢制御処理の概要について説明する。
【００５２】
図３は本発明の第１の実施の形態における車両の段差昇降動作を示す概略図、図４は本発明の第１の実施の形態における車両の走行及び姿勢制御処理の動作を示すフローチャートである。なお、図３（ａ）は比較のための従来技術による動作例を示し、図３（ｂ）は本実施の形態による動作を示している。
【００５３】
「背景技術」の項で説明したような従来の車両の場合、図３（ａ）に示されるように、段差に乗り上げるために駆動輪１２に付与した駆動トルクの反作用、すなわち、反トルクが車体に作用するので、車体が後方に傾いてしまう。そのため、段差に乗り上げるときに、安定した車体姿勢及び走行の制御を行うことができない。
【００５４】
これに対し、本実施の形態においては、搭乗部１４が能動重量部として機能し、図３（ｂ）に示されるように、搭乗部１４を前後に移動させることによって、車両１０の重心位置を能動的に補正する。これにより、段差に乗り上げるときには、車体の重心を前方に移動させるので、段差に乗り上げるための駆動トルクを駆動輪１２に付与したときの反作用、すなわち、反トルクが車体に作用しても、車体が後方に傾いてしまうことがない。したがって、段差に乗り上げるときにも安定した車体姿勢及び走行の制御を行うことができる。本実施の形態は、特に停止状態及び低速走行状態から段差に進入する場合に効果的である。
【００５５】
また、段差に乗り上げるための駆動トルクを、乗り上げ動作の間、リアルタイムで推定して駆動輪１２に付与する。これにより、任意の形状の段差に対して、安定した乗り上げが可能となる。
【００５６】
すなわち、本実施の形態においては、車両１０の重心位置補正や駆動トルクの付与を含む走行及び姿勢制御処理を実行することによって、車両１０は安定して段差を昇降することができる。
【００５７】
走行及び姿勢制御処理において、制御ＥＣＵ２０は、まず、状態量の取得処理を実行し（ステップＳ１）、各センサ、すなわち、駆動輪センサ５１、車体傾斜センサ４１及び能動重量部センサ６１によって、駆動輪１２の回転状態、車体の傾斜状態及び搭乗部１４の移動状態を取得する。
【００５８】
次に、制御ＥＣＵ２０は、段差昇降トルクの決定処理を実行し（ステップＳ２）、状態量の取得処理で取得した状態量、すなわち、駆動輪１２の回転状態、車体の傾斜状態及び搭乗部１４の移動状態と、各アクチュエータの出力値、すなわち、駆動モータ５２及び能動重量部モータ６２の出力値に基づき、オブザーバによって段差抵抗トルクを推定し、段差昇降トルクを決定する。ここで、前記オブザーバは、力学的なモデルに基づいて、制御系の内部状態を観測する方法であり、ワイヤードロジック又はソフトロジックで構成される。
【００５９】
次に、制御ＥＣＵ２０は、目標走行状態の決定処理を実行し（ステップＳ３）、ジョイスティック３１の操作量に基づいて、車両１０の加速度の目標値、及び、駆動輪１２の回転角速度の目標値を決定する。
【００６０】
次に、制御ＥＣＵ２０は、目標車体姿勢の決定処理を実行し（ステップＳ４）、段差昇降トルクの決定処理によって決定された段差昇降トルクと、目標走行状態の決定処理によって決定された車両１０の加速度の目標値に基づいて、車体姿勢の目標値、すなわち、車体傾斜角及び能動重量部位置の目標値を決定する。
【００６１】
最後に、制御ＥＣＵ２０は、アクチュエータ出力の決定処理を実行し（ステップＳ５）、状態量の取得処理によって取得された各状態量、段差昇降トルクの決定処理によって決定された段差昇降トルク、目標走行状態の決定処理によって決定された目標走行状態、及び、目標車体姿勢の決定処理によって決定された目標車体姿勢に基づいて、各アクチュエータの出力、すなわち、駆動モータ５２及び能動重量部モータ６２の出力を決定する。
【００６２】
次に、走行及び姿勢制御処理の詳細について説明する。まず、状態量の取得処理について説明する。
【００６３】
図５は本発明の第１の実施の形態における車両の力学モデル及びそのパラメータを示す図、図６は本発明の第１の実施の形態における状態量の取得処理の動作を示すフローチャートである。
【００６４】
本実施の形態においては、状態量やパラメータを次のような記号によって表す。なお、図５には状態量やパラメータの一部が示されている。
θW ：駆動輪回転角〔ｒａｄ〕
θ1 ：車体傾斜角（鉛直軸基準）〔ｒａｄ〕
λS ：能動重量部位置（車体中心点基準）〔ｍ〕
τW ：駆動トルク（２つの駆動輪の合計）〔Ｎｍ〕
ＳS ：能動重量部推力〔Ｎ〕
ｇ：重力加速度〔ｍ／ｓ2 〕
ｍW ：駆動輪質量（２つの駆動輪の合計）〔ｋｇ〕
ＲW ：駆動輪接地半径〔ｍ〕
ＩW ：駆動輪慣性モーメント（２つの駆動輪の合計）〔ｋｇｍ2 〕
ＤW ：駆動輪回転に対する粘性減衰係数〔Ｎｓ／ｒａｄ〕
ｍ1 ：車体質量（能動重量部を含む）〔ｋｇ〕
ｌ1 ：車体重心距離（車軸から）〔ｍ〕
Ｉ1 ：車体慣性モーメント（重心周り）〔ｋｇｍ2 〕
Ｄ1 ：車体傾斜に対する粘性減衰係数〔Ｎｓ／ｒａｄ〕
ｍS ：能動重量部質量〔ｋｇ〕
ｌS ：能動重量部重心距離（車軸から）〔ｍ〕
ＩS ：能動重量部慣性モーメント（重心周り）〔ｋｇｍ2 〕
ＤS ：能動重量部並進に対する粘性減衰係数〔Ｎｓ／ｒａｄ〕
0005061943.tif 000002
【００６５】
次に、段差昇降トルクの決定処理について説明する。
【００６６】
図７は本発明の第１の実施の形態における段差昇降トルクの決定処理の動作を示すフローチャートである。
【００６７】
段差昇降トルクの決定処理において、主制御ＥＣＵ２１は、まず、段差抵抗トルクτD を推定する（ステップＳ２−１）。この場合、状態量の取得処理で取得した各状態量と、前回（一つ前の時間ステップ）の走行及び姿勢制御処理におけるアクチュエータ出力の決定処理で決定した各アクチュエータの出力に基づき、次の式（１）により、段差抵抗トルクτD を推定する。
【００６８】
【数１】
0005061943.tif 000003
【００６９】
続いて、主制御ＥＣＵ２１は、段差昇降トルクτC を決定する（ステップＳ２−２）。この場合、推定した段差抵抗トルクτD の値を段差昇降トルクτC の値とする。すなわち、τC ＝τD とする。
【００７０】
このように、本実施の形態においては、駆動モータ５２が出力する駆動トルクと、状態量としての車両並進加速度を示す駆動輪回転角加速度、車体傾斜角加速度及び能動重量部移動加速度とに基づいて段差抵抗トルクを推定する。この場合、駆動輪１２の回転状態を示す駆動輪回転角加速度だけでなく、車体姿勢の変化を示す車体傾斜角加速度及び能動重量部移動加速度も考慮している。すなわち、倒立振り子の姿勢制御を利用した車両、いわゆる倒立型車両に特有の要素である車体姿勢の変化を考慮している。
【００７１】
従来においては、駆動トルクと駆動輪回転角加速度とに基づいて段差抵抗トルクを推定するため、特に車体の姿勢が変化しているとき、段差抵抗トルクの推定値に大きな誤差が生じることがあった。しかし、本実施の形態においては、車体の姿勢変化を示す車体傾斜角加速度及び能動重量部移動加速度をも考慮して段差抵抗トルクを推定するので、大きな誤差が生じることがなく、高い精度で段差抵抗トルクを推定することができる。
【００７２】
一般的に、倒立型車両では、駆動輪と相対的に車体の重心が前後に移動するので、駆動輪が停止していても、車両の重心が前後に移動することがある。したがって、重心の加速度と駆動力、あるいは、駆動トルクとから段差抵抗トルクを高い精度で推定するためには、このような影響を考慮する必要がある。一般的な倒立型車両においては、車両全体に対する車体の重量比率が高く、かつ、段差昇降動作中の姿勢変化が大きいので、このような影響が大きくなる。
【００７３】
また、本実施の形態においては、段差の昇降動作中に変化する段差抵抗トルクを常に推定している。例えば、段差の昇降動作中に一定の駆動トルクを駆動輪１２に付与すると、昇降終了直前に、車両１０が不必要に加減速してしまうことがある。これは、例えば、段差に乗り上げる場合、車両１０が段差を上るのと共に段差抵抗トルクが小さくなるためである。そこで、本実施の形態においては、段差昇降状態と共に変化する段差抵抗トルクの推定をリアルタイムで行い、その値を常に更新することで、常に段差の昇降動作に適した段差昇降トルクを付与するようになっている。
【００７４】
なお、段差抵抗トルクの推定値にローパスフィルタをかけることによって、推定値の高周波成分を除去することもできる。この場合、推定に時間遅れが生じるが、高周波成分に起因する振動を抑制することができる。
【００７５】
本実施の形態においては、慣性力のみを考慮しているが、駆動輪１２の転がり抵抗や回転軸の摩擦による粘性抵抗、あるいは、車両１０に作用する空気抵抗などを副次的な影響として考慮してもよい。
【００７６】
また、本実施の形態においては、駆動輪１２の回転運動に関する線形モデルを使用しているが、より正確な非線形モデルを使用してもよいし、車体傾斜運動や能動重量部並進運動についてのモデルを使用してもよい。なお、非線形モデルについては、マップの形式で関数を適用することもできる。
【００７７】
さらに、計算の簡略化のために、車体姿勢の変化を考慮しなくてもよい。
【００７８】
次に、目標走行状態の決定処理について説明する。
【００７９】
図８は本発明の第１の実施の形態における目標走行状態の決定処理の動作を示すフローチャートである。
【００８０】
目標走行状態の決定処理において、主制御ＥＣＵ２１は、まず、操縦操作量を取得する（ステップＳ３−１）。この場合、乗員１５が、車両１０の加速、減速、旋回、その場回転、停止、制動等の走行指令を入力するために操作したジョイスティック３１の操作量を取得する。
【００８１】
続いて、主制御ＥＣＵ２１は、取得したジョイスティック３１の操作量に基づいて、車両加速度の目標値を決定する（ステップＳ３−２）。例えば、ジョイスティック３１の前後方向への操作量に比例した値を車両加速度の目標値とする。
【００８２】
続いて、主制御ＥＣＵ２１は、決定した車両加速度の目標値から、駆動輪回転角速度の目標値を算出する（ステップＳ３−３）。例えば、車両加速度の目標値を時間積分し、駆動輪接地半径ＲW で除した値を駆動輪回転角速度の目標値とする。
【００８３】
次に、目標車体姿勢の決定処理について説明する。
【００８４】
図９は本発明の第１の実施の形態における能動重量部位置の目標値及び車体傾斜角の目標値の変化を示すグラフ、図１０は本発明の第１の実施の形態における目標車体姿勢の決定処理の動作を示すフローチャートである。
【００８５】
目標車体姿勢の決定処理において、主制御ＥＣＵ２１は、まず、能動重量部位置の目標値及び車体傾斜角の目標値を決定する（ステップＳ４−１）。この場合、目標走行状態の決定処理によって決定された車両加速度の目標値と、段差昇降トルクの決定処理によって取得された段差昇降トルクτC に基づき、次の式（２）及び（３）により、能動重量部位置の目標値及び車体傾斜角の目標値を決定する。
【００８６】
【数２】
0005061943.tif 000004
【００８７】
【数３】
0005061943.tif 000005
【００８８】
続いて、主制御ＥＣＵ２１は、残りの目標値を算出する（ステップＳ４−２）。すなわち、各目標値を時間微分又は時間積分することにより、駆動輪回転角、車体傾斜角速度及び能動重量部移動速度の目標値を算出する。
【００８９】
このように、本実施の形態においては、車両加速度に伴って車体に作用する慣性力及び駆動モータ反トルクだけでなく、段差抵抗トルクτD に応じた段差昇降トルクτC に伴って車体に作用する反トルクも考慮して、車体姿勢の目標値、すなわち、能動重量部位置の目標値及び車体傾斜角の目標値を決定する。
【００９０】
このとき、車体に作用して車体を傾斜させようとするトルク、すなわち、車体傾斜トルクを重力の作用によって打ち消すように、車体の重心を移動させる。例えば、車両１０が段差を上るときには、搭乗部１４を前方へ移動させ、あるいは、さらに車体を前方へ傾ける。また、車両１０が段差を下るときには、搭乗部１４を後方へ移動させ、あるいは、さらに車体を後方へ傾ける。
【００９１】
本実施の形態においては、図９に示されるように、まず、車体を傾斜させずに搭乗部１４を移動させ、該搭乗部１４が能動重量部移動限界に達すると、車体の傾斜を開始させる。そのため、細かい加減速に対しては車体が前後に傾かないので、乗員１５にとっての乗り心地が向上する。また、格別に高い段差でなければ、段差の上でも車体が直立状態を維持するので、乗員１５にとっての視界の確保が容易となる。さらに、格別に高い段差でなければ、段差の上でも車体が大きく傾斜することがないので、車体の一部が路面に接触することが防止される。
【００９２】
なお、本実施の形態においては、能動重量部移動限界が前方と後方とで等しい場合を想定しているが、前方と後方とで異なる場合には、各々の限界に応じて、車体の傾斜の有無を切り替えるようにしてもよい。例えば、加速性能よりも制動性能を高く設定する場合、後方の能動重量部移動限界を前方の限界よりも遠くに設定する必要がある。
【００９３】
また、本実施の形態においては、加速度が低いときや段差が低いときには、搭乗部１４の移動だけで対応させているが、その車体傾斜トルクの一部又は全部を車体の傾斜で対応させてもよい。車体を傾斜させることにより、乗員１５に作用する前後方向の慣性力を軽減することができる。
【００９４】
さらに、本実施の形態においては、線形化した力学モデルに基づいた式を使用しているが、より正確な非線形モデル又は粘性抵抗を考慮したモデルに基づいた式を使用してもよい。なお、式が非線形になる場合には、マップの形式で関数を適用することもできる。
【００９５】
次に、アクチュエータ出力の決定処理について説明する。
【００９６】
図１１は本発明の第１の実施の形態におけるアクチュエータ出力の決定処理の動作を示すフローチャートである。
【００９７】
アクチュエータ出力の決定処理において、主制御ＥＣＵ２１は、まず、各アクチュエータのフィードフォワード出力を決定する（ステップＳ５−１）。この場合、各目標値と段差昇降トルクτC とから、次の式（４）により駆動モータ５２のフィードフォワード出力を決定し、また、次の式（５）により能動重量部モータ６２のフィードフォワード出力を決定する。
【００９８】
【数４】
0005061943.tif 000006
【００９９】
このように、段差抵抗トルクτD に応じた段差昇降トルクτC を自動的に追加することにより、つまり、段差抵抗トルクτD に応じて駆動トルクを補正することにより、段差の昇降の際にも、平地と同様の操縦感覚を提供することができる。すなわち、平地と同様の操縦操作で段差を乗り降りすることができる。また、ジョイスティック３１の一定の操縦操作に対して、段差の昇降の際に、車両１０が不必要に加減速することがない。
【０１００】
【数５】
0005061943.tif 000007
【０１０１】
このように、本実施の形態においては、理論的にフィードフォワード出力を与えることによって、より高精度な制御を実現する。
【０１０２】
なお、必要に応じて、フィードフォワード出力を省略することもできる。この場合、フィードバック制御により、定常偏差を伴いつつ、フィードフォワード出力に近い値が間接的に与えられる。また、前記定常偏差は、積分ゲインを適用することによって低減させることができる。
【０１０３】
続いて、主制御ＥＣＵ２１は、各アクチュエータのフィードバック出力を決定する（ステップＳ５−２）。この場合、各目標値と実際の状態量との偏差から、次の式（６）により駆動モータ５２のフィードバック出力を決定し、また、次の式（７）により能動重量部モータ６２のフィードバック出力を決定する。
【０１０４】
【数６】
0005061943.tif 000008
【０１０５】
なお、スライディングモード制御等の非線形のフィードバック制御を導入することもできる。また、より簡単な制御として、ＫW2、ＫW3及びＫS5を除くフィードバックゲインのいくつかをゼロとしてもよい。さらに、定常偏差をなくすために、積分ゲインを導入してもよい。
【０１０６】
最後に、主制御ＥＣＵ２１は、各要素制御システムに指令値を与える（ステップＳ５−３）。この場合、主制御ＥＣＵ２１は、前述のように決定したフィードフォワード出力とフィードバック出力との和を駆動トルク指令値及び能動重量部推力指令値として、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３に送信する。
【０１０７】
このように、本実施の形態においては、段差抵抗トルクτD をオブザーバによって推定し、段差昇降トルクτC を与えるとともに、搭乗部１４を段差の上段方向に移動させる。そのため、段差の上でも車体を直立に保持することができ、段差の昇降にも対応することができる。また、段差を計測する装置が不要となり、システム構成を簡素化してコストを低減することができる。
【０１０８】
さらに、車体の姿勢を示す車体傾斜角θ1 及び能動重量部位置λS を考慮して段差昇降トルクτC を推定するので、大きな誤差が生じることなく、極めて高い精度で段差昇降トルクτC を推定することができる。
【０１０９】
なお、本実施の形態は、段差を上るときだけでなく、段差を降りるときにも有効であることを注記する。段差昇降トルクの付与によって段差降下時の車両の加速を抑えるのと共に、搭乗部１４を後方に移動させることにより車体を直立に保持する。これは、以降で説明する第２及び第３の実施の形態でも同様である。
【０１１０】
次に、本発明の第２の実施の形態について説明する。なお、第１の実施の形態と同じ構造を有するものについては、同じ符号を付与することによってその説明を省略する。また、前記第１の実施の形態と同じ動作及び同じ効果についても、その説明を省略する。
【０１１１】
図１２は本発明の第２の実施の形態における車両の制御システムの構成を示すブロック図、図１３は本発明の第２の実施の形態における車両の段差の昇降における動作を示す概略図である。
【０１１２】
前記第１の実施の形態においては、搭乗部１４が、車両１０の前後方向に本体部１１に対して相対的に並進可能となるように取り付けられ、能動重量部として機能する。この場合、能動重量部モータ６２を備える移動機構が配設され、これにより搭乗部１４を並進させるので、構造の複雑化、コストや重量の増加と共に、制御システムも複雑化する。一方、前記第１の実施の形態は、搭乗部１４を移動させる移動機構を有していない倒立型車両に適用することは不可能である。
【０１１３】
そこで、本実施の形態においては、搭乗部１４を移動させる移動機構が省略されている。また、図１２に示されるように、制御システムからも、能動重量部制御システム６０が省略され、能動重量部制御ＥＣＵ２３、能動重量部センサ６１及び能動重量部モータ６２が省略されている。なお、その他の点の構成については、前記第１の実施の形態と同様であるので、その説明は省略する。
【０１１４】
そして、本実施の形態においては、図１３に示されるように、段差を昇降する際には、段差を昇降するための駆動輪１２に付与する駆動トルク、すなわち、段差昇降トルクの反作用として車体に作用する反トルクとしての車体傾斜トルクに対し、車体を段差昇降トルクに応じた角度だけ段差の上段方向に傾けることにより、車体傾斜トルクを重力の作用で打ち消してバランスを保つようになっている。
【０１１５】
なお、「背景技術」の項でも説明したように、例えば、段差に乗り上げるとき、必要な駆動トルクを駆動輪に付与すると、その反作用が車体に働くので、車体が段差と逆の方向、すなわち、段差の下段方向に大きく傾いてしまう。一方、車体の姿勢を直立に維持しようとすると、必要な駆動トルクを駆動輪に付与することができないので、段差に乗り上げることができなくなってしまう。また、段差を降りるときにも同様の現象が発生し、車体が前方に傾いてしまう。
【０１１６】
これに対し、本実施の形態においては、段差の高さに適した角度だけ車体を段差の上段方向に意図的に傾けるので、段差の昇降の際にも、安定した車体の姿勢を保つことができ、段差のある場所でも安全に、かつ、快適に走行することができる。
【０１１７】
次に、本実施の形態における走行及び姿勢制御処理の詳細について説明する。なお、走行及び姿勢制御処理の概要及び目標走行状態の決定処理については、前記第１の実施の形態と同様であるので、説明を省略し、状態量の取得処理、段差昇降トルクの決定処理、目標車体姿勢の決定処理及びアクチュエータ出力の決定処理についてのみ説明する。まず、状態量の取得処理について説明する。
【０１１８】
図１４は本発明の第２の実施の形態における状態量の取得処理の動作を示すフローチャートである。
0005061943.tif 000009
【０１１９】
次に、段差昇降トルクの決定処理について説明する。
【０１２０】
図１５は本発明の第２の実施の形態における段差昇降トルクの決定処理の動作を示すフローチャートである。
【０１２１】
段差昇降トルクの決定処理において、主制御ＥＣＵ２１は、段差抵抗トルクτD を推定する（ステップＳ２−１１）。この場合、状態量の取得処理で取得した各状態量と、前回（一つ前の時間ステップ）の走行及び姿勢制御処理におけるアクチュエータ出力の決定処理で決定した各アクチュエータの出力とに基づき、次の式（８）により、段差抵抗トルクτD を推定する。
【０１２２】
【数７】
0005061943.tif 000010
【０１２３】
続いて、主制御ＥＣＵ２１は、段差昇降トルクτC を決定する（ステップＳ２−１２）。この場合、推定した段差抵抗トルクτD の値を段差昇降トルクτC の値とする。すなわち、τC ＝τD とする。
【０１２４】
このように、本実施の形態においては、駆動モータ５２が出力する駆動トルクと、状態量としての駆動輪回転角加速度及び車体傾斜角加速度に基づいて段差抵抗トルクを推定する。この場合、駆動輪１２の回転状態を示す駆動輪回転角加速度だけでなく、車体姿勢の変化を示す車体傾斜角加速度も考慮している。すなわち、倒立振り子の姿勢制御を利用した車両、いわゆる倒立型車両に特有の要素である車体姿勢の変化を考慮している。
【０１２５】
従来においては、駆動トルクと駆動輪回転角加速度とに基づいて段差抵抗トルクを推定するため、特に車体の姿勢が大きく変化するとき、段差抵抗トルクの推定値に大きな誤差が生じることがあった。しかし、本実施の形態においては、車体の姿勢変化を示す車体傾斜角加速度を考慮して段差抵抗トルクを推定するので、大きな誤差が生じることがなく、高い精度で段差抵抗トルクを推定することができる。
【０１２６】
また、本実施の形態においては、段差の昇降動作中に変化する段差抵抗トルクを常に推定している。例えば、段差の昇降動作中に一定の駆動トルクを駆動輪１２に付与すると、昇降終了直前に、車両１０が不必要に加減速してしまうことがある。これは、例えば、段差に乗り上げる場合、車両１０が段差を上るのと共に段差抵抗トルクが小さくなるためである。そこで、本実施の形態においては、段差昇降状態と共に変化する段差抵抗トルクの推定をリアルタイムで行い、その値を常に更新することで、常に段差の昇降動作に適した段差昇降トルクを付与するようになっている。
【０１２７】
なお、前記第１の実施の形態と同様に、段差抵抗トルクの推定値にローパスフィルタをかけることによって、推定値の高周波成分を除去することもできる。この場合、推定に時間遅れが生じるが、高周波成分に起因する振動を抑制することができる。
【０１２８】
本実施の形態においては、慣性力のみを考慮しているが、駆動輪１２の転がり抵抗や回転軸の摩擦による粘性抵抗、あるいは、車両１０に作用する空気抵抗などを、副次的な影響として考慮してもよい。
【０１２９】
また、より正確な非線形モデルを使用してもよいし、車体傾斜運動についてのモデルを使用してもよい。なお、非線形モデルについては、マップの形式で関数を適用することもできる。
【０１３０】
さらに、計算の簡略化のために、車体姿勢の変化を考慮しなくてもよい。
【０１３１】
次に、目標車体姿勢の決定処理について説明する。
【０１３２】
図１６は本発明の第２の実施の形態における目標車体姿勢の決定処理の動作を示すフローチャートである。
【０１３３】
目標車体姿勢の決定処理において、主制御ＥＣＵ２１は、まず、車体傾斜角の目標値を決定する（ステップＳ４−１１）。この場合、目標走行状態の決定処理によって決定された車両加速度の目標値と、段差昇降トルクの決定処理によって取得された段差昇降トルクτC とに基づき、次の式（９）により、車体傾斜角の目標値を決定する。
【０１３４】
【数８】
0005061943.tif 000011
【０１３５】
続いて、主制御ＥＣＵ２１は、残りの目標値を算出する（ステップＳ４−１２）。すなわち、各目標値を時間微分又は時間積分することにより、駆動輪回転角及び車体傾斜角速度の目標値を算出する。
【０１３６】
このように、本実施の形態においては、車両加速度に伴って車体に作用する慣性力及び駆動モータ反トルクだけでなく、段差抵抗トルクτD に応じた段差昇降トルクτC に伴って車体に作用する反トルクも考慮して、車体姿勢の目標値、すなわち、車体傾斜角の目標値を決定する。
【０１３７】
このとき、車体傾斜トルクを重力の作用によって打ち消すように、車体の重心を移動させる。例えば、車両１０が加速するとき及び段差を上るときには車体を前方へ傾ける。また、車両１０が減速するとき及び段差を下るときには車体を後方へ傾ける。
【０１３８】
なお、本実施の形態においては、線形化した力学モデルに基づいた式を使用しているが、より正確な非線形モデル又は粘性抵抗を考慮したモデルに基づいた式を使用してもよい。なお、式が非線形になる場合には、マップの形式で関数を適用することもできる。
【０１３９】
次に、アクチュエータ出力の決定処理について説明する。
【０１４０】
図１７は本発明の第２の実施の形態におけるアクチュエータ出力の決定処理の動作を示すフローチャートである。
【０１４１】
アクチュエータ出力の決定処理において、主制御ＥＣＵ２１は、まず、アクチュエータのフィードフォワード出力を決定する（ステップＳ５−１１）。この場合、目標値と段差昇降トルクτC とから、前記第１の実施の形態において説明した前記式（４）により駆動モータ５２のフィードフォワード出力を決定する。
【０１４２】
前記式（４）に表されるように、段差抵抗トルクτD に応じた段差昇降トルクτC を自動的に追加することにより、段差の昇降の際にも、平地と同様の操縦感覚を提供することができる。すなわち、平地と同様の操縦操作で段差を乗り降りすることができる。また、ジョイスティック３１の一定の操縦操作に対して、段差の昇降の際に、車両１０が不必要に加減速することがない。
【０１４３】
なお、本実施の形態においては、理論的にフィードフォワード出力を与えることによって、より高精度な制御を実現するが、必要に応じて、フィードフォワード出力を省略することもできる。この場合、フィードバック制御により、定常偏差を伴いつつ、フィードフォワード出力に近い値が間接的に与えられる。また、前記定常偏差は、積分ゲインを適用することによって低減させることができる。
【０１４４】
続いて、主制御ＥＣＵ２１は、アクチュエータのフィードバック出力を決定する（ステップＳ５−１２）。この場合、各目標値と実際の状態量との偏差から、次の式（１０）により駆動モータ５２のフィードバック出力を決定する。
【０１４５】
【数９】
0005061943.tif 000012
【０１４６】
なお、スライディングモード制御等の非線形のフィードバック制御を導入することもできる。また、より簡単な制御として、ＫW2及びＫW3を除くフィードバックゲインのいくつかをゼロとしてもよい。さらに、定常偏差をなくすために、積分ゲインを導入してもよい。
【０１４７】
最後に、主制御ＥＣＵ２１は、要素制御システムに指令値を与える（ステップＳ５−１３）。この場合、主制御ＥＣＵ２１は、前述のように決定したフィードフォワード出力とフィードバック出力との和を駆動トルク指令値として、駆動輪制御ＥＣＵ２２に送信する。
【０１４８】
このように、本実施の形態においては、車体を段差の上段方向に傾けて、段差の昇降の際にバランスを保つことができる。したがって、搭乗部１４を移動させる移動機構を有していない倒立型車両に適用することができ、構造及び制御システムを簡素化することで、安価で軽量な倒立型車両でも安定した段差の乗り降りを実現することができる。
【０１４９】
次に、本発明の第３の実施の形態について説明する。なお、第１及び第２の実施の形態と同じ構造を有するものについては、同じ符号を付与することによってその説明を省略する。また、前記第１及び第２の実施の形態と同じ動作及び同じ効果についても、その説明を省略する。
【０１５０】
図１８は本発明の第３の実施の形態における車両の構成を示す概略図であり段差手前で段差を検出している状態を示す図、図１９は本発明の第３の実施の形態における車両の段差の昇降における動作を示す概略図、図２０は本発明の第３の実施の形態における車両の制御システムの構成を示すブロック図である。なお、図１８において、（ｂ）は（ａ）の要部拡大図、図１９において、（ａ）〜（ｃ）は一連の動作を示す図である。
【０１５１】
段差の昇降動作中に一定の駆動トルクを駆動輪１２に付与すると、昇降終了直前に、車両１０が不必要に加減速してしまうことがある。これは、例えば、段差に乗り上げる場合、車両１０が段差を上るのと共に段差抵抗トルクが小さくなるためである。
【０１５２】
そこで、本実施の形態においては、車両１０の進行方向の段差をセンサによって検出し、該センサによって計測した段差の位置と高さ、及び、段差の昇降状態に相当する駆動輪回転角に応じて、段差昇降トルクを変化させるようになっている。
【０１５３】
そのため、本実施の形態において、車両１０は、図１８に示されるように、段差計測センサとしての距離センサ７１を有する。該距離センサ７１は、例えば、レーザ光を利用したものであるが、いかなる種類のセンサであってもよい。図１８に示される例においては、２つの距離センサ７１が、互いに前後に離れて、搭乗部１４の下面に配設され、各々が下面から路面までの距離を計測する。そして、各距離センサ７１の計測値の変化から、路面の段差を検出し、検出した段差の位置及び高さを取得することができる。望ましくは、一方の距離センサ７１が駆動輪１２の路面に接地する部位よりも前方に位置し、他方の距離センサ７１が駆動輪１２の路面に接地する部位よりも後方に位置するように配設される。このように、２つの距離センサ７１が駆動輪１２の接地点から前後に離れた位置において路面までの距離を計測するので、車両１０の前後の段差を検出することができる。
【０１５４】
また、車両１０は、図２０に示されるように、距離センサ７１を含む段差計測システム７０を有する。そして、距離センサ７１は、前後の２点において、路面までの距離としての対地距離を検出して主制御ＥＣＵ２１に送信する。
【０１５５】
これにより、例えば、段差に乗り上げる場合、図１９に示されるように、車両１０が上昇するのに応じて搭乗部１４の移動量、段差に乗り上げるための駆動トルク等を変化させ、安定した車体姿勢及び走行の制御を行うことができる。
【０１５６】
次に、本実施の形態における走行及び姿勢制御処理の詳細について説明する。なお、走行及び姿勢制御処理の概要、状態量の取得処理、目標走行状態の決定処理、目標車体姿勢の決定処理及びアクチュエータ出力の決定処理については、前記第１の実施の形態と同様であるので、説明を省略し、段差昇降トルクの決定処理についてのみ説明する。
【０１５７】
図２１は本発明の第３の実施の形態における上りの段差を測定するときの幾何学的条件を示す図、図２２は本発明の第３の実施の形態における上りの段差の段差昇降抵抗率の変化を示す図、図２３は本発明の第３の実施の形態における下りの段差を測定するときの幾何学的条件を示す図、図２４は本発明の第３の実施の形態における下りの段差の段差昇降抵抗率の変化を示す図、図２５は本発明の第３の実施の形態における段差昇降トルクの決定処理の動作を示すフローチャートである。
【０１５８】
段差昇降トルクの決定処理において、主制御ＥＣＵ２１は、まず、距離センサ７１の計測値を取得する（ステップＳ２−２１）。この場合、前後２つの距離センサ７１から対地距離の計測値を取得する。
【０１５９】
続いて、主制御ＥＣＵ２１は、段差の位置と高さとを決定する（ステップＳ２−２２）。この場合、各距離センサ７１から取得した対地距離の時間履歴と、車体傾斜角θ1 と、搭乗部１４の位置、すなわち、能動重量部位置λS とに基づき、段差の位置と高さとを決定する。
【０１６０】
続いて、主制御ＥＣＵ２１は、段差抵抗トルクτD を決定する（ステップＳ２−２３）。この場合、段差抵抗トルクτD を、次の式（１１）により算出する。
τD ＝ξτD,Max   ・・・式（１１）
ここで、τD,Max は最大段差抵抗トルクであり、ξは段差昇降抵抗率である。
【０１６１】
図２１に示されるように、段差が上り、すなわち、昇段である場合、最大段差抵抗トルクτD,Max 及び段差昇降抵抗率ξは、次の式（１２）及び（１３）で表される。なお、図２１において、Ｘは段差検出時における段差までの距離であり、Ｈは段差の高さである。昇段の場合、Ｈはゼロ以上となる。
【０１６２】
【数１０】
0005061943.tif 000013
【０１６３】
なお、η0 は、仮想登坂角であり、段差を上るために必要な駆動輪回転角に相当する。また、θW,S は駆動輪１２が段差に接触した時点の駆動輪回転角であり、θW,0 は段差を検出した時点の駆動輪回転角である。さらに、ΔθW は段差接触以降の駆動輪回転角であり、その値は、駆動輪１２が段差に接触した時点でゼロになる。
【０１６４】
そして、段差抵抗トルクτD の値は、図２２に示されるように変化する。すなわち、駆動輪１２が段差に接触した時点で最大値であるτD,Max となり、昇段中に徐々に減少し、昇段を終了した時点で最小値であるゼロになる。
【０１６５】
また、図２３に示されるように、段差が下り、すなわち、降段である場合、最大段差抵抗トルクτD,Max 及び段差昇降抵抗率ξは、次の式（１４）及び（１５）で表される。なお、図２３においても、Ｘは段差検出時における段差までの距離であり、Ｈは段差の高さであるが、降段の場合、Ｈはゼロ未満、すなわち、マイナスとなる。
【０１６６】
【数１１】
0005061943.tif 000014
【０１６７】
そして、段差抵抗トルクτD の値は、図２４に示されるように変化する。すなわち、駆動輪１２が段差に接触した時点で最小値であるゼロであり、降段中に徐々に減少し、降段を終了する時点の直前で最大値であるτD,Max となる。
【０１６８】
最後に、主制御ＥＣＵ２１は、段差昇降トルクτC を決定する（ステップＳ２−２４）。この場合、推定した段差抵抗トルクτD の値を段差昇降トルクτC の値とする。すなわち、τC ＝τD とする。
【０１６９】
このように、段差昇降トルクの決定処理においては、段差の高さＨに応じて段差抵抗トルクτD の大きさを変えるようになっている。つまり、段差の高さＨの値が大きいほど段差抵抗トルクτD の値を大きくする。
【０１７０】
また、車両１０の段差昇降状態に応じて段差抵抗トルクτD の大きさを変えるようになっている。つまり、駆動輪回転角θW から車両１０の昇降状態を推定し、段差昇降抵抗率ξの値を変化させる。これにより、車両１０の速度変化にも対応することができる。
【０１７１】
具体的には、段差を上る場合、すなわち、段差の高さＨがゼロ以上の場合、駆動輪回転角θW の増加とともに、段差抵抗トルクτD （段差昇降抵抗率ξ）を減少させる。これは、段差を上るにつれて、車両１０を支持するために必要な駆動トルクが減少するからである。
【０１７２】
一方、段差を下る場合、すなわち、段差の高さＨがゼロ未満の場合、駆動輪回転角θW の増加とともに、段差抵抗トルクτD （段差昇降抵抗率ξ）を増加させる。これは、段差を下るにつれて、車両１０を支持するために必要な駆動トルクが増加するからである。
【０１７３】
これにより、段差昇降時における車両１０の走行状態を安定的に制御することができる。
【０１７４】
なお、本実施の形態においては、車両１０の前方に位置する段差に前進して突入した場合についてのみ説明したが、車両１０の後方に位置する段差に後進して突入した場合についても、同様の制御を実施することができる。
【０１７５】
また、本実施の形態においては、段差の昇降動作中に距離センサ７１を使用しない場合について説明したが、車両１０の段差昇降状態をより正確に把握するために、距離センサ７１の計測値を利用することもできる。これにより、駆動輪１２がスリップしても安定した制御を行うことが可能となる。
【０１７６】
さらに、本実施の形態においては、段差昇降抵抗率ξの決定式に不連続な関数を使用した場合について説明したが、不連続部分を連続に修正した関数を使用することもできる。また、不連続部分における制御のチャタリング又は車両動作のハンチングを防止するために、ヒステリシス制御（例えば、２つの閾（しきい）値を設定し、駆動輪１２の回転方向に応じて閾値を変える制御）を導入してもよい。
【０１７７】
さらに、本実施の形態においては、非線形の力学モデルに基づく決定式を使用した場合について説明したが、簡略化のために、線形近似した式を使用してもよい。また、駆動輪１２の変形、転がり摩擦、スリップ条件等を考慮した、より高度な決定式を使用してもよい。
【０１７８】
このように、本実施の形態においては、車両１０の進行方向の段差を距離センサ７１によって検出し、該距離センサ７１によって計測した段差の位置及び高さＨ並びに駆動輪回転角θW に応じて、段差昇降トルクτC の値を変化させるようになっている。したがって、段差の昇降時にも車体の倒立姿勢を安定に保つことができる。これにより、車両１０は、段差のある場所でも安全に、かつ、快適に走行することができる。
【０１７９】
なお、本実施の形態においては、２つの距離センサ７１によって段差の検出、並びに、段差の位置及び高さＨを計測した場合について説明したが、他の装置や方法を使用することもできる。例えば、カメラによって車両１０の進行方向の画像を取得し、取得した画像を解析することによって、段差の検出、並びに、段差の位置及び高さＨを計測してもよい。また、例えば、ＧＰＳ（Ｇｌｏｂａｌ  Ｐｏｓｉｔｉｏｎｉｎｇ  Ｓｙｓｔｅｍ）を利用して車両１０の位置を取得する車両位置取得システムと、路面と段差に関する情報を含む地図データとに基づいて、車両１０の周囲に存在する段差の情報を取得してもよい。
【０１８０】
次に、本発明の第４の実施の形態について説明する。なお、第１〜第３の実施の形態と同じ構造を有するものについては、同じ符号を付与することによってその説明を省略する。また、前記第１〜第３の実施の形態と同じ動作及び同じ効果についても、その説明を省略する。
【０１８１】
図２６は本発明の第４の実施の形態における搭乗意図推定マップ、すなわち、車両加速度の目標値及び駆動輪回転角速度の閾値を示す図、図２７は本発明の第４の実施の形態における車両の走行及び姿勢制御処理の動作を示すフローチャート、図２８は本発明の第４の実施の形態における段差昇降トルクの決定処理の動作を示すフローチャートである。
【０１８２】
次の（ａ）〜（ｃ）のような場合には、段差を昇降するための駆動トルクを追加する制御動作（以下「段差昇降制御」と称する。）を禁止する方が、すなわち、実行しない方が適切である。
（ａ）駆動輪１２が上がり段差に接触した状態で車両１０が停止し、乗員１５もジョイスティック３１を操作していない場合：この場合、乗員１５の操縦意図は、車両１０が停止した状態を維持すること、である可能性が高い。
（ｂ）比較的低い車両速度で駆動輪１２が上がり段差に接触し、乗員１５がジョイスティック３１の操作による走行指令として制動を入力した場合：この場合、乗員１５の操縦意図は、車両１０を段差に接触させて止めること、である可能性が高い。
（ｃ）乗員１５がジョイスティック３１の操作による走行指令として急制動を入力した場合：この場合、乗員１５の操縦意図は、車両１０を段差に接触させて止めること、又は、少しでも短い制動距離で車両を止めること、である可能性が高い。
【０１８３】
また、次の（ｄ）及び（ｅ）のような場合には、段差昇降制御を実行した方が適切である。
（ｄ）比較的高い車両速度で駆動輪１２が上がり段差に接触し、乗員１５がジョイスティック３１を操作して走行指令として制動を入力した場合：この場合、乗員１５は、車両１０を段差に接触させて止めることはできないことを認識している、又は、段差通過後に車両を止めることを意図している可能性が高い。
（ｅ）車両１０が下がり段差に進入した場合：この場合、段差を昇降するための駆動トルクを追加しないと、段差から着地したときに衝撃を受け、乗員１５は不快に感じる可能性が高い。
【０１８４】
そこで、本実施の形態においては、車両１０の走行状態と走行指令とに基づいて乗員１５の操縦意図を推定し、推定された操縦意図に従って段差昇降制御の実行又は禁止を選択する。すなわち、車両制御装置としての制御ＥＣＵ２０は、乗員１５の操縦意図を推定する操縦意図推定手段を備え、推定された操縦意図に従って段差昇降制御の実行又は禁止を選択する。具体的には、前記操縦意図推定手段は、車両１０の走行状態としての車両速度（駆動輪回転角速度）、走行指令としてジョイスティック３１の操作量に応じて決定される車両加速度の目標値、及び、段差の高さに相当する段差抵抗トルクを考慮して乗員１５の操縦意図を推定し、段差昇降制御の実行又は禁止を選択する。
【０１８５】
そして、操縦意図推定手段は、上がり段差への進入時、車両速度及び車両加速度の目標値が所定の条件を満たしている場合、操縦意図は段差昇降制御の禁止であると推定し、車両速度及び車両加速度の目標値が所定の条件を満たしていない場合、操縦意図は段差昇降制御の実行であると推定する。
【０１８６】
より詳細には、車両１０が停止状態にあり、車両加速度の目標値がゼロである場合又は停止を指令する値である場合には、段差昇降制御を実行しない。また、比較的低い車両速度で上がり段差に進入し、車両加速度の目標値が制動を指令する値である場合には、段差昇降制御を実行しない。一方、比較的高い車両速度で上がり段差に進入する場合、車両加速度の目標値が制動を指令する値であっても、段差昇降制御を実行する。また、車両加速度の目標値が急制動を指令する値である場合には、車両速度が高くても段差昇降制御を実行しない。さらに、下がり段差への進入時においては、車両速度や車両加速度の目標値に係わらず、段差昇降制御を実行する。
【０１８７】
これにより、乗員１５の操縦意図を的確に推定して、段差昇降制御を適切に実行することができる。したがって、段差が存在しても、乗員１５が意のままに操縦することができる倒立型車両を提供することができる。
【０１８８】
次に、本実施の形態における走行及び姿勢制御処理の概要について説明する。
【０１８９】
走行及び姿勢制御処理において、主制御ＥＣＵ２１は、まず、車両１０の動作状態を示す状態量の取得処理を実行し（ステップＳ１１）、各センサ、すなわち、駆動輪センサ５１、車体傾斜センサ４１及び能動重量部センサ６１によって、駆動輪１２の回転状態、車体の傾斜状態及び搭乗部１４の移動状態を取得する。
【０１９０】
次に、制御ＥＣＵ２０は、目標走行状態の決定処理を実行し（ステップＳ１２）、ジョイスティック３１の操作量に基づいて、車両１０の加速度の目標値、及び、駆動輪１２の回転角速度の目標値を決定する。
【０１９１】
次に、制御ＥＣＵ２０は、段差昇降トルクの決定処理を実行し（ステップＳ１３）、状態量の取得処理で取得した状態量、すなわち、駆動輪１２の回転状態、車体の傾斜状態及び搭乗部１４の移動状態と、各アクチュエータの出力値、すなわち、駆動モータ５２及び／又は能動重量部モータ６２の出力値とに基づき、オブザーバによって段差抵抗トルクを推定し、さらに、目標走行状態の決定処理で決定した車両１０の加速度の目標値、駆動輪１２の回転角速度等に基づき、段差昇降トルクを決定する。
【０１９２】
次に、制御ＥＣＵ２０は、目標車体姿勢の決定処理を実行し（ステップＳ１４）、段差昇降トルクの決定処理によって決定された段差昇降トルクと、目標走行状態の決定処理によって決定された車両１０の加速度の目標値とに基づいて、車体姿勢の目標値、すなわち、車体傾斜角及び能動重量部位置の目標値を決定する。
【０１９３】
最後に、制御ＥＣＵ２０は、アクチュエータ出力の決定処理を実行し（ステップＳ１５）、状態量の取得処理によって取得された各状態量、段差昇降トルクの決定処理によって決定された段差昇降トルク、目標走行状態の決定処理によって決定された目標走行状態、及び、目標車体姿勢の決定処理によって決定された目標車体姿勢に基づいて、各アクチュエータの出力、すなわち、駆動モータ５２及び能動重量部モータ６２の出力を決定する。
【０１９４】
次に、本実施の形態における段差昇降トルクの決定処理の詳細について説明する。なお、状態量の取得処理、目標走行状態の決定処理、目標車体姿勢の決定処理及びアクチュエータ出力の決定処理については、前記第１の実施の形態と同様であるので、説明を省略する。
【０１９５】
段差昇降トルクの決定処理において、主制御ＥＣＵ２１は、まず、段差抵抗トルクτD を推定する（ステップＳ１３−１）。この場合、前記第１の実施の形態と同様に、状態量の取得処理で取得した各状態量と、前回（一つ前の時間ステップ）の走行及び姿勢制御処理におけるアクチュエータ出力の決定処理で決定した各アクチュエータの出力とに基づき、前記式（１）により、段差抵抗トルクτD を推定する。
【０１９６】
続いて、主制御ＥＣＵ２１は、段差昇降トルクτC を決定する（ステップＳ１３−２）。この場合、段差抵抗トルクτD と、車両加速度の目標値と、駆動輪回転角速度とに基づき、次の式（１６）により、段差昇降トルクτC を決定する。
τC ＝ρτD   ・・・式（１６）
ここで、ρは、段差昇降トルク率であり、次の式（１７）で表される。
【０１９７】
【数１２】
0005061943.tif 000015
【０１９８】
【数１３】
0005061943.tif 000016
【０１９９】
【数１４】
0005061943.tif 000017
【０２００】
【数１５】
0005061943.tif 000018
【０２０１】
【数１６】
0005061943.tif 000019
【０２０２】
【数１７】
0005061943.tif 000020
【０２０３】
このように、主制御ＥＣＵ２１は、乗員１５が段差を上がることを望んでいない、すなわち、操縦意図が段差昇降制御の不実行である、と推定した場合には、段差昇降制御を禁止する、すなわち、実行しない。
【０２０４】
具体的には、乗員１５によるジョイスティック３１の操作量によって決定される車両加速度の目標値と、車両１０の動作状態を示す駆動輪回転角速度と、段差の高さに相当する段差抵抗トルクの推定値とに基づいて、乗員１５が車両１０の段差乗り上げを望んでいるか否かを判断する。
【０２０５】
この場合、段差抵抗トルクの推定値に段差昇降トルク率を乗じることによって、段差昇降制御の実行と不実行とを切り替える。また、段差昇降トルク率指定値にローパスフィルタをかけることによって、段差昇降制御の実行と不実行との滑らかな切替を実現する。これにより、乗員１５の操縦意図を適切に判断することができ、乗員１５が車両の段差乗り上げを望んでいる場合のみ、段差昇降制御を実行する。
【０２０６】
車両１０が停止した状態で、乗員１５が車両加速度の目標値の入力に対応する操縦操作を行わない場合、段差昇降制御を実行しない。この場合は、前記（ａ）の場合に相当し、図２６の操縦意図判定マップにおいて、駆動輪角速度と目標車両加速度の条件に相当する点が、原点を含む長方形のハッチングされた領域の中に存在する。すなわち、駆動輪回転角速度の絶対値が所定の駆動輪回転角速度第１閾値以下であり、かつ、車両加速度の目標値の絶対値が所定の目標車両加速度第１閾値以下であるという条件を満足する場合である。この場合には、乗員１５が車両１０の段差昇降を望んでいないと判断し、操縦意図判定値を０とする。これにより、駆動輪１２が上がり段差に接触した状態で車両１０が停止しているときには、車両１０の停止状態を安定に保ち、乗員１５が意図しない段差乗り上げを防止することができる。
【０２０７】
また、車両１０の段差進入速度が低く、乗員１５が走行指令として制動を入力した場合、すなわち、制動を要求している場合、段差昇降制御を実行しない。この場合は、前記（ｂ）の場合に相当し、図２６の操縦意図判定マップにおいて、駆動輪角速度と目標車両加速度の条件に相当する点が、前記原点を含む長方形の右隣及び左隣のハッチングされた領域の中に存在する。すなわち、段差に進入する方向について、駆動輪回転角速度が駆動輪回転角速度第２閾値以下であり、かつ、車両加速度の目標値の絶対値が零以下であるという条件を満足する場合である。
【０２０８】
この場合には、乗員１５が段差を利用した車両１０の制動及び停止を望んでいると判断し、操縦意図判定値を０とする。なお、前記右隣及び左隣のハッチングされた領域は、駆動輪回転角速度が駆動輪回転角速度第１閾値より高く駆動輪回転角速度第２閾値以下である範囲において、目標車両加速度上限閾値を目標車両加速度第１閾値からゼロに線形に減少させることによって設けられた、乗員１５の微小な加速度要求に対して操縦意図判定値を０とする領域を含む。これにより、駆動輪１２を段差に接触させて車両１０を停止させる動作や段差の乗り上げによって減速させる動作を意図した乗員１５による操縦操作を適切に判断して、前記動作を容易に実現させることができる。
【０２０９】
さらに、車両１０の段差進入速度が高く、乗員１５が走行指令として緩やかな制動を入力した場合、すなわち、緩やかな制動を要求している場合、段差昇降制御を実行する。この場合は、前記（ｄ）の場合に相当し、図２６の操縦意図判定マップにおいて、駆動輪角速度と目標車両加速度の条件に相当する点が、前記右隣のハッチングされた領域のさらに右側に存在する車両加速度の目標値が負のハッチングされていない領域、又は、前記左隣のハッチングされた領域のさらに左側に存在する車両加速度の目標値が負のハッチングされていない領域の中に存在する。すなわち、段差に進入する方向について、駆動輪回転角速度が駆動輪回転角速度第２閾値より高く、かつ、車両加速度の目標値が負の目標車両加速度上限閾値より大きいという条件を満足する場合である。
【０２１０】
この場合には、乗員１５が段差の乗り上げを意図している又は許容していると判断し、操縦意図判定値を１とする。なお、前記車両加速度の目標値が負のハッチングされていない領域は、駆動輪回転角速度が駆動輪回転角速度第２閾値より高い範囲において、目標車両加速度上限閾値をゼロから、目標車両加速度第２閾値に漸近するような指数関数によって減少させることで設けられた領域である。つまり、乗員１５の要求する目標減速度が大きいほど、段差昇降制御を実行する閾値、すなわち、操縦意図判定値を１とする駆動輪回転角速度の閾値を大きくするようになっている。これにより、車両速度が高いほど、段差に乗り上げた後に車両１０を停止させる動作を意図していると判定することで、乗員１５による操縦操作を適切に判断して、前記動作を容易にかつ安定に実現させることができる。
【０２１１】
さらに、乗り上げる段差が高いほど、段差昇降制御を実行するための車両速度の閾値を高くする。すなわち、段差抵抗トルクの推定値が大きいほど、高速走行時に操縦意図判定値を切り替えるための閾値である駆動輪回転角速度第２閾値を高くし、高い段差に対する車両１０の不自然な乗り上げを防止する。加えて、駆動輪回転角速度第２閾値を、車両１０が慣性で（駆動トルクを用いることなく）段差に乗り上げることができる最低限の車両速度である段差慣性乗り上げの最低駆動輪回転角速度に基づいて決定することによって、より自然な車両１０の動作を実現する。これにより、段差の高さを考慮した乗員１５の操縦意図をより適切に判断して、その動作を容易に実現させることができる。
【０２１２】
さらに、乗員１５が急制動を要求している場合、車両１０の段差進入速度に係わらず、段差昇降制御を実行しない。この場合は、前記（ｃ）の場合に相当し、図２６の操縦意図判定マップにおいて、駆動輪角速度と目標車両加速度の条件に相当する点が、二本の一点鎖線よりも外側にあるハッチングされた領域の中に存在する。すなわち、段差に進入する方向について、駆動輪回転角速度が駆動輪回転角速度第１閾値より高く、かつ、車両加速度の目標値が負の目標車両加速度第２閾値よりも低いという条件を満足する場合である。
【０２１３】
この場合、操縦意図判定値をゼロとし、駆動トルクを追加する段差昇降制御を実行しない。これにより、車両１０の急制動、又は、段差に乗り上げることを拒否する乗員１５の操縦意図を適切に判断して、その動作の実現を助けるような制御を実行することができる。
【０２１４】
さらに、段差を下りる場合には、必ず段差昇降制御を実行する。この場合は、前記（ｅ）の場合に相当する。すなわち、駆動輪回転角速度の正負と段差抵抗トルクの正負とが異なる場合には、車両１０が段差を下りる状態にあると判断し、段差昇降トルク率指定値を１とする。この場合、段差を下りることに伴う車両加速度増加を利用するよりも、段差を下りる際に発生する衝撃を緩和することを優先することで、乗り心地を向上させることができる。
【０２１５】
なお、本実施の形態においては、段差昇降トルク率指定値にローパスフィルタをかけることによって、段差昇降制御の実行と不実行との切替を滑らかにする例について説明したが、切替の滑らかさよりも応答性を重視するのであれば、段差昇降トルク率指定値にローパスフィルタをかけなくてもよい。また、図２６の操縦意図判定マップにおいて曲線で示されるような車両加速度の目標値と駆動輪回転角速度との関数である目標車両加速度上限閾値及び目標車両加速度下限閾値に遷移帯を設けてもよい。すなわち、図２６において、段差昇降トルク率指定値を０から１に切り替える曲線を所定の幅を備える帯域に置き換え、該帯域の中で段差昇降トルク率指定値を０から１に線形に変化させてもよい。これにより、切替時の滑らかさと、乗員１５の操作量の変化に対する応答性とを、ある程度両立させることができる。
【０２１６】
また、本実施の形態においては、前方の上がり段差接触時における制動要求に対して禁止した段差昇降制御が、車両１０が停止する直前に、一時的に、再実行される場合がある。例えば、駆動輪回転角速度が駆動輪回転角速度第１閾値より高く駆動輪回転角速度第２閾値以下であるという条件を満たす状態において、車両加速度の目標値を負の目標車両加速度第１閾値より低い一定値に維持すると、駆動輪回転角速度が駆動輪回転角速度第１閾値を下回ったときに、段差昇降トルク率指定値を０から１に変化する。そこで、このような問題を解決するために、車両加速度の目標値と駆動輪回転角速度とが変化する方向も考慮して、段差昇降トルク率指定値を決定してもよい。例えば、駆動輪回転角速度がゼロより高く駆動輪回転角速度第１閾値以下であり、かつ、車両加速度の目標値が負の目標車両加速度第１閾値より低い領域内に、車両加速度の目標値が変化することによって入った場合には段差昇降トルク率指定値を０から１に切り替えるが、駆動輪回転角速度が変化することによって入った場合には段差昇降トルク率指定値をゼロに維持するようにして、不必要な段差昇降制御の再実行を防止することができる。
【０２１７】
さらに、本実施の形態においては、駆動輪回転角速度の計測値に基づいて段差昇降制御の実行と禁止とを切り替える例について説明したが、駆動輪回転角速度の目標値に基づいて段差昇降制御の実行と禁止とを切り替えてもよい。これにより、外乱等に伴う駆動輪回転角速度の微小振動が段差昇降制御の実行と禁止との切替に影響を及ぼすことを防止し、より安定した段差昇降制御を実現することができる。
【０２１８】
さらに、本実施の形態においては、車両加速度の目標値の閾値の一部や段差慣性乗り上げの最低駆動輪回転角速度を決定するために非線形の関数を用いた例について説明したが、該非線形の関数を近似した線形の関数を用いることによって計算を簡素化してもよい。また、マップの形で非線形の関数を適用してもよい。
【０２１９】
さらに、本実施の形態においては、様々な乗員１５の操縦意図を想定して段差昇降制御の実行と禁止とを切り替える例について説明したが、車両１０を使用する用途、条件等によって、いくつかの切替を除いてもよい。例えば、低速での走行しか行わない場合には、高速での段差進入時における段差昇降制御を実行せず、制動要求時には常に段差昇降制御を禁止するようにしてもよい。
【０２２０】
さらに、本実施の形態においては、段差抵抗トルクの推定値によって段差の上下及び高さを推定し、その値に基づいて段差昇降制御の実行と禁止とを切り替える例について説明したが、前記第３の実施の形態において説明したように、距離センサ７１等の段差計測センサを使用し、該段差計測センサの計測結果に基づいて段差昇降制御の実行と禁止とを切り替えてもよい。
【０２２１】
さらに、本実施の形態においては、乗員１５によるジョイスティック３１の操作量に対応する車両加速度の目標値に基づいて乗員１５の操縦意図を推定する例について説明したが、ジョイスティック３１の操作量が車両速度の目標値に対応している場合には、車両加速度の目標値を車両速度の目標値に置き換えてもよいし、車両速度の目標値の時間差分に置き換えてもよい。また、ジョイスティック３１の操作量自体に基づいて乗員１５の操縦意図を推定してもよい。例えば、車両１０に操縦装置としてアクセルペダル及びブレーキペダルを配設し、各ペダルの踏み込み量と駆動輪回転角速度とに基づいて、段差昇降制御の実行と禁止とを切り替えてもよい。さらに、走行状態と停止状態とを乗員１５が切り替えるスイッチを車両１０に配設し、該スイッチの操作状態によって、車両停止時の段差昇降制御の禁止を選択してもよい。
【０２２２】
なお、本発明は前記実施の形態に限定されるものではなく、本発明の趣旨に基づいて種々変形させることが可能であり、それらを本発明の範囲から排除するものではない。
【図面の簡単な説明】
【０２２３】
【図１】本発明の第１の実施の形態における車両の構成を示す概略図であり乗員が搭乗した状態で加速前進している状態を示す図である。
【図２】本発明の第１の実施の形態における車両の制御システムの構成を示すブロック図である。
【図３】本発明の第１の実施の形態における車両の段差昇降動作を示す概略図である。
【図４】本発明の第１の実施の形態における車両の走行及び姿勢制御処理の動作を示すフローチャートである。
【図５】本発明の第１の実施の形態における車両の力学モデル及びそのパラメータを示す図である。
【図６】本発明の第１の実施の形態における状態量の取得処理の動作を示すフローチャートである。
【図７】本発明の第１の実施の形態における段差昇降トルクの決定処理の動作を示すフローチャートである。
【図８】本発明の第１の実施の形態における目標走行状態の決定処理の動作を示すフローチャートである。
【図９】本発明の第１の実施の形態における能動重量部位置の目標値及び車体傾斜角の目標値の変化を示すグラフである。
【図１０】本発明の第１の実施の形態における目標車体姿勢の決定処理の動作を示すフローチャートである。
【図１１】本発明の第１の実施の形態におけるアクチュエータ出力の決定処理の動作を示すフローチャートである。
【図１２】本発明の第２の実施の形態における車両の制御システムの構成を示すブロック図である。
【図１３】本発明の第２の実施の形態における車両の段差の昇降における動作を示す概略図である。
【図１４】本発明の第２の実施の形態における状態量の取得処理の動作を示すフローチャートである。
【図１５】本発明の第２の実施の形態における段差昇降トルクの決定処理の動作を示すフローチャートである。
【図１６】本発明の第２の実施の形態における目標車体姿勢の決定処理の動作を示すフローチャートである。
【図１７】本発明の第２の実施の形態におけるアクチュエータ出力の決定処理の動作を示すフローチャートである。
【図１８】本発明の第３の実施の形態における車両の構成を示す概略図であり段差手前で段差を検出している状態を示す図である。
【図１９】本発明の第３の実施の形態における車両の段差の昇降における動作を示す概略図である。
【図２０】本発明の第３の実施の形態における車両の制御システムの構成を示すブロック図である。
【図２１】本発明の第３の実施の形態における上りの段差を測定するときの幾何学的条件を示す図である。
【図２２】本発明の第３の実施の形態における上りの段差の段差昇降抵抗率の変化を示す図である。
【図２３】本発明の第３の実施の形態における下りの段差を測定するときの幾何学的条件を示す図である。
【図２４】本発明の第３の実施の形態における下りの段差の段差昇降抵抗率の変化を示す図である。
【図２５】本発明の第３の実施の形態における段差昇降トルクの決定処理の動作を示すフローチャートである。
【図２６】本発明の第４の実施の形態における搭乗意図推定マップ、すなわち、車両加速度の目標値及び駆動輪回転角速度の閾値を示す図である。
【図２７】本発明の第４の実施の形態における車両の走行及び姿勢制御処理の動作を示すフローチャートである。
【図２８】本発明の第４の実施の形態における段差昇降トルクの決定処理の動作を示すフローチャートである。
【符号の説明】
【０２２４】
１０    車両
１２    駆動輪
２０    制御ＥＣＵ
３０    入力装置
【図１】
0005061943.tif 000021
【図２】
0005061943.tif 000022
【図３】
0005061943.tif 000023
【図４】
0005061943.tif 000024
【図５】
0005061943.tif 000025
【図６】
0005061943.tif 000026
【図７】
0005061943.tif 000027
【図８】
0005061943.tif 000028
【図９】
0005061943.tif 000029
【図１０】
0005061943.tif 000030
【図１１】
0005061943.tif 000031
【図１２】
0005061943.tif 000032
【図１３】
0005061943.tif 000033
【図１４】
0005061943.tif 000034
【図１５】
0005061943.tif 000035
【図１６】
0005061943.tif 000036
【図１７】
0005061943.tif 000037
【図１８】
0005061943.tif 000038
【図１９】
0005061943.tif 000039
【図２０】
0005061943.tif 000040
【図２１】
0005061943.tif 000041
【図２２】
0005061943.tif 000042
【図２３】
0005061943.tif 000043
【図２４】
0005061943.tif 000044
【図２５】
0005061943.tif 000045
【図２６】
0005061943.tif 000046
【図２７】
0005061943.tif 000047
【図２８】
0005061943.tif 000048