車両
【課題】車両の走行速度に依らず、いつ倒立制御を停止しても車体を安定した状態に維持することを可能とし、異常時における緊急停止に即時に対応することができ、高い走行性能や利便性を備え、かつ、安全に使用することができるようにとする。高い走行性能や利便性を備え、且つ、安全に使用することができるようにする。
【解決手段】車両制御装置は、車両の走行速度に応じて減速度の時間変化を予測する減速度予測手段と、減速度予測手段によって予測された減速度の時間変化に応じて、前記姿勢制限手段の位置や形状を制御する姿勢制限制御手段とを備える。
【解決手段】車両制御装置は、車両の走行速度に応じて減速度の時間変化を予測する減速度予測手段と、減速度予測手段によって予測された減速度の時間変化に応じて、前記姿勢制限手段の位置や形状を制御する姿勢制限制御手段とを備える。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、倒立振り子の姿勢制御を利用した車両に関するものである。
【背景技術】
【0002】
従来、倒立振り子の姿勢制御を利用した車両に関する技術が提案されている。例えば、同軸上に配設された2つの駆動輪を有し、乗員の重心移動による車体の姿勢変化を感知して駆動する車両、球体状の単一の駆動輪に取り付けられた車体の姿勢を制御しながら移動する車両等の技術が提案されている(例えば、特許文献1参照。)。
【0003】
この場合、センサで車体のバランスや動作の状態を検出しながら、倒立制御を行って、車両を移動させる。また、乗員が降車するときや車両の電源を遮断したときには、倒立制御を停止するのと同時にストッパを作動させ、該ストッパを接地させることによって車体の姿勢を維持するようになっている。
【先行技術文献】
【特許文献】
【0004】
【特許文献1】特開2004−291799号公報
【発明の概要】
【発明が解決しようとする課題】
【0005】
しかしながら、前記従来の車両においては、走行中に倒立制御を停止できない場合がある。例えば、ストッパの接地時に路面との摩擦力で車両が制動される場合、減速に伴って車両に作用する慣性力により接地荷重中心点が前方に移動し、安定性が低下する可能性がある。また、倒立制御の停止と共に、駆動輪に対して自動的にブレーキが作動する場合も同様である。
【0006】
このような場合の安全性を確実に保証するためには、非常停止時の減速度を軽減させる構造又は制御を用いればよいが、車両の緊急停止時のように急制動を必要とする場合には対応できない。また、車両の最高速度を制限する方法もあるが、利便性や快適性は損なわれる。あるいは、常に十分な安定領域を確保できるよう大きなストッパを装着した場合には、車両の小型化が困難になる。
【0007】
本発明は、前記従来の車両の問題点を解決して、倒立制御の実行時に、車両の走行速度に応じて倒立制御停止時における減速度の時間変化を予測し、該減速度の時間変化に基づいてストッパの形状等を制御し、倒立制御を停止する前にあらかじめ姿勢制限手段を適切な状態で待機させることによって、車両の走行速度に依らず、いつ倒立制御を停止しても車体を安定した状態に維持することを可能とし、高い走行性能や利便性を備え、且つ、安全に使用することができる車両を提供することを目的とする。
【課題を解決するための手段】
【0008】
そのために、本発明の車両においては、回転可能に車体に取り付けられた駆動輪と、前記車体の姿勢角度を制限する姿勢制限手段と、前記駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、車両の走行速度に応じて減速度を予測する減速度予測手段と、該減速度予測手段によって予測された減速度に応じて、前記姿勢制限手段の位置及び/又は形状を制御する姿勢制限制御手段とを備える。
【0009】
本発明の他の車両においては、さらに、前記減速度予測手段は、車両が停止するまでの時間である車両制動時間を予測し、前記車両制御装置は、前記姿勢制限手段が機能するまでの時間である車体傾斜時間を予測する傾斜時間予測手段を更に備え、前記姿勢制限制御手段は、前記減速度予測手段によって予測された前記車両制動時間と前記傾斜時間予測手段によって予測された前記車体傾斜時間に応じて、前記姿勢制限手段を制御する。
【0010】
本発明の更に他の車両においては、さらに、前記姿勢制限制御手段は、前記車両制動時間が前記車体傾斜時間よりも短い場合には、第1の状態に前記姿勢制限手段を制御し、前記車両制動時間が前記車体傾斜時間よりも長い場合には、第1の状態と異なる第2の状態に前記姿勢制限手段を制御する。
【0011】
本発明の更に他の車両においては、さらに、前記傾斜時間予測手段は、前記車体の姿勢角度に応じて前記車体傾斜時間を予測する。
【0012】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記減速度予測手段によって予測された減速度の時間変化から接地荷重中心点を予測する接地荷重中心点予測手段と、を更に備え、前記姿勢制限手段は、該接地荷重中心点予測手段によって予測された接地荷重中心点に応じて、前記姿勢制限手段を制御する。
【0013】
本発明の更に他の車両においては、さらに、前記姿勢制限手段は、路面に接地した状態で前記車体の姿勢を制限し、前記姿勢制限制御手段は、前記接地荷重中心点予測手段によって予測された接地荷重中心点の位置である第1の位置と、前記駆動輪が路面に接地する位置である第2の位置と、前記姿勢制限手段が路面に接地する位置である第3の位置について、前記第1の位置が前記第2の位置と前記第3の位置との間にあるように前記姿勢制限手段を制御する。
【0014】
本発明の更に他の車両においては、さらに、前記第2の位置と前記第3の位置から等しい距離にある第4の位置について、該第4の位置に対する前記第1の位置の相対位置を表す接地荷重偏心度を算出する接地荷重偏心度算出手段を更に備え、前記姿勢制限制御手段は、算出された接地荷重偏心度が所定範囲内になるように前記姿勢制限手段を制御する。
【0015】
本発明の更に他の車両においては、さらに、前記制限値制御手段は、前記車体の姿勢の制御が行われている時に前記姿勢制限手段を制御する。
【0016】
本発明の更に他の車両においては、さらに、前記車体の姿勢の制御の続行が可能か不可能かを判定する制御可能判定手段と、前記車体の姿勢の制御を続行するか停止するかを指令する信号を取得する制御指令取得手段と、を更に備え、前記車両制御装置は、前記制御可能判定手段が不可能と判定した時、又は、前記制御指令取得手段が停止を指令する信号を取得した時に、前記姿勢制限手段を固定する。
【0017】
本発明の更に他の車両においては、さらに、前記姿勢制限手段は、前記駆動輪の回転軸に平行で前記駆動輪に接する所定の平面である基準面について、前記車体の姿勢角度を固定したとき、常に前記基準面に分断されること無く、前記基準面に接した状態を維持したまま位置及び/又は形状を変化させる機構を備える。
【発明の効果】
【0018】
請求項1の構成によれば、車両の走行速度によって推定された減速度の時間変化に基づいて車体の安定性に及ぼす慣性の影響を考慮し、その影響を補償するように姿勢制限手段を制御することで、車両の走行状態及びその後の減速状態に依らず、車体姿勢を安定な状態に保つことができる。したがって、倒立制御停止時の安全性を憂慮することなく、高速で走行することができる。
【0019】
請求項2の構成によれば、姿勢制限手段が機能するまでの時間を考慮することで、減速度が車体姿勢の安定性に及ぼす影響を正確に評価し、必要に応じた姿勢制限手段の制御を実行できる。
【0020】
請求項3の構成によれば、姿勢制限手段機能後も減速状態が続いているか否か、すなわち、慣性力が安定性に影響するか否かを判断し、姿勢制限手段を各々の状態に適した状態に制御することで、確実に安全性を保障するのと共に、過剰な動作に伴うエネルギの浪費や部材の劣化、騒音等を低減させることができる。
【0021】
請求項4の構成によれば、倒立制御停止直前の車体傾斜角を考慮することで、その後の車体傾斜時間をより正確に予測することができる。
【0022】
請求項5の構成によれば、倒立制御停止時の車体姿勢の安定性を決定する要素である接地荷重中心点を予測し、その結果に基づいて姿勢制限手段を制御することで、確実に車体を安定化させることができる。
【0023】
請求項6の構成によれば、車体の力学的状態を厳密に考慮して安定性を予測した結果に基づいて姿勢制限手段を制御するため、より確実に車体を安定化させることができる。また、車体が傾斜して姿勢制限手段が接地した後に、車体が更に同じ方向に傾斜し続けることを防ぐのと共に、乗員の移動等に伴って車体が逆方向に傾斜することも防ぐことができる。
【0024】
請求項7の構成によれば、車体の力学的状態を厳密に、かつ、定量的に考慮して安定性を予測した結果に基づいて姿勢制限手段を制御するため、更に確実に車体を安定化させることができる。また、接地荷重偏心度の目標値を所定範囲内とすることで、安定な範囲内で細かく姿勢制限手段を制御するような不要な動作、及び、それに伴うエネルギの浪費や振動、騒音等を防ぐことができる。
【0025】
請求項8の構成によれば、姿勢制限手段を使用する前に、あらかじめ姿勢制限手段を適切な状態に設定することができる。
【0026】
請求項9の構成によれば、異常時における緊急停止や乗員による駐車要求等に即時且つ確実に対応することができる。また、姿勢制限手段を必要とする状態を容易に判断できるのと共に、倒立制御停止後における姿勢制限手段の誤動作を確実に防止できる。
【0027】
請求項10の構成によれば、姿勢制限手段の制御に依らず、車体傾斜角の最大値を一定に保つような機構を用いることで、車体傾斜による加減速や登降坂等の運動性能と高速走行時の安全性を両立させることができる。すなわち、安全で便利な倒立型車両を実現できる。
【図面の簡単な説明】
【0028】
【図1】本発明の実施の形態における車両の構成を示す概略図であり乗員が搭乗した状態を示す図である。
【図2】本発明の実施の形態における車両の制御システムの構成を示すブロック図である。
【図3】本発明の実施の形態における車両制御処理の動作を示すフローチャートである。
【図4】本発明の実施の形態におけるストッパ制御処理の動作を示すフローチャートである。
【図5】本発明の実施の形態におけるストッパ状態量の取得処理の動作を示すフローチャートである。
【図6】本発明の実施の形態における車両の減速時間と有効減速度との関係を示す図である。
【図7】本発明の実施の形態における変動特性量の取得処理の動作を示すフローチャートである。
【図8】本発明の実施の形態におけるストッパの接地予測状態を示す図である。
【図9】本発明の実施の形態における駆動輪接地点、接地荷重中心点及びストッパ接地点の位置関係を説明する図である。
【図10】本発明の実施の形態における接地状態の予測処理の動作を示すフローチャートである。
【図11】本発明の実施の形態における接地荷重偏心度の予測値と目標値との関係を示す図である。
【図12】本発明の実施の形態におけるストッパ目標状態の決定処理の動作を示すフローチャートである。
【図13】本発明の実施の形態におけるストッパ出力の制御処理の動作を示すフローチャートである。
【発明を実施するための形態】
【0029】
以下、本発明の実施の形態について図面を参照しながら詳細に説明する。
【0030】
図1は本発明の実施の形態における車両の構成を示す概略図であり乗員が搭乗した状態を示す図、図2は本発明の実施の形態における車両の制御システムの構成を示すブロック図である。なお、図1において、(a)は事前適応制御未実行の場合における倒立制御実行時の状態、(b)は事前適応制御未実行の場合における倒立制御停止後の状態、(c)は事前適応制御実行の場合における倒立制御停止後の状態、(d)は事前適応制御実行の場合における倒立制御実行時の状態である。
【0031】
図1において、10は、本実施の形態における車両であり、車体の本体部11、駆動輪12、支持部13及び乗員15が搭乗する搭乗部14を有し、前記車両10は、車体を前後に傾斜させることができるようになっている。そして、倒立振り子の姿勢制御と同様に車体の姿勢を制御する。図1に示される例において、車両10は右方向に前進し、左方向に後退することができる。
【0032】
前記駆動輪12は、車体の一部である支持部13に対して回転可能に支持され、駆動アクチュエータとしての駆動モータ52によって駆動される。なお、駆動輪12の軸は図1に示す平面に垂直な方向に存在し、駆動輪12はその軸を中心に回転する。また、前記駆動輪12は、単数であっても複数であってもよいが、複数である場合、同軸上に並列に配設される。本実施の形態においては、駆動輪12が2つであるものとして説明する。この場合、各駆動輪12は個別の駆動モータ52によって独立して駆動される。なお、駆動アクチュエータとしては、例えば、油圧モータ、内燃機関等を使用することもできるが、ここでは、電気モータである駆動モータ52を使用するものとして説明する。
【0033】
また、車体の一部である本体部11は、支持部13によって下方から支持され、駆動輪12の上方に位置する。そして、本体部11には搭乗部14が取り付けられている。なお、本実施の形態においては、説明の都合上、乗員15が搭乗部14に搭乗している例について説明するが、搭乗部14には必ずしも乗員15が搭乗している必要はなく、例えば、車両10がリモートコントロールによって操縦される場合には、搭乗部14に乗員15が搭乗していなくてもよいし、乗員15に代えて、貨物が積載されていてもよい。前記搭乗部14は、乗用車、バス等の自動車に使用されるシートと同様のものであり、座面部、背もたれ部及びヘッドレストを備える。
【0034】
前記搭乗部14の脇(わき)には、目標走行状態取得装置としてのジョイスティック31を備える入力装置30が配設されている。乗員15は、操縦装置であるジョイスティック31を操作することによって、車両10を操縦する、すなわち、車両10の加速、減速、旋回、その場転回、停止、制動等の走行指令を入力するようになっている。なお、乗員15が操作して走行指令を入力することができる装置であれば、ジョイスティック31に代えて他の装置、例えば、ペダル、ハンドル、ジョグダイヤル、タッチパネル、押しボタン等の装置を目標走行状態取得装置として使用することもできる。
【0035】
また、前記入力装置30は、停止要求取得手段としての制御切替スイッチ32を備える。そして、乗員15が走行開始や降車を希望する場合には、制御切替スイッチ32を操作することによって、倒立制御の実行や停止の指令を入力するようになっている。ここで、乗員15が操作して倒立制御の実行や停止を入力することができる装置であれば、制御切替スイッチ32に代えて他の装置、例えば、押しボタンやタッチパネル、操作レバー、音声認識システム等の装置を停止要求取得手段として使用することもできる。また、これらは実行又は停止の一方のみを指令する装置であってもよい。
【0036】
なお、車両10がリモートコントロールによって操縦される場合には、前記ジョイスティック31及び制御切替スイッチ32に代えて、コントローラからの走行指令を有線又は無線で受信する受信装置を目標走行状態取得装置として使用することができる。また、車両10があらかじめ決められた走行指令データに従って自動走行する場合には、前記ジョイスティック31及び制御切替スイッチ32に代えて、半導体メモリ、ハードディスク等の記憶媒体に記憶された走行指令データを読み取るデータ読取り装置を目標走行状態取得装置として使用することができる。
【0037】
図1に示されるように、車両10の支持部13には、姿勢制限手段としてのストッパ16が伸縮可能に取り付けられ、ストッパモータ72によって前後独立に伸縮させられる。図に示される例において、前記ストッパ16は、V字形の側面形状を備え、支持部13の下端に固定され、下方に向けて延出する中心部16c、該中心部16cの下端から前方斜め上方向に延出する前方部16f、該前方部16fの前端に形成された接地部としての前方接地部16a、前記中心部16cの下端から後方斜め上方向に延出する後方部16r、及び、該後方部16rの後端に形成された接地部としての後方接地部16bを有する。そして、前記前方部16f及び後方部16rは、互いに独立に伸縮可能に構成され、伸縮軸として機能する。
【0038】
図1(a)に示されるような前方部16fと後方部16rの長さが等しい状態において、ストッパ16の各部の位置、角度及び形状について、前方部16fと後方部16rは面対称の関係にあり、その平面上に駆動輪12の回転軸があるように取り付けられる、すなわち、前方部16fと後方部16rとは同一の寸法及び形状を備える。
【0039】
ストッパ16の具体的な寸法等は、車体傾斜角の制限値に基づいて決定される。まず、水平面を駆動輪12の回転軸まわりに車体傾斜角制限値に等しい角度だけ回転させた平面であり、かつ、駆動輪12に接する平面を基準面とする。なお、基準面は全部で4面考えられるが、駆動輪12の前方下部で接する面を前方部16fに対応する基準面とし、駆動輪12の後方下部で接する面を後方部に対応する基準面とする。そして、車体が直立状態にあるとき、すなわち、車体傾斜角が零であるとき、前方部16f及び後方部16rの伸縮方向が各々対応する基準面に平行であるように設計する。つまり、前方接地部16a及び後方接地部16bが水平面から車体傾斜角制限値だけ上方に傾いた方向に移動可能な構造とする。また、車体が直立状態にあるとき、前方部16f及び後方部16rの伸縮状態に関わらず、前方接地部16a及び後方接地部16bが前記基準面に接するように設計する。
【0040】
そして、倒立制御を停止した時には、前方接地部16a又は後方接地部16bが路面に接地することによって車体の姿勢角度を制限し、車体が所定角度、すなわち、車体傾斜角制限値以上に傾斜することを防止する。
【0041】
このように、本実施の形態においては、車体直立時におけるストッパ16の伸縮軸、すなわち、前方部16f及び後方部16rの傾きであるストッパ伸縮軸偏角ΨSTが、所定の車体傾斜角の最大値θ1,MFと等しくなるような伸縮型ストッパ構造が採用されている。そして、ストッパ16の伸縮軸に平行で、かつ、駆動輪12に接する平面上にストッパ接地点が位置する。これにより、ストッパ長さによって、車体傾斜角制限値、すなわち、車両10の加減速や登降坂等の限界性能が変化しない。したがって、車両10の運動性能を低下させることなく、車両10の安全性を向上させることができる。
【0042】
なお、本実施の形態においては、ストッパの伸縮に対して車体傾斜角制限値が一定であるような構造を用いているが、ストッパが伸びると同方向の車体傾斜角制限値が大きくなるような構造を用いてもよい。この場合、安定性を確保するために必要なストッパ伸長量が増加する代わりに、運動限界性能を更に高めることができる。一方、ストッパが伸びると同方向の車体傾斜角制限値が小さくなるような構造を用いてもよい。この場合、運動限界性能が低下する代わりに、より短いストッパ伸長量で安定性を確保することができる。
【0043】
次に、前記ストッパモータ62は、すべりねじ伝動装置を介して、前方部16f及び後方部16rを伸縮させる。つまり、互いに螺(ら)合するスクリュ及びナットのいずれか一方をストッパモータ62によって回転させることによって他方を軸方向に移動させることにより、ストッパモータ62の回転往復運動を直線往復運動に変換し、この直線往復運動によって、ロッド状の前方部16fにおける前後端の間隔、及び、ロッド状の後方部16rにおける前後端の間隔を変化させる。したがって、ストッパブレーキを別段具備していなくても、電源が遮断されてストッパモータ62の回転が停止すると、スクリュ及びナット間の摩擦によって、直線往復運動にブレーキがかかり、前方部16f及び後方部16rが伸縮不能となる。
【0044】
また、車両10は、車両制御装置としての制御ECU(Electronic Control Unit)20を有し、該制御ECU20は、主制御ECU21、駆動輪制御ECU22及びストッパ制御ECU23を備える。前記制御ECU20並びに主制御ECU21、駆動輪制御ECU22及びストッパ制御ECU23は、CPU、MPU等の演算手段、磁気ディスク、半導体メモリ等の記憶手段、入出力インターフェイス等を備え、車両10の各部の動作を制御するコンピュータシステムであり、例えば、本体部11に配設されるが、支持部13や搭乗部14に配設されていてもよい。また、前記主制御ECU21、駆動輪制御ECU22及びストッパ制御ECU23は、それぞれ、別個に構成されていてもよいし、一体に構成されていてもよい。
【0045】
そして、主制御ECU21は、駆動輪制御ECU22、駆動輪センサ51及び駆動モータ52とともに、駆動輪12の動作を制御する駆動輪制御システム50の一部として機能する。前記駆動輪センサ51は、レゾルバ、エンコーダ等から成り、駆動輪回転状態計測装置として機能し、駆動輪12の回転状態を示す駆動輪回転角及び/又は回転角速度を検出し、主制御ECU21に送信する。また、該主制御ECU21は、駆動トルク指令値を駆動輪制御ECU22に送信し、該駆動輪制御ECU22は、受信した駆動トルク指令値に相当する入力電圧を駆動モータ52に供給する。そして、該駆動モータ52は、入力電圧に従って駆動輪12に駆動トルクを付与し、これにより、駆動アクチュエータとして機能する。
【0046】
また、主制御ECU21は、駆動輪制御ECU22、車体傾斜センサ41及び駆動モータ52とともに、車体の姿勢を制御する車体制御システム40の一部として機能する。前記車体傾斜センサ41は、加速度センサ、ジャイロセンサ等から成り、車体傾斜状態計測装置として機能し、車体の傾斜状態を示す車体傾斜角及び/又は傾斜角速度を検出し、主制御ECU21に送信する。そして、該主制御ECU21は、駆動トルク指令値を駆動輪制御ECU22に送信する。
【0047】
さらに、主制御ECU21は、ストッパ制御ECU23、ストッパセンサ61及びストッパモータ62とともに、ストッパ16の動作を制御するストッパ制御システム60の一部として機能する。前記ストッパセンサ61は、レゾルバ、エンコーダ等から成り、姿勢制限手段計測装置として機能し、ストッパ16の形状を示すストッパ長さ、すなわち、前方部16f及び後方部16rの長さを検出し、主制御ECU21に送信する。また、該主制御ECU21は、ストッパトルク指令値をストッパ制御ECU23に送信し、該ストッパ制御ECU23は、受信したストッパトルク指令値に相当する入力電圧をストッパモータ62に供給する。そして、該ストッパモータ62は、入力電圧に従ってストッパ16に駆動トルクを付与し、これにより、姿勢制限手段アクチュエータとして機能する。
【0048】
なお、主制御ECU21には、入力装置30のジョイスティック31から走行指令が入力される。そして、前記主制御ECU21は、駆動トルク指令値を駆動輪制御ECU22に送信する。
【0049】
また、各センサは、複数の状態量を取得するものであってもよい。例えば、車体傾斜センサ41として加速度センサとジャイロセンサとを併用し、両者の計測値から車体傾斜角と車体傾斜角速度とを決定してもよい。
【0050】
本実施の形態において、制御ECU20は、図1(a)に示されるように、倒立制御を実行している間に、図1(b)に示されるような倒立制御を停止した時の状態を予測し、予測した状態が図1(c)に示されるような倒立制御停止時の目標状態に一致するように、ストッパ16の回転状態を図1(d)に示されるように補正する事前適応制御を実行する。
【0051】
なお、図1において、17は乗員15も含む車両10の重心を示し、白抜きの三角は、駆動輪12の接地点としての駆動輪接地点を示し、白抜きの丸は、重心17を通り重力と慣性力の合力ベクトルに平行な直線が路面と交わる点としての接地荷重中心点を示し、白抜きの星は、前方接地部16a又は後方接地部16bが路面に接地する点としてのストッパ接地点を示している。
【0052】
つまり、制御ECU20は、ストッパ事前適応制御を実行し、接地荷重中心点とストッパ接地点とを予測し、補正する。具体的には、倒立制御実行時、すなわち、ストッパ16が浮上している時において、常に、倒立制御停止時、すなわち、ストッパ16の接地時の車体姿勢を予測し、それが安定状態であるようにストッパ16の状態をあらかじめ制御して倒立制御停止に備える。
【0053】
また、倒立制御停止後における車両10の減速度の変化を考慮して、接地荷重中心点を予測する。具体的には、車両10の走行速度に基づいて倒立制御停止後の減速度の変化を予測し、その減速度に伴う慣性力の影響を考慮して接地荷重中心点の位置を予測する。そして、予測された接地荷重中心点の位置に応じてストッパ16を適切な状態に制御する。
【0054】
以下の説明において、表記の簡略化のため、駆動輪12の回転軸に垂直な平面に投影した駆動輪接地点を、省略して、単に、駆動輪接地点と表記する。また、ストッパ接地点や接地荷重中心点も同様に表記する。また、同様の理由から、倒立制御の実行時に予測したストッパ接地点及び接地荷重中心点を、それぞれストッパ接地予測点及び接地荷重中心予測点と表記する。
【0055】
車体姿勢の安定性については、予測される倒立制御停止時における駆動輪接地点とストッパ接地点と接地荷重中心点との位置関係によって判断する。まず、駆動輪接地点とストッパ接地点との中点に接地荷重中心点がある状態を最安定状態とする。そして、前記中点から接地荷重中心点までの水平方向の距離に相当する接地荷重偏心度の予測値を小さくするように、ストッパ接地予測点と接地荷重中心予測点とを制御する。具体的には、ストッパ16の状態を変化させることによって、ストッパ接地予測点と接地荷重中心予測点とを制御する。
【0056】
前述のように、ストッパ16は、車両10の前後の前方部16fと後方部16rとが結合され、前方部16f及び後方部16rが伸縮可能となっている。そこで、前方部16f及び後方部16rの長さをストッパモータ62で変化させることによって、ストッパ接地予測点と接地荷重中心予測点とを制御することができる。
【0057】
また、倒立制御停止時には電源が遮断されるため、ストッパ16の前方部16f及び後方部16rの伸縮運動に制動力が作用し、倒立制御停止直前の伸縮状態で固定される。倒立制御を停止するのは、例えば、システム異常に対する緊急停止時や、乗員15が降車又は駐車を希望する時である。
【0058】
なお、制御ECU20は、機能の観点から、減速度の時間変化を予測する減速度予測手段、車体傾斜時間を予測する傾斜時間予測手段、停止時の接地荷重中心点を予測する接地荷重中心点予測手段、及び、ストッパ16の形状を制御する姿勢制限制御手段を備える。
【0059】
このように、倒立制御実行時、すなわち、車体の姿勢制御が行われている時であってストッパ16を使用する前に、あらかじめストッパ16を適切な状態に設定しておくので、異常時における緊急停止、乗員15による駐車要求等にも即時に対応することができる。また、車両10の力学的状態を厳密に考慮して安定性を予測した結果に基づいてストッパ16を制御するため、倒立制御停止時であっても、確実に車体を安定化させることができる。さらに、車両10の減速状態を予測し、減速に伴う慣性力の影響を考慮して車両10の力学的状態を予測するため、緊急停止時の安定性低下を憂慮することなく車両10の有する走行性能を最大限発揮できる。さらに、必要に応じてストッパ16の状態を制御するため、ストッパ16による安定領域の過度なマージンが不要であり、ストッパ16、すなわち、車両10を小型化及び軽量化することができる。
【0060】
以上のように、高い走行性能、並びに、車両10の小型化によって、安全で使い勝手のよい倒立型の車両10を提供することができる。
【0061】
次に、前記構成の車両10の動作について説明する。まず、車両制御処理の概要について説明する。
【0062】
図3は本発明の実施の形態における車両制御処理の動作を示すフローチャートである。
【0063】
車両制御処理において、制御ECU20は、まず、システム異常判定を行い、異常発生か否かを判定する(ステップS1)。この場合、例えば、バッテリのエネルギ枯渇やセンサの故障等の原因によって、倒立制御の維持が不可能な状態となっているか否かを判断する。
【0064】
そして、異常発生はないと判定すると、制御ECU20は、降車希望判定を行い、降車希望であるか否かを判定する(ステップS2)。この場合、入力装置30の制御切替スイッチ32から入力された実行/停止指令の信号を取得し、乗員15が降車を望んでいるか否かを判断する。具体的には、実行指令の場合には乗員15が降車を望んでいない、停止指令の場合には乗員15が降車を望んでいると判断する。
【0065】
そして、降車を望んでいないと判定すると、制御ECU20は、倒立制御を実行し(ステップS3)、車体の倒立姿勢を維持しつつ、乗員15が指令する走行状態を実現する。なお、倒立制御の内容については、通常の倒立型車両における倒立制御と同様であるので、説明を省略する。また、本実施の形態においては、前方部16f及び後方部16rの伸縮構造がすべりねじを備えるものであるので、ストッパブレーキを備えておらず、そのため、ストッパブレーキ操作は不要である。
【0066】
続いて、制御ECU20は、ストッパ制御処理を実行し(ステップS4)、倒立制御の停止に備えてストッパ16を適切な状態に制御し、車両制御処理を終了する。なお、該車両制御処理は、所定の時間間隔(例えば、100〔μs〕毎)で繰り返し実行される。
【0067】
一方、システム異常判定において異常が発生していると判定した場合、制御ECU20は、電源遮断、すなわち、緊急停止を行い(ステップS5)、車両10のシステムの電源を遮断し、車両制御処理を終了する。
【0068】
また、降車希望判定において降車を希望していると判定した場合、制御ECU20は、着地制御を実行し(ステップS6)、車体を緩やかに前方に傾け、ストッパ16の前方接地部16aを路面に接地させ、車両制御処理を終了する。
【0069】
なお、本実施の形態では、車両制御処理において、異常時を除いて、必ず制御切替スイッチ32の入力に基づく乗員15の降車希望を判断しているが、一度降車希望の信号を受信したら、それ以降は制御切替スイッチ32の入力に係わらず、常に降車を望んでいると判断してもよい。これにより、無駄な制御処理が軽減されるのと共に、一度降車希望を送信した直後に撤回された場合に適応することが困難な姿勢制御の実行、及び、それに伴う危険性を簡単に回避することができる。
【0070】
次に、ストッパ制御処理について説明する。
【0071】
図4は本発明の実施の形態におけるストッパ制御処理の動作を示すフローチャートである。
【0072】
ストッパ制御処理において、制御ECU20は、まず、ストッパ状態量の取得処理を実行し(ステップS4−1)、ストッパセンサ61によって、ストッパ16の状態量を取得する。
【0073】
次に、制御ECU20は、変動特性量の取得処理を実行し(ステップS4−2)、車体の安定性に影響を及ぼす要素についての特性量、具体的に本実施の形態においては、有効減速度を取得する。
【0074】
次に、制御ECU20は、接地状態の予測処理を実行し(ステップS4−3)、ストッパ状態量の取得処理によって取得されたストッパ16の状態量及び変動特性量の取得処理によって取得された特性量に基づいて、倒立制御停止時、すなわち、ストッパ接地時における車両10の力学的状態を予測する。
【0075】
次に、制御ECU20は、ストッパ目標状態の決定処理を実行し(ステップS4−4)、接地状態の予測処理によって予測された車両10の力学的状態に応じてストッパ状態量の目標値を決定する。
【0076】
最後に、制御ECU20は、ストッパ出力の制御処理を実行し(ステップS4−5)、ストッパ状態量の取得処理によって取得されたストッパ16の状態量及びストッパ目標状態の決定処理によって決定されたストッパ状態量の目標値に応じて、ストッパトルク指令値をストッパ制御ECU23に与える。
【0077】
次に、ストッパ制御処理の詳細について説明する。まず、ストッパ状態量の取得処理について説明する。
【0078】
図5は本発明の実施の形態におけるストッパ状態量の取得処理の動作を示すフローチャートである。
【0079】
ストッパ状態量の取得処理において、主制御ECU21は、まず、ストッパ16の状態量を取得する(ステップS4−1−1)。この場合、ストッパセンサ61からストッパ長さ及び/又はストッパ伸縮速度を取得する。
【0080】
続いて、主制御ECU21は、残りの状態量を算出する(ステップS4−1−2)。この場合、取得した状態量を時間微分又は時間積分することによって、残りの状態量を算出する。取得した状態量がストッパ長さである場合には、これを時間微分することによって、ストッパ伸縮速度を得ることができる。また、取得した状態量がストッパ伸縮速度である場合には、これを時間積分することによって、ストッパ長さを得ることができる。
【0081】
次に、変動特性量の取得処理について説明する。
【0082】
図6は本発明の実施の形態における車両の減速時間と有効減速度との関係を示す図、図7は本発明の実施の形態における変動特性量の取得処理の動作を示すフローチャートである。
【0083】
本実施の形態においては、状態量やパラメータを次のような記号によって表す。
θW :駆動輪回転角〔rad〕
θ1 :車体傾斜角(鉛直軸基準)〔rad〕
τW :駆動トルク(2つの駆動輪の合計)〔Nm〕
g:重力加速度〔m/s2 〕
mW :駆動輪質量(2つの駆動輪の合計)〔kg〕
RW :駆動輪接地半径〔m〕
IW :駆動輪慣性モーメント(2つの駆動輪の合計)〔kgm2 〕
m1 :車体質量(乗員を含む)〔kg〕
l1 :車体重心距離(車軸から)〔m〕
【0084】
続いて、主制御ECU21は、有効減速度を予測する(ステップS4−2−2)。この場合、駆動輪12及び車体の状態量から、次の式(1)によって有効減速度αD を予測する。
【0085】
【数1】
【0086】
このようにして予測された有効減速度αD は、車両制動時間に応じて、図6に示されるように変化する。
【0087】
なお、制動トルクの予測値には、次の(a)及び(b)の仮定の下で所定の値を予め与えておく。
(a)緊急停止時、駆動輪12に摩擦ブレーキが作用する場合、性能予想値又は制御指令値であるブレーキトルクの値を与える。
(b)緊急停止時、駆動輪12に摩擦ブレーキが作用しない場合、駆動モータ52の逆起電力や駆動輪12の転がり抵抗などを考慮して、制動トルクに相当する値を与える。
【0088】
このように、本実施の形態においては、車両10の走行速度に応じて、減速度の影響をどの程度考慮すべきかを評価し、考慮すべき減速度を有効減速度として決定する。この場合、緊急停止時のブレーキ性能と車両総重量によって予測される減速度を基準値、かつ、最大値とする。
【0089】
また、緊急制動時に車両10がある走行速度から停止状態に至るまでの時間である車両制動時間と、倒立制御停止時に車体がある角度から傾斜してストッパ16が接地するまでの時間である車体傾斜時間とを比較することにより、考慮すべき減速度の程度を表す減速度有効率を決定する。
【0090】
具体的には、車両制動時間が車体傾斜時間よりもはるかに短い場合、減速度有効率を零とする。このような場合には、車体が傾斜してストッパ16が路面に接地する前に減速は終了してしまうため、減速の影響を考慮する必要がない。
【0091】
また、車両制動時間が車体傾斜時間よりも長い場合、減速度有効率を1とする。このような場合には、車体が傾斜してストッパ16が路面に接地してから所定の時間、車両10の減速が継続されるため、その影響を確実に考慮する必要がある。
【0092】
さらに、車両制動時間が車体傾斜時間よりも少し短い場合、所定の減速度有効率を与える。これは、関数の不連続を回避することだけでなく、慣性力による車体傾斜角速度の増加に伴い、車体傾斜の勢い(慣性)で安定領域から外れる危険性を考慮する役割を果たす。
【0093】
さらに、現在の車両速度によって、車両減速時間を予測する。車両速度が高いほど、減速を続ける時間は長くなるため、減速度の影響が大きいと評価する。
【0094】
さらに、現在の車体傾斜角によって、車体傾斜時間を予測する。すでに車体が車両進行方向側に大きく傾いている場合、ストッパ16が接地するまでの時間は短いため、減速度の影響は大きいと評価する。なお、車体が大きく逆側に傾いている場合には、倒立制御停止後も逆側のストッパ16が接地すると想定して、その接地までの時間を車体傾斜時間として与える。
【0095】
このように、本実施の形態においては、緊急停止時における減速度がストッパ接地後の車体姿勢の安定性に及ぼす影響を正しく、かつ、効率的に考慮することで、必要最小限のストッパ長さ及び接地点移動量で十分な安全性を保証できる。
【0096】
なお、本実施の形態においては、慣性力によって車体傾斜運動が付勢される影響を、有効減速度の漸増によって簡単に考慮しているが、より厳密に考慮してもよい。例えば、力学モデルに基づいてストッパ接地時の車体傾斜角速度を予測し、そのときの運動エネルギに基づいて有効減速度を補正することで、勢いによる車体の更なる傾斜をより確実に防ぐことができる。
【0097】
また、本実施の形態においては、基準となる減速度の予測値を求める際、制動トルク及び車両総重量として所定の値を予め与えているが、状況に応じて値を変えてもよい。例えば、緊急停止時における車両10の状態や乗員15の意思に応じて、制動システムの動作状態を変更される場合、その変更結果に応じて予測される減速度の値に修正してもよい。また、乗員15や搭載物の重量を取得できる場合には、その値に応じて減速度の予測値を変えてもよい。
【0098】
さらに、本実施の形態においては、制動力として駆動輪12で発生する制動トルクのみを考慮しているが、ストッパ接地点で発生する制動力を考慮してもよい。例えば、ストッパ接地点に作用する摩擦力を考慮した力学モデルにより、全制動力及び減速度を予測してもよい。また、接地荷重移動による摩擦力限界の変化も考慮して予測してもよい。ちなみに、ストッパ接地点での制動力のみで制動する場合には、ストッパの接地と同時に減速を開始するため、ストッパ接地の時間遅れ、換言すれば、減速の先行時間に相当する車体傾斜時間の値を零、あるいは、ストッパの制御を開始する車両速度の閾値に相当する所定値に設定してもよい。
【0099】
さらに、本実施の形態においては、有効減速度の決定過程の一部で非線形の関数を用いているが、線形近似した簡単な関数を用いてもよい。また、より複雑な非線形の関数やモデルを導入して、より詳細に有効減速度を決定してもよい。
【0100】
次に、接地状態の予測処理について説明する。
【0101】
図8は本発明の実施の形態におけるストッパの接地予測状態を示す図、図9は本発明の実施の形態における駆動輪接地点、接地荷重中心点及びストッパ接地点の位置関係を説明する図、図10は本発明の実施の形態における接地状態の予測処理の動作を示すフローチャートである。
【0102】
接地状態の予測処理において、主制御ECU21は、まず、ストッパ接地点を予測する(ステップS4−3−1)。具体的には、ストッパ状態量の取得処理で取得したストッパ長さに基づき、ストッパ接地点を予測する。なお、図8には、ストッパ16の前方接地部16aが路面に接地した予測状態が示されている。
【0103】
ストッパ16の前方接地部16aが接地した場合の駆動輪接地点からストッパ接地予測点までの水平線上の距離xS,f と、ストッパ16の後方接地部16bが接地した場合の駆動輪接地点からストッパ接地予測点までの水平線上の距離xS,r は、次の式(2)で表される。なお、以降の説明において、xS,f 及びxS,r を統合的に説明する場合には、駆動輪接地点からストッパ接地予測点までの距離をxS として説明する。
【0104】
【数2】
【0105】
続いて、主制御ECU21は、接地荷重中心点を予測する(ステップS4−3−2)。具体的には、ストッパ状態量の取得処理で取得したストッパ長さ及び変動特性量の取得処理で取得した有効減速度に基づき、接地荷重中心点を予測する。
【0106】
ストッパ16の前方接地部16aが接地した場合の駆動輪接地点から接地荷重中心予測点までの水平線上の距離xC,f と、ストッパ16の後方接地部16bが接地した場合の駆動輪接地点から接地荷重中心予測点までの水平線上の距離xC,r は、次の式(3)で表される。なお、以降の説明において、xC,f 及びxC,r を統合的に説明する場合には、駆動輪接地点から接地荷重中心予測点までの距離をxC として説明する。
【0107】
【数3】
【0108】
このように、本実施の形態においては、有効減速度とストッパ16の状態に基づいて、倒立制御停止時の車体姿勢及び力学的状態を予測する。つまり、有効減速度αD とストッパ長さλST,f及びλST,rに基づいて、ストッパ接地点と接地荷重中心点を予測する。また、ストッパ長さによるストッパ接地点の位置変化を考慮して、駆動輪接地点からストッパ接地点までの距離xS を求める。さらに、有効減速度及びストッパ長さによる車体傾斜角の変化を考慮して、駆動輪接地点から接地荷重中心点までの距離xC を求める。このように、倒立制御停止時における車両10の状態を詳細に考慮することで、その安定性をより高い精度で評価できる。
【0109】
また、車体が前傾してストッパ16の前方接地部16aが接地した場合と車体が後傾してストッパ16の後方接地部16bが接地した場合を考慮し、各々の場合におけるストッパ接地点と接地荷重中心点を求める。したがって、倒立制御の緊急停止時において車体がどちらの方向に傾斜しても、その安定性を保証できる。
【0110】
なお、車両進行方向逆側のストッパ16については、有効減速度の影響を考慮しない。倒立制御停止時に車体が進行方向逆側に傾斜した場合、減速中に車体が進行方向へ再傾斜して乗員15に不安感を与える可能性よりも、車両停止後に車体が後方に倒れる危険性を重要視することで、より安全なシステムを実現できる。
【0111】
また、本実施の形態においては、非線形の評価式によって、ストッパ接地点と接地荷重中心点の相対位置を予測しているが、より簡単な線形式により予測してもよい。あるいは、駆動輪12の変形や車体傾斜の慣性等を考慮したより詳細なモデルに基づく評価式によって予測してもよい。さらに、関数をマップとして具備し、それを用いて予測してもよい。
【0112】
続いて、主制御ECU21は、接地荷重偏心度を予測する(ステップS4−3−3)。具体的には、予測したストッパ接地点及び接地荷重中心点に基づき、次の式(4)により、倒立制御の停止時、すなわち、ストッパ16の接地時における接地荷重偏心度を算出する。なお、図9には、ストッパ接地点、接地荷重中心点及び駆動輪接地点の位置と、駆動輪接地点からストッパ接地点及び接地荷重中心点までの水平距離と、接地荷重偏心度との関係も示されている。
【0113】
ストッパ16の前方接地部16aが接地した場合の接地荷重偏心度をγf とし、ストッパ16の後方接地部16bが接地した場合の接地荷重偏心度をγr とすると、γf 及びγr は、次の式(4)で表される。なお、以降の説明において、γf 及びγr を統合的に説明する場合には、接地荷重偏心度γとして説明する。
【0114】
【数4】
【0115】
このように、主制御ECU21は、予測した駆動輪接地点、ストッパ接地点及び接地荷重中心点の位置関係に基づいて、倒立制御停止時、すなわち、ストッパ接地時における車体姿勢の安定性を評価する。具体的には、駆動輪接地点とストッパ接地点との中点を基準とした接地荷重中心点のずれを駆動輪接地点及びストッパ接地点間距離の半分で無次元化した値である接地荷重偏心度によって、安定性を評価する。
【0116】
接地荷重偏心度が、γ>1の場合、接地荷重中心点がストッパ接地点の外側に位置するので、ストッパ接地点を中心として車体が回転し、場合によっては転倒する危険性があるため、危険な「不安定」であると評価する。また、γ<−1の場合、接地荷重中心点が駆動輪接地点の外側に位置するので、ストッパ接地時の車体姿勢を維持することができず、やがて車体は逆側に傾斜するため、不便な「不安定」であると評価する。さらに、γ=0の場合、接地荷重中心点が上記の2領域から最も離れた位置にあるので、この点が「最安定」であると評価し、この位置に接地荷重中心点があることを理想とする。
【0117】
これにより、転倒の危険だけでなく、逆側への車体再傾斜も回避させることができ、安定した車体姿勢の維持を実現することができる。
【0118】
また、本実施の形態においては、接地荷重中心点が駆動輪接地点とストッパ接地点との中点にある場合を最安定としているが、異なる点にある場合を最安定としてもよい。例えば、接地荷重中心点がストッパ接地点の外側にある状態の方が、駆動輪接地点の外側にある状態よりも重大な不安定状態にあることを考慮し、所定量だけ駆動輪接地点に接近した位置を最安定点とすることで、より転倒しにくい制御を実現してもよい。
【0119】
さらに、前側接地を想定した接地荷重中心点と後側接地を想定した接地荷重中心点について異なる値を最安定としてもよい。また、降車時には前傾接地した後に乗員15が降車すると重心位置が後方に移動するため、停止中は前側の最安定点をストッパ接地点側に乗員15の体重に応じた量だけ近付けてもよい。
【0120】
次に、ストッパ目標状態の決定処理について説明する。
【0121】
図11は本発明の実施の形態における接地荷重偏心度の予測値と目標値との関係を示す図、図12は本発明の実施の形態におけるストッパ目標状態の決定処理の動作を示すフローチャートである。
【0122】
ストッパ目標状態の決定処理において、主制御ECU21は、まず、接地荷重偏心度の目標値を決定する(ステップS4−4−1)。具体的には、接地状態の予測処理によって予測した接地荷重偏心度の値に基づき、次の式(5)によって、接地荷重偏心度の目標値を決定する。なお、上付きの符号*は目標値であることを示す符号である。また、図11には、接地荷重偏心度の予測値と目標値との関係が示されている。
【0123】
【数5】
【0124】
ここでは、接地荷重偏心度が安定な範囲にあるように、かつ、緩やかに最安定な値に収束するように、目標値を決定する。そのために、接地荷重偏心度の推定値に基づいて、接地荷重偏心度の目標値を決定する。
【0125】
具体的には、接地荷重偏心度が不安定な範囲にある場合、すなわち、γ<γMin 又はγ>γMax である場合、安定な範囲内の所定値を目標値とする。これにより、接地荷重偏心度を迅速に安定な範囲内まで変化させ、不安定な状態を回避する。また、接地荷重偏心度が安定な範囲にある場合、すなわち、γMin <γ<γMax である場合、推定値よりも少し小さな値を目標値とする。これにより、接地荷重偏心度を緩やかに最安定点へ誘導し、その安定度を強くする。
【0126】
このように、緊急度に応じて対応を変えることで、非緊急時の過剰な制御に伴うエネルギの浪費や振動発生を回避することができる。
【0127】
なお、本実施の形態では、単純な線形関数を組み合わせた関数で接地荷重偏心度の目標値を設定しているが、より複雑な非線形の関数を用いてもよい。例えば、式(5)における閾(しきい)値付近の不連続な変化を滑らかにすることで、同閾値付近でのストッパ16や車体の動作の急な変化を軽減させることができる。また、本実施の形態では、接地荷重偏心度の予測値が正の場合と負の場合で同様の関数から目標値を設定しているが、その特性が異なってもよい。例えば、正の場合の目標値の関数の勾(こう)配をより小さく設定することで、車体転倒の防止をより強くすることができる。さらに、本実施の形態では、前側接地を想定した場合と後側接地を想定した場合で同じ関数を用いているが、それが異なっていてもよい。例えば、前側接地想定時の目標値の関数の最大値をより小さく設定することで、緊急停止時に可能性が高くなる前側への車体転倒の防止をより強く実行することができる。
【0128】
また、本実施の形態では、接地荷重偏心度の目標値を同予測値に基づいて設定することで収束速度などの制御特性を調整しているが、後述のフィードバック制御において特性を調整してもよい。例えば、接地荷重偏心度の予測値が所定の閾値を超過している場合にはフィードバックゲインを大きくし、同閾値以下の場合には同ゲインを小さくすることで、本実施の形態と同様の効果を実現できる。
【0129】
続いて、主制御ECU21は、ストッパ状態量の目標値を決定する(ステップS4−4−2)。具体的には、接地荷重偏心度の目標値及び変動特性量の取得処理によって取得した車両重心位置に基づき、次の式(6)及び(7)によって、ストッパ長さの目標値を決定する。なお、式(6)はストッパ16の前方部16fの長さの目標値を示し、式(7)はストッパ16の後方部16rの長さの目標値を示している。
【0130】
【数6】
【0131】
【数7】
【0132】
このように、接地荷重偏心度の目標値に応じて、ストッパ16の目標状態を決定する。つまり、接地荷重偏心度の目標値と有効減速度とによって、ストッパ長さの目標値を決定する。この場合、ストッパ接地点及び接地荷重中心点が接地荷重偏心度の目標値を実現する配置になるようなストッパ長さを幾何学的条件等に基づいて算出し、それを目標値として設定する。
【0133】
なお、ストッパ長さを接地荷重偏心度と有効減速度との陽関数で表すこと、すなわち、直接求めることは困難であることから、本実施の形態においては、数値的な方程式の解法(ニュートン法)を用いている。
【0134】
【数8】
【0135】
なお、本実施の形態においては、非線形の陰関数によってストッパ長さの目標値を決定しているが、より簡単な線形式又は陽関数によって決定してもよい。また、関数をマップとして具備し、それを用いて決定してもよい。
【0136】
また、本実施の形態においては、接地荷重偏心度という指標を用いることによって車体の姿勢安定性の扱いを容易にしているが、有効減速度及びストッパ長さから直接的にストッパ長さの目標値を設定してもよい。さらに、接地荷重偏心度の目標値を、一度、接地荷重中心点及びストッパ接地点の相対位置の目標値に置き換えた後に、ストッパ長さの目標値を決定してもよい。
【0137】
次に、ストッパ出力の制御処理について説明する。
【0138】
図13は本発明の実施の形態におけるストッパ出力の制御処理の動作を示すフローチャートである。
【0139】
ストッパ出力の制御処理において、主制御ECU21は、まず、ストッパモータ62のストッパトルク指令値を決定する(ステップS4−5−1)。具体的には、ストッパ長さ及びストッパ伸縮速度の目標値と計測値との偏差に基づき、次の式(12)によって、ストッパモータ62のストッパトルク指令値を決定する。なお、τS,f は前方部16fを伸縮させるストッパモータ62のストッパトルク指令値であり、τS,r は後方部16rを伸縮させるストッパモータ62のストッパトルク指令値である。また、以降の説明において、τS,f 及びτS,r を統合的に説明する場合には、ストッパトルク指令値τS として説明する。
【0140】
【数9】
【0141】
このように、フィードバック制御(PID制御)によって、ストッパ16の目標状態を実現するようにストッパトルク指令値を決定する。
【0142】
なお、本実施の形態においては、ストッパ長さを制御対象としたフィードバック制御を実行しているが、他の状態量を対象としてもよい。例えば、ストッパ接地点、接地荷重中心点、又は、接地荷重偏心度を制御量としたフィードバック制御を実行してもよい。さらに、スライディングモード制御等の他のフィードバック制御、又は、フィードフォワード制御を導入してもよい。
【0143】
最後に、主制御ECU21は、ストッパ制御システム60に指令値を与える(ステップS4−5−2)。この場合、主制御ECU21は、前述のように決定したストッパモータ62のストッパトルク指令値をストッパ制御ECU23に送信する。
【0144】
このように、本実施の形態においては、走行速度を考慮してストッパ事前適応制御を行う。つまり、倒立制御実行時において、車両10の走行速度に応じてストッパ16を制御する。具体的には、車両制御停止時における減速度の時間変化を予測し、その減速度に伴う慣性力に対して車体姿勢を安定に保持できるように、あらかじめストッパ16を制御する。また、車両速度に基づいて車両制動時間を予測するのと共に、車体傾斜角に基づいて車体傾斜時間を予測し、両時間を比較することで減速の影響を評価する。なお、車両進行方向側のストッパ16についてのみ、慣性力の影響を考慮する。
【0145】
これにより、高速走行中の緊急停止における安全性を保障し、常に安全に、安心して、快適に利用できる倒立型の車両10を提供することができる。
【0146】
なお、本実施の形態においては、伸縮型ストッパによる構成を説明したが、他の種類のストッパを用いてもよい。
【0147】
例えば、支持部13とストッパ16がモータを介して相対的に回転可能な状態で結合された構造とし、モータのトルクによってストッパ16の回転角のみを制御することで、ストッパ接地時の車体傾斜角を調整して車体姿勢の安定化を達成してもよい。この場合、前後各々の制御はできないが、伸縮型に比べて簡素なシステムで倒立制御停止時における車体姿勢の安定性を実現できる。
【0148】
また、ストッパスライダ機構を具備し、該スライダ機構の相対的に並進移動する部分の一方を支持部13に固定し、他方をストッパ16に固定することで、ストッパ16が支持部13と相対的に並進移動する構造を用いてもよい。この場合、ストッパ16を駆動輪12の回転軸から遠ざけるほど、遠ざけた側のストッパ16が接地した時の車体の傾斜角が小さくなり、その方向に転倒する可能性が低下する。
【0149】
また、本実施の形態においては、すべりねじ伝動装置を介してストッパ16の前方部16f及び後方部16rを伸縮させる構造であるが、これに加えて、前方部16fと前方接地部16aの間、及び、後方部16rと後方接地部16bの間にそれぞれコイルばねを介し、また、電源投入時に各コイルばねが所定のひずみ量で固定されるのと共に電源遮断時に解放される係合装置を具備した構造を用いてもよい。この場合、倒立制御の停止と共に電源を遮断した時にコイルばねの付与力により突出した前方接地部16a及び/又は後方接地部16rが接地した状態における車体姿勢の安定性を倒立制御実行時に予測し、不安定であると判定した場合にはすべりねじ伝動装置を動作させて、予測される接地状態を安定化させることができる。
【0150】
なお、本発明は前記実施の形態に限定されるものではなく、本発明の趣旨に基づいて種々変形させることが可能であり、それらを本発明の範囲から排除するものではない。
【産業上の利用可能性】
【0151】
本発明は、倒立振り子の姿勢制御を利用した車両に適用することができる。
【符号の説明】
【0152】
10 車両
12 駆動輪
16 ストッパ
16a 前方接地部
16b 後方接地部
16f 前方部
16r 後方部
17 重心
20 制御ECU
【技術分野】
【0001】
本発明は、倒立振り子の姿勢制御を利用した車両に関するものである。
【背景技術】
【0002】
従来、倒立振り子の姿勢制御を利用した車両に関する技術が提案されている。例えば、同軸上に配設された2つの駆動輪を有し、乗員の重心移動による車体の姿勢変化を感知して駆動する車両、球体状の単一の駆動輪に取り付けられた車体の姿勢を制御しながら移動する車両等の技術が提案されている(例えば、特許文献1参照。)。
【0003】
この場合、センサで車体のバランスや動作の状態を検出しながら、倒立制御を行って、車両を移動させる。また、乗員が降車するときや車両の電源を遮断したときには、倒立制御を停止するのと同時にストッパを作動させ、該ストッパを接地させることによって車体の姿勢を維持するようになっている。
【先行技術文献】
【特許文献】
【0004】
【特許文献1】特開2004−291799号公報
【発明の概要】
【発明が解決しようとする課題】
【0005】
しかしながら、前記従来の車両においては、走行中に倒立制御を停止できない場合がある。例えば、ストッパの接地時に路面との摩擦力で車両が制動される場合、減速に伴って車両に作用する慣性力により接地荷重中心点が前方に移動し、安定性が低下する可能性がある。また、倒立制御の停止と共に、駆動輪に対して自動的にブレーキが作動する場合も同様である。
【0006】
このような場合の安全性を確実に保証するためには、非常停止時の減速度を軽減させる構造又は制御を用いればよいが、車両の緊急停止時のように急制動を必要とする場合には対応できない。また、車両の最高速度を制限する方法もあるが、利便性や快適性は損なわれる。あるいは、常に十分な安定領域を確保できるよう大きなストッパを装着した場合には、車両の小型化が困難になる。
【0007】
本発明は、前記従来の車両の問題点を解決して、倒立制御の実行時に、車両の走行速度に応じて倒立制御停止時における減速度の時間変化を予測し、該減速度の時間変化に基づいてストッパの形状等を制御し、倒立制御を停止する前にあらかじめ姿勢制限手段を適切な状態で待機させることによって、車両の走行速度に依らず、いつ倒立制御を停止しても車体を安定した状態に維持することを可能とし、高い走行性能や利便性を備え、且つ、安全に使用することができる車両を提供することを目的とする。
【課題を解決するための手段】
【0008】
そのために、本発明の車両においては、回転可能に車体に取り付けられた駆動輪と、前記車体の姿勢角度を制限する姿勢制限手段と、前記駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、車両の走行速度に応じて減速度を予測する減速度予測手段と、該減速度予測手段によって予測された減速度に応じて、前記姿勢制限手段の位置及び/又は形状を制御する姿勢制限制御手段とを備える。
【0009】
本発明の他の車両においては、さらに、前記減速度予測手段は、車両が停止するまでの時間である車両制動時間を予測し、前記車両制御装置は、前記姿勢制限手段が機能するまでの時間である車体傾斜時間を予測する傾斜時間予測手段を更に備え、前記姿勢制限制御手段は、前記減速度予測手段によって予測された前記車両制動時間と前記傾斜時間予測手段によって予測された前記車体傾斜時間に応じて、前記姿勢制限手段を制御する。
【0010】
本発明の更に他の車両においては、さらに、前記姿勢制限制御手段は、前記車両制動時間が前記車体傾斜時間よりも短い場合には、第1の状態に前記姿勢制限手段を制御し、前記車両制動時間が前記車体傾斜時間よりも長い場合には、第1の状態と異なる第2の状態に前記姿勢制限手段を制御する。
【0011】
本発明の更に他の車両においては、さらに、前記傾斜時間予測手段は、前記車体の姿勢角度に応じて前記車体傾斜時間を予測する。
【0012】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記減速度予測手段によって予測された減速度の時間変化から接地荷重中心点を予測する接地荷重中心点予測手段と、を更に備え、前記姿勢制限手段は、該接地荷重中心点予測手段によって予測された接地荷重中心点に応じて、前記姿勢制限手段を制御する。
【0013】
本発明の更に他の車両においては、さらに、前記姿勢制限手段は、路面に接地した状態で前記車体の姿勢を制限し、前記姿勢制限制御手段は、前記接地荷重中心点予測手段によって予測された接地荷重中心点の位置である第1の位置と、前記駆動輪が路面に接地する位置である第2の位置と、前記姿勢制限手段が路面に接地する位置である第3の位置について、前記第1の位置が前記第2の位置と前記第3の位置との間にあるように前記姿勢制限手段を制御する。
【0014】
本発明の更に他の車両においては、さらに、前記第2の位置と前記第3の位置から等しい距離にある第4の位置について、該第4の位置に対する前記第1の位置の相対位置を表す接地荷重偏心度を算出する接地荷重偏心度算出手段を更に備え、前記姿勢制限制御手段は、算出された接地荷重偏心度が所定範囲内になるように前記姿勢制限手段を制御する。
【0015】
本発明の更に他の車両においては、さらに、前記制限値制御手段は、前記車体の姿勢の制御が行われている時に前記姿勢制限手段を制御する。
【0016】
本発明の更に他の車両においては、さらに、前記車体の姿勢の制御の続行が可能か不可能かを判定する制御可能判定手段と、前記車体の姿勢の制御を続行するか停止するかを指令する信号を取得する制御指令取得手段と、を更に備え、前記車両制御装置は、前記制御可能判定手段が不可能と判定した時、又は、前記制御指令取得手段が停止を指令する信号を取得した時に、前記姿勢制限手段を固定する。
【0017】
本発明の更に他の車両においては、さらに、前記姿勢制限手段は、前記駆動輪の回転軸に平行で前記駆動輪に接する所定の平面である基準面について、前記車体の姿勢角度を固定したとき、常に前記基準面に分断されること無く、前記基準面に接した状態を維持したまま位置及び/又は形状を変化させる機構を備える。
【発明の効果】
【0018】
請求項1の構成によれば、車両の走行速度によって推定された減速度の時間変化に基づいて車体の安定性に及ぼす慣性の影響を考慮し、その影響を補償するように姿勢制限手段を制御することで、車両の走行状態及びその後の減速状態に依らず、車体姿勢を安定な状態に保つことができる。したがって、倒立制御停止時の安全性を憂慮することなく、高速で走行することができる。
【0019】
請求項2の構成によれば、姿勢制限手段が機能するまでの時間を考慮することで、減速度が車体姿勢の安定性に及ぼす影響を正確に評価し、必要に応じた姿勢制限手段の制御を実行できる。
【0020】
請求項3の構成によれば、姿勢制限手段機能後も減速状態が続いているか否か、すなわち、慣性力が安定性に影響するか否かを判断し、姿勢制限手段を各々の状態に適した状態に制御することで、確実に安全性を保障するのと共に、過剰な動作に伴うエネルギの浪費や部材の劣化、騒音等を低減させることができる。
【0021】
請求項4の構成によれば、倒立制御停止直前の車体傾斜角を考慮することで、その後の車体傾斜時間をより正確に予測することができる。
【0022】
請求項5の構成によれば、倒立制御停止時の車体姿勢の安定性を決定する要素である接地荷重中心点を予測し、その結果に基づいて姿勢制限手段を制御することで、確実に車体を安定化させることができる。
【0023】
請求項6の構成によれば、車体の力学的状態を厳密に考慮して安定性を予測した結果に基づいて姿勢制限手段を制御するため、より確実に車体を安定化させることができる。また、車体が傾斜して姿勢制限手段が接地した後に、車体が更に同じ方向に傾斜し続けることを防ぐのと共に、乗員の移動等に伴って車体が逆方向に傾斜することも防ぐことができる。
【0024】
請求項7の構成によれば、車体の力学的状態を厳密に、かつ、定量的に考慮して安定性を予測した結果に基づいて姿勢制限手段を制御するため、更に確実に車体を安定化させることができる。また、接地荷重偏心度の目標値を所定範囲内とすることで、安定な範囲内で細かく姿勢制限手段を制御するような不要な動作、及び、それに伴うエネルギの浪費や振動、騒音等を防ぐことができる。
【0025】
請求項8の構成によれば、姿勢制限手段を使用する前に、あらかじめ姿勢制限手段を適切な状態に設定することができる。
【0026】
請求項9の構成によれば、異常時における緊急停止や乗員による駐車要求等に即時且つ確実に対応することができる。また、姿勢制限手段を必要とする状態を容易に判断できるのと共に、倒立制御停止後における姿勢制限手段の誤動作を確実に防止できる。
【0027】
請求項10の構成によれば、姿勢制限手段の制御に依らず、車体傾斜角の最大値を一定に保つような機構を用いることで、車体傾斜による加減速や登降坂等の運動性能と高速走行時の安全性を両立させることができる。すなわち、安全で便利な倒立型車両を実現できる。
【図面の簡単な説明】
【0028】
【図1】本発明の実施の形態における車両の構成を示す概略図であり乗員が搭乗した状態を示す図である。
【図2】本発明の実施の形態における車両の制御システムの構成を示すブロック図である。
【図3】本発明の実施の形態における車両制御処理の動作を示すフローチャートである。
【図4】本発明の実施の形態におけるストッパ制御処理の動作を示すフローチャートである。
【図5】本発明の実施の形態におけるストッパ状態量の取得処理の動作を示すフローチャートである。
【図6】本発明の実施の形態における車両の減速時間と有効減速度との関係を示す図である。
【図7】本発明の実施の形態における変動特性量の取得処理の動作を示すフローチャートである。
【図8】本発明の実施の形態におけるストッパの接地予測状態を示す図である。
【図9】本発明の実施の形態における駆動輪接地点、接地荷重中心点及びストッパ接地点の位置関係を説明する図である。
【図10】本発明の実施の形態における接地状態の予測処理の動作を示すフローチャートである。
【図11】本発明の実施の形態における接地荷重偏心度の予測値と目標値との関係を示す図である。
【図12】本発明の実施の形態におけるストッパ目標状態の決定処理の動作を示すフローチャートである。
【図13】本発明の実施の形態におけるストッパ出力の制御処理の動作を示すフローチャートである。
【発明を実施するための形態】
【0029】
以下、本発明の実施の形態について図面を参照しながら詳細に説明する。
【0030】
図1は本発明の実施の形態における車両の構成を示す概略図であり乗員が搭乗した状態を示す図、図2は本発明の実施の形態における車両の制御システムの構成を示すブロック図である。なお、図1において、(a)は事前適応制御未実行の場合における倒立制御実行時の状態、(b)は事前適応制御未実行の場合における倒立制御停止後の状態、(c)は事前適応制御実行の場合における倒立制御停止後の状態、(d)は事前適応制御実行の場合における倒立制御実行時の状態である。
【0031】
図1において、10は、本実施の形態における車両であり、車体の本体部11、駆動輪12、支持部13及び乗員15が搭乗する搭乗部14を有し、前記車両10は、車体を前後に傾斜させることができるようになっている。そして、倒立振り子の姿勢制御と同様に車体の姿勢を制御する。図1に示される例において、車両10は右方向に前進し、左方向に後退することができる。
【0032】
前記駆動輪12は、車体の一部である支持部13に対して回転可能に支持され、駆動アクチュエータとしての駆動モータ52によって駆動される。なお、駆動輪12の軸は図1に示す平面に垂直な方向に存在し、駆動輪12はその軸を中心に回転する。また、前記駆動輪12は、単数であっても複数であってもよいが、複数である場合、同軸上に並列に配設される。本実施の形態においては、駆動輪12が2つであるものとして説明する。この場合、各駆動輪12は個別の駆動モータ52によって独立して駆動される。なお、駆動アクチュエータとしては、例えば、油圧モータ、内燃機関等を使用することもできるが、ここでは、電気モータである駆動モータ52を使用するものとして説明する。
【0033】
また、車体の一部である本体部11は、支持部13によって下方から支持され、駆動輪12の上方に位置する。そして、本体部11には搭乗部14が取り付けられている。なお、本実施の形態においては、説明の都合上、乗員15が搭乗部14に搭乗している例について説明するが、搭乗部14には必ずしも乗員15が搭乗している必要はなく、例えば、車両10がリモートコントロールによって操縦される場合には、搭乗部14に乗員15が搭乗していなくてもよいし、乗員15に代えて、貨物が積載されていてもよい。前記搭乗部14は、乗用車、バス等の自動車に使用されるシートと同様のものであり、座面部、背もたれ部及びヘッドレストを備える。
【0034】
前記搭乗部14の脇(わき)には、目標走行状態取得装置としてのジョイスティック31を備える入力装置30が配設されている。乗員15は、操縦装置であるジョイスティック31を操作することによって、車両10を操縦する、すなわち、車両10の加速、減速、旋回、その場転回、停止、制動等の走行指令を入力するようになっている。なお、乗員15が操作して走行指令を入力することができる装置であれば、ジョイスティック31に代えて他の装置、例えば、ペダル、ハンドル、ジョグダイヤル、タッチパネル、押しボタン等の装置を目標走行状態取得装置として使用することもできる。
【0035】
また、前記入力装置30は、停止要求取得手段としての制御切替スイッチ32を備える。そして、乗員15が走行開始や降車を希望する場合には、制御切替スイッチ32を操作することによって、倒立制御の実行や停止の指令を入力するようになっている。ここで、乗員15が操作して倒立制御の実行や停止を入力することができる装置であれば、制御切替スイッチ32に代えて他の装置、例えば、押しボタンやタッチパネル、操作レバー、音声認識システム等の装置を停止要求取得手段として使用することもできる。また、これらは実行又は停止の一方のみを指令する装置であってもよい。
【0036】
なお、車両10がリモートコントロールによって操縦される場合には、前記ジョイスティック31及び制御切替スイッチ32に代えて、コントローラからの走行指令を有線又は無線で受信する受信装置を目標走行状態取得装置として使用することができる。また、車両10があらかじめ決められた走行指令データに従って自動走行する場合には、前記ジョイスティック31及び制御切替スイッチ32に代えて、半導体メモリ、ハードディスク等の記憶媒体に記憶された走行指令データを読み取るデータ読取り装置を目標走行状態取得装置として使用することができる。
【0037】
図1に示されるように、車両10の支持部13には、姿勢制限手段としてのストッパ16が伸縮可能に取り付けられ、ストッパモータ72によって前後独立に伸縮させられる。図に示される例において、前記ストッパ16は、V字形の側面形状を備え、支持部13の下端に固定され、下方に向けて延出する中心部16c、該中心部16cの下端から前方斜め上方向に延出する前方部16f、該前方部16fの前端に形成された接地部としての前方接地部16a、前記中心部16cの下端から後方斜め上方向に延出する後方部16r、及び、該後方部16rの後端に形成された接地部としての後方接地部16bを有する。そして、前記前方部16f及び後方部16rは、互いに独立に伸縮可能に構成され、伸縮軸として機能する。
【0038】
図1(a)に示されるような前方部16fと後方部16rの長さが等しい状態において、ストッパ16の各部の位置、角度及び形状について、前方部16fと後方部16rは面対称の関係にあり、その平面上に駆動輪12の回転軸があるように取り付けられる、すなわち、前方部16fと後方部16rとは同一の寸法及び形状を備える。
【0039】
ストッパ16の具体的な寸法等は、車体傾斜角の制限値に基づいて決定される。まず、水平面を駆動輪12の回転軸まわりに車体傾斜角制限値に等しい角度だけ回転させた平面であり、かつ、駆動輪12に接する平面を基準面とする。なお、基準面は全部で4面考えられるが、駆動輪12の前方下部で接する面を前方部16fに対応する基準面とし、駆動輪12の後方下部で接する面を後方部に対応する基準面とする。そして、車体が直立状態にあるとき、すなわち、車体傾斜角が零であるとき、前方部16f及び後方部16rの伸縮方向が各々対応する基準面に平行であるように設計する。つまり、前方接地部16a及び後方接地部16bが水平面から車体傾斜角制限値だけ上方に傾いた方向に移動可能な構造とする。また、車体が直立状態にあるとき、前方部16f及び後方部16rの伸縮状態に関わらず、前方接地部16a及び後方接地部16bが前記基準面に接するように設計する。
【0040】
そして、倒立制御を停止した時には、前方接地部16a又は後方接地部16bが路面に接地することによって車体の姿勢角度を制限し、車体が所定角度、すなわち、車体傾斜角制限値以上に傾斜することを防止する。
【0041】
このように、本実施の形態においては、車体直立時におけるストッパ16の伸縮軸、すなわち、前方部16f及び後方部16rの傾きであるストッパ伸縮軸偏角ΨSTが、所定の車体傾斜角の最大値θ1,MFと等しくなるような伸縮型ストッパ構造が採用されている。そして、ストッパ16の伸縮軸に平行で、かつ、駆動輪12に接する平面上にストッパ接地点が位置する。これにより、ストッパ長さによって、車体傾斜角制限値、すなわち、車両10の加減速や登降坂等の限界性能が変化しない。したがって、車両10の運動性能を低下させることなく、車両10の安全性を向上させることができる。
【0042】
なお、本実施の形態においては、ストッパの伸縮に対して車体傾斜角制限値が一定であるような構造を用いているが、ストッパが伸びると同方向の車体傾斜角制限値が大きくなるような構造を用いてもよい。この場合、安定性を確保するために必要なストッパ伸長量が増加する代わりに、運動限界性能を更に高めることができる。一方、ストッパが伸びると同方向の車体傾斜角制限値が小さくなるような構造を用いてもよい。この場合、運動限界性能が低下する代わりに、より短いストッパ伸長量で安定性を確保することができる。
【0043】
次に、前記ストッパモータ62は、すべりねじ伝動装置を介して、前方部16f及び後方部16rを伸縮させる。つまり、互いに螺(ら)合するスクリュ及びナットのいずれか一方をストッパモータ62によって回転させることによって他方を軸方向に移動させることにより、ストッパモータ62の回転往復運動を直線往復運動に変換し、この直線往復運動によって、ロッド状の前方部16fにおける前後端の間隔、及び、ロッド状の後方部16rにおける前後端の間隔を変化させる。したがって、ストッパブレーキを別段具備していなくても、電源が遮断されてストッパモータ62の回転が停止すると、スクリュ及びナット間の摩擦によって、直線往復運動にブレーキがかかり、前方部16f及び後方部16rが伸縮不能となる。
【0044】
また、車両10は、車両制御装置としての制御ECU(Electronic Control Unit)20を有し、該制御ECU20は、主制御ECU21、駆動輪制御ECU22及びストッパ制御ECU23を備える。前記制御ECU20並びに主制御ECU21、駆動輪制御ECU22及びストッパ制御ECU23は、CPU、MPU等の演算手段、磁気ディスク、半導体メモリ等の記憶手段、入出力インターフェイス等を備え、車両10の各部の動作を制御するコンピュータシステムであり、例えば、本体部11に配設されるが、支持部13や搭乗部14に配設されていてもよい。また、前記主制御ECU21、駆動輪制御ECU22及びストッパ制御ECU23は、それぞれ、別個に構成されていてもよいし、一体に構成されていてもよい。
【0045】
そして、主制御ECU21は、駆動輪制御ECU22、駆動輪センサ51及び駆動モータ52とともに、駆動輪12の動作を制御する駆動輪制御システム50の一部として機能する。前記駆動輪センサ51は、レゾルバ、エンコーダ等から成り、駆動輪回転状態計測装置として機能し、駆動輪12の回転状態を示す駆動輪回転角及び/又は回転角速度を検出し、主制御ECU21に送信する。また、該主制御ECU21は、駆動トルク指令値を駆動輪制御ECU22に送信し、該駆動輪制御ECU22は、受信した駆動トルク指令値に相当する入力電圧を駆動モータ52に供給する。そして、該駆動モータ52は、入力電圧に従って駆動輪12に駆動トルクを付与し、これにより、駆動アクチュエータとして機能する。
【0046】
また、主制御ECU21は、駆動輪制御ECU22、車体傾斜センサ41及び駆動モータ52とともに、車体の姿勢を制御する車体制御システム40の一部として機能する。前記車体傾斜センサ41は、加速度センサ、ジャイロセンサ等から成り、車体傾斜状態計測装置として機能し、車体の傾斜状態を示す車体傾斜角及び/又は傾斜角速度を検出し、主制御ECU21に送信する。そして、該主制御ECU21は、駆動トルク指令値を駆動輪制御ECU22に送信する。
【0047】
さらに、主制御ECU21は、ストッパ制御ECU23、ストッパセンサ61及びストッパモータ62とともに、ストッパ16の動作を制御するストッパ制御システム60の一部として機能する。前記ストッパセンサ61は、レゾルバ、エンコーダ等から成り、姿勢制限手段計測装置として機能し、ストッパ16の形状を示すストッパ長さ、すなわち、前方部16f及び後方部16rの長さを検出し、主制御ECU21に送信する。また、該主制御ECU21は、ストッパトルク指令値をストッパ制御ECU23に送信し、該ストッパ制御ECU23は、受信したストッパトルク指令値に相当する入力電圧をストッパモータ62に供給する。そして、該ストッパモータ62は、入力電圧に従ってストッパ16に駆動トルクを付与し、これにより、姿勢制限手段アクチュエータとして機能する。
【0048】
なお、主制御ECU21には、入力装置30のジョイスティック31から走行指令が入力される。そして、前記主制御ECU21は、駆動トルク指令値を駆動輪制御ECU22に送信する。
【0049】
また、各センサは、複数の状態量を取得するものであってもよい。例えば、車体傾斜センサ41として加速度センサとジャイロセンサとを併用し、両者の計測値から車体傾斜角と車体傾斜角速度とを決定してもよい。
【0050】
本実施の形態において、制御ECU20は、図1(a)に示されるように、倒立制御を実行している間に、図1(b)に示されるような倒立制御を停止した時の状態を予測し、予測した状態が図1(c)に示されるような倒立制御停止時の目標状態に一致するように、ストッパ16の回転状態を図1(d)に示されるように補正する事前適応制御を実行する。
【0051】
なお、図1において、17は乗員15も含む車両10の重心を示し、白抜きの三角は、駆動輪12の接地点としての駆動輪接地点を示し、白抜きの丸は、重心17を通り重力と慣性力の合力ベクトルに平行な直線が路面と交わる点としての接地荷重中心点を示し、白抜きの星は、前方接地部16a又は後方接地部16bが路面に接地する点としてのストッパ接地点を示している。
【0052】
つまり、制御ECU20は、ストッパ事前適応制御を実行し、接地荷重中心点とストッパ接地点とを予測し、補正する。具体的には、倒立制御実行時、すなわち、ストッパ16が浮上している時において、常に、倒立制御停止時、すなわち、ストッパ16の接地時の車体姿勢を予測し、それが安定状態であるようにストッパ16の状態をあらかじめ制御して倒立制御停止に備える。
【0053】
また、倒立制御停止後における車両10の減速度の変化を考慮して、接地荷重中心点を予測する。具体的には、車両10の走行速度に基づいて倒立制御停止後の減速度の変化を予測し、その減速度に伴う慣性力の影響を考慮して接地荷重中心点の位置を予測する。そして、予測された接地荷重中心点の位置に応じてストッパ16を適切な状態に制御する。
【0054】
以下の説明において、表記の簡略化のため、駆動輪12の回転軸に垂直な平面に投影した駆動輪接地点を、省略して、単に、駆動輪接地点と表記する。また、ストッパ接地点や接地荷重中心点も同様に表記する。また、同様の理由から、倒立制御の実行時に予測したストッパ接地点及び接地荷重中心点を、それぞれストッパ接地予測点及び接地荷重中心予測点と表記する。
【0055】
車体姿勢の安定性については、予測される倒立制御停止時における駆動輪接地点とストッパ接地点と接地荷重中心点との位置関係によって判断する。まず、駆動輪接地点とストッパ接地点との中点に接地荷重中心点がある状態を最安定状態とする。そして、前記中点から接地荷重中心点までの水平方向の距離に相当する接地荷重偏心度の予測値を小さくするように、ストッパ接地予測点と接地荷重中心予測点とを制御する。具体的には、ストッパ16の状態を変化させることによって、ストッパ接地予測点と接地荷重中心予測点とを制御する。
【0056】
前述のように、ストッパ16は、車両10の前後の前方部16fと後方部16rとが結合され、前方部16f及び後方部16rが伸縮可能となっている。そこで、前方部16f及び後方部16rの長さをストッパモータ62で変化させることによって、ストッパ接地予測点と接地荷重中心予測点とを制御することができる。
【0057】
また、倒立制御停止時には電源が遮断されるため、ストッパ16の前方部16f及び後方部16rの伸縮運動に制動力が作用し、倒立制御停止直前の伸縮状態で固定される。倒立制御を停止するのは、例えば、システム異常に対する緊急停止時や、乗員15が降車又は駐車を希望する時である。
【0058】
なお、制御ECU20は、機能の観点から、減速度の時間変化を予測する減速度予測手段、車体傾斜時間を予測する傾斜時間予測手段、停止時の接地荷重中心点を予測する接地荷重中心点予測手段、及び、ストッパ16の形状を制御する姿勢制限制御手段を備える。
【0059】
このように、倒立制御実行時、すなわち、車体の姿勢制御が行われている時であってストッパ16を使用する前に、あらかじめストッパ16を適切な状態に設定しておくので、異常時における緊急停止、乗員15による駐車要求等にも即時に対応することができる。また、車両10の力学的状態を厳密に考慮して安定性を予測した結果に基づいてストッパ16を制御するため、倒立制御停止時であっても、確実に車体を安定化させることができる。さらに、車両10の減速状態を予測し、減速に伴う慣性力の影響を考慮して車両10の力学的状態を予測するため、緊急停止時の安定性低下を憂慮することなく車両10の有する走行性能を最大限発揮できる。さらに、必要に応じてストッパ16の状態を制御するため、ストッパ16による安定領域の過度なマージンが不要であり、ストッパ16、すなわち、車両10を小型化及び軽量化することができる。
【0060】
以上のように、高い走行性能、並びに、車両10の小型化によって、安全で使い勝手のよい倒立型の車両10を提供することができる。
【0061】
次に、前記構成の車両10の動作について説明する。まず、車両制御処理の概要について説明する。
【0062】
図3は本発明の実施の形態における車両制御処理の動作を示すフローチャートである。
【0063】
車両制御処理において、制御ECU20は、まず、システム異常判定を行い、異常発生か否かを判定する(ステップS1)。この場合、例えば、バッテリのエネルギ枯渇やセンサの故障等の原因によって、倒立制御の維持が不可能な状態となっているか否かを判断する。
【0064】
そして、異常発生はないと判定すると、制御ECU20は、降車希望判定を行い、降車希望であるか否かを判定する(ステップS2)。この場合、入力装置30の制御切替スイッチ32から入力された実行/停止指令の信号を取得し、乗員15が降車を望んでいるか否かを判断する。具体的には、実行指令の場合には乗員15が降車を望んでいない、停止指令の場合には乗員15が降車を望んでいると判断する。
【0065】
そして、降車を望んでいないと判定すると、制御ECU20は、倒立制御を実行し(ステップS3)、車体の倒立姿勢を維持しつつ、乗員15が指令する走行状態を実現する。なお、倒立制御の内容については、通常の倒立型車両における倒立制御と同様であるので、説明を省略する。また、本実施の形態においては、前方部16f及び後方部16rの伸縮構造がすべりねじを備えるものであるので、ストッパブレーキを備えておらず、そのため、ストッパブレーキ操作は不要である。
【0066】
続いて、制御ECU20は、ストッパ制御処理を実行し(ステップS4)、倒立制御の停止に備えてストッパ16を適切な状態に制御し、車両制御処理を終了する。なお、該車両制御処理は、所定の時間間隔(例えば、100〔μs〕毎)で繰り返し実行される。
【0067】
一方、システム異常判定において異常が発生していると判定した場合、制御ECU20は、電源遮断、すなわち、緊急停止を行い(ステップS5)、車両10のシステムの電源を遮断し、車両制御処理を終了する。
【0068】
また、降車希望判定において降車を希望していると判定した場合、制御ECU20は、着地制御を実行し(ステップS6)、車体を緩やかに前方に傾け、ストッパ16の前方接地部16aを路面に接地させ、車両制御処理を終了する。
【0069】
なお、本実施の形態では、車両制御処理において、異常時を除いて、必ず制御切替スイッチ32の入力に基づく乗員15の降車希望を判断しているが、一度降車希望の信号を受信したら、それ以降は制御切替スイッチ32の入力に係わらず、常に降車を望んでいると判断してもよい。これにより、無駄な制御処理が軽減されるのと共に、一度降車希望を送信した直後に撤回された場合に適応することが困難な姿勢制御の実行、及び、それに伴う危険性を簡単に回避することができる。
【0070】
次に、ストッパ制御処理について説明する。
【0071】
図4は本発明の実施の形態におけるストッパ制御処理の動作を示すフローチャートである。
【0072】
ストッパ制御処理において、制御ECU20は、まず、ストッパ状態量の取得処理を実行し(ステップS4−1)、ストッパセンサ61によって、ストッパ16の状態量を取得する。
【0073】
次に、制御ECU20は、変動特性量の取得処理を実行し(ステップS4−2)、車体の安定性に影響を及ぼす要素についての特性量、具体的に本実施の形態においては、有効減速度を取得する。
【0074】
次に、制御ECU20は、接地状態の予測処理を実行し(ステップS4−3)、ストッパ状態量の取得処理によって取得されたストッパ16の状態量及び変動特性量の取得処理によって取得された特性量に基づいて、倒立制御停止時、すなわち、ストッパ接地時における車両10の力学的状態を予測する。
【0075】
次に、制御ECU20は、ストッパ目標状態の決定処理を実行し(ステップS4−4)、接地状態の予測処理によって予測された車両10の力学的状態に応じてストッパ状態量の目標値を決定する。
【0076】
最後に、制御ECU20は、ストッパ出力の制御処理を実行し(ステップS4−5)、ストッパ状態量の取得処理によって取得されたストッパ16の状態量及びストッパ目標状態の決定処理によって決定されたストッパ状態量の目標値に応じて、ストッパトルク指令値をストッパ制御ECU23に与える。
【0077】
次に、ストッパ制御処理の詳細について説明する。まず、ストッパ状態量の取得処理について説明する。
【0078】
図5は本発明の実施の形態におけるストッパ状態量の取得処理の動作を示すフローチャートである。
【0079】
ストッパ状態量の取得処理において、主制御ECU21は、まず、ストッパ16の状態量を取得する(ステップS4−1−1)。この場合、ストッパセンサ61からストッパ長さ及び/又はストッパ伸縮速度を取得する。
【0080】
続いて、主制御ECU21は、残りの状態量を算出する(ステップS4−1−2)。この場合、取得した状態量を時間微分又は時間積分することによって、残りの状態量を算出する。取得した状態量がストッパ長さである場合には、これを時間微分することによって、ストッパ伸縮速度を得ることができる。また、取得した状態量がストッパ伸縮速度である場合には、これを時間積分することによって、ストッパ長さを得ることができる。
【0081】
次に、変動特性量の取得処理について説明する。
【0082】
図6は本発明の実施の形態における車両の減速時間と有効減速度との関係を示す図、図7は本発明の実施の形態における変動特性量の取得処理の動作を示すフローチャートである。
【0083】
本実施の形態においては、状態量やパラメータを次のような記号によって表す。
θW :駆動輪回転角〔rad〕
θ1 :車体傾斜角(鉛直軸基準)〔rad〕
τW :駆動トルク(2つの駆動輪の合計)〔Nm〕
g:重力加速度〔m/s2 〕
mW :駆動輪質量(2つの駆動輪の合計)〔kg〕
RW :駆動輪接地半径〔m〕
IW :駆動輪慣性モーメント(2つの駆動輪の合計)〔kgm2 〕
m1 :車体質量(乗員を含む)〔kg〕
l1 :車体重心距離(車軸から)〔m〕
【0084】
続いて、主制御ECU21は、有効減速度を予測する(ステップS4−2−2)。この場合、駆動輪12及び車体の状態量から、次の式(1)によって有効減速度αD を予測する。
【0085】
【数1】
【0086】
このようにして予測された有効減速度αD は、車両制動時間に応じて、図6に示されるように変化する。
【0087】
なお、制動トルクの予測値には、次の(a)及び(b)の仮定の下で所定の値を予め与えておく。
(a)緊急停止時、駆動輪12に摩擦ブレーキが作用する場合、性能予想値又は制御指令値であるブレーキトルクの値を与える。
(b)緊急停止時、駆動輪12に摩擦ブレーキが作用しない場合、駆動モータ52の逆起電力や駆動輪12の転がり抵抗などを考慮して、制動トルクに相当する値を与える。
【0088】
このように、本実施の形態においては、車両10の走行速度に応じて、減速度の影響をどの程度考慮すべきかを評価し、考慮すべき減速度を有効減速度として決定する。この場合、緊急停止時のブレーキ性能と車両総重量によって予測される減速度を基準値、かつ、最大値とする。
【0089】
また、緊急制動時に車両10がある走行速度から停止状態に至るまでの時間である車両制動時間と、倒立制御停止時に車体がある角度から傾斜してストッパ16が接地するまでの時間である車体傾斜時間とを比較することにより、考慮すべき減速度の程度を表す減速度有効率を決定する。
【0090】
具体的には、車両制動時間が車体傾斜時間よりもはるかに短い場合、減速度有効率を零とする。このような場合には、車体が傾斜してストッパ16が路面に接地する前に減速は終了してしまうため、減速の影響を考慮する必要がない。
【0091】
また、車両制動時間が車体傾斜時間よりも長い場合、減速度有効率を1とする。このような場合には、車体が傾斜してストッパ16が路面に接地してから所定の時間、車両10の減速が継続されるため、その影響を確実に考慮する必要がある。
【0092】
さらに、車両制動時間が車体傾斜時間よりも少し短い場合、所定の減速度有効率を与える。これは、関数の不連続を回避することだけでなく、慣性力による車体傾斜角速度の増加に伴い、車体傾斜の勢い(慣性)で安定領域から外れる危険性を考慮する役割を果たす。
【0093】
さらに、現在の車両速度によって、車両減速時間を予測する。車両速度が高いほど、減速を続ける時間は長くなるため、減速度の影響が大きいと評価する。
【0094】
さらに、現在の車体傾斜角によって、車体傾斜時間を予測する。すでに車体が車両進行方向側に大きく傾いている場合、ストッパ16が接地するまでの時間は短いため、減速度の影響は大きいと評価する。なお、車体が大きく逆側に傾いている場合には、倒立制御停止後も逆側のストッパ16が接地すると想定して、その接地までの時間を車体傾斜時間として与える。
【0095】
このように、本実施の形態においては、緊急停止時における減速度がストッパ接地後の車体姿勢の安定性に及ぼす影響を正しく、かつ、効率的に考慮することで、必要最小限のストッパ長さ及び接地点移動量で十分な安全性を保証できる。
【0096】
なお、本実施の形態においては、慣性力によって車体傾斜運動が付勢される影響を、有効減速度の漸増によって簡単に考慮しているが、より厳密に考慮してもよい。例えば、力学モデルに基づいてストッパ接地時の車体傾斜角速度を予測し、そのときの運動エネルギに基づいて有効減速度を補正することで、勢いによる車体の更なる傾斜をより確実に防ぐことができる。
【0097】
また、本実施の形態においては、基準となる減速度の予測値を求める際、制動トルク及び車両総重量として所定の値を予め与えているが、状況に応じて値を変えてもよい。例えば、緊急停止時における車両10の状態や乗員15の意思に応じて、制動システムの動作状態を変更される場合、その変更結果に応じて予測される減速度の値に修正してもよい。また、乗員15や搭載物の重量を取得できる場合には、その値に応じて減速度の予測値を変えてもよい。
【0098】
さらに、本実施の形態においては、制動力として駆動輪12で発生する制動トルクのみを考慮しているが、ストッパ接地点で発生する制動力を考慮してもよい。例えば、ストッパ接地点に作用する摩擦力を考慮した力学モデルにより、全制動力及び減速度を予測してもよい。また、接地荷重移動による摩擦力限界の変化も考慮して予測してもよい。ちなみに、ストッパ接地点での制動力のみで制動する場合には、ストッパの接地と同時に減速を開始するため、ストッパ接地の時間遅れ、換言すれば、減速の先行時間に相当する車体傾斜時間の値を零、あるいは、ストッパの制御を開始する車両速度の閾値に相当する所定値に設定してもよい。
【0099】
さらに、本実施の形態においては、有効減速度の決定過程の一部で非線形の関数を用いているが、線形近似した簡単な関数を用いてもよい。また、より複雑な非線形の関数やモデルを導入して、より詳細に有効減速度を決定してもよい。
【0100】
次に、接地状態の予測処理について説明する。
【0101】
図8は本発明の実施の形態におけるストッパの接地予測状態を示す図、図9は本発明の実施の形態における駆動輪接地点、接地荷重中心点及びストッパ接地点の位置関係を説明する図、図10は本発明の実施の形態における接地状態の予測処理の動作を示すフローチャートである。
【0102】
接地状態の予測処理において、主制御ECU21は、まず、ストッパ接地点を予測する(ステップS4−3−1)。具体的には、ストッパ状態量の取得処理で取得したストッパ長さに基づき、ストッパ接地点を予測する。なお、図8には、ストッパ16の前方接地部16aが路面に接地した予測状態が示されている。
【0103】
ストッパ16の前方接地部16aが接地した場合の駆動輪接地点からストッパ接地予測点までの水平線上の距離xS,f と、ストッパ16の後方接地部16bが接地した場合の駆動輪接地点からストッパ接地予測点までの水平線上の距離xS,r は、次の式(2)で表される。なお、以降の説明において、xS,f 及びxS,r を統合的に説明する場合には、駆動輪接地点からストッパ接地予測点までの距離をxS として説明する。
【0104】
【数2】
【0105】
続いて、主制御ECU21は、接地荷重中心点を予測する(ステップS4−3−2)。具体的には、ストッパ状態量の取得処理で取得したストッパ長さ及び変動特性量の取得処理で取得した有効減速度に基づき、接地荷重中心点を予測する。
【0106】
ストッパ16の前方接地部16aが接地した場合の駆動輪接地点から接地荷重中心予測点までの水平線上の距離xC,f と、ストッパ16の後方接地部16bが接地した場合の駆動輪接地点から接地荷重中心予測点までの水平線上の距離xC,r は、次の式(3)で表される。なお、以降の説明において、xC,f 及びxC,r を統合的に説明する場合には、駆動輪接地点から接地荷重中心予測点までの距離をxC として説明する。
【0107】
【数3】
【0108】
このように、本実施の形態においては、有効減速度とストッパ16の状態に基づいて、倒立制御停止時の車体姿勢及び力学的状態を予測する。つまり、有効減速度αD とストッパ長さλST,f及びλST,rに基づいて、ストッパ接地点と接地荷重中心点を予測する。また、ストッパ長さによるストッパ接地点の位置変化を考慮して、駆動輪接地点からストッパ接地点までの距離xS を求める。さらに、有効減速度及びストッパ長さによる車体傾斜角の変化を考慮して、駆動輪接地点から接地荷重中心点までの距離xC を求める。このように、倒立制御停止時における車両10の状態を詳細に考慮することで、その安定性をより高い精度で評価できる。
【0109】
また、車体が前傾してストッパ16の前方接地部16aが接地した場合と車体が後傾してストッパ16の後方接地部16bが接地した場合を考慮し、各々の場合におけるストッパ接地点と接地荷重中心点を求める。したがって、倒立制御の緊急停止時において車体がどちらの方向に傾斜しても、その安定性を保証できる。
【0110】
なお、車両進行方向逆側のストッパ16については、有効減速度の影響を考慮しない。倒立制御停止時に車体が進行方向逆側に傾斜した場合、減速中に車体が進行方向へ再傾斜して乗員15に不安感を与える可能性よりも、車両停止後に車体が後方に倒れる危険性を重要視することで、より安全なシステムを実現できる。
【0111】
また、本実施の形態においては、非線形の評価式によって、ストッパ接地点と接地荷重中心点の相対位置を予測しているが、より簡単な線形式により予測してもよい。あるいは、駆動輪12の変形や車体傾斜の慣性等を考慮したより詳細なモデルに基づく評価式によって予測してもよい。さらに、関数をマップとして具備し、それを用いて予測してもよい。
【0112】
続いて、主制御ECU21は、接地荷重偏心度を予測する(ステップS4−3−3)。具体的には、予測したストッパ接地点及び接地荷重中心点に基づき、次の式(4)により、倒立制御の停止時、すなわち、ストッパ16の接地時における接地荷重偏心度を算出する。なお、図9には、ストッパ接地点、接地荷重中心点及び駆動輪接地点の位置と、駆動輪接地点からストッパ接地点及び接地荷重中心点までの水平距離と、接地荷重偏心度との関係も示されている。
【0113】
ストッパ16の前方接地部16aが接地した場合の接地荷重偏心度をγf とし、ストッパ16の後方接地部16bが接地した場合の接地荷重偏心度をγr とすると、γf 及びγr は、次の式(4)で表される。なお、以降の説明において、γf 及びγr を統合的に説明する場合には、接地荷重偏心度γとして説明する。
【0114】
【数4】
【0115】
このように、主制御ECU21は、予測した駆動輪接地点、ストッパ接地点及び接地荷重中心点の位置関係に基づいて、倒立制御停止時、すなわち、ストッパ接地時における車体姿勢の安定性を評価する。具体的には、駆動輪接地点とストッパ接地点との中点を基準とした接地荷重中心点のずれを駆動輪接地点及びストッパ接地点間距離の半分で無次元化した値である接地荷重偏心度によって、安定性を評価する。
【0116】
接地荷重偏心度が、γ>1の場合、接地荷重中心点がストッパ接地点の外側に位置するので、ストッパ接地点を中心として車体が回転し、場合によっては転倒する危険性があるため、危険な「不安定」であると評価する。また、γ<−1の場合、接地荷重中心点が駆動輪接地点の外側に位置するので、ストッパ接地時の車体姿勢を維持することができず、やがて車体は逆側に傾斜するため、不便な「不安定」であると評価する。さらに、γ=0の場合、接地荷重中心点が上記の2領域から最も離れた位置にあるので、この点が「最安定」であると評価し、この位置に接地荷重中心点があることを理想とする。
【0117】
これにより、転倒の危険だけでなく、逆側への車体再傾斜も回避させることができ、安定した車体姿勢の維持を実現することができる。
【0118】
また、本実施の形態においては、接地荷重中心点が駆動輪接地点とストッパ接地点との中点にある場合を最安定としているが、異なる点にある場合を最安定としてもよい。例えば、接地荷重中心点がストッパ接地点の外側にある状態の方が、駆動輪接地点の外側にある状態よりも重大な不安定状態にあることを考慮し、所定量だけ駆動輪接地点に接近した位置を最安定点とすることで、より転倒しにくい制御を実現してもよい。
【0119】
さらに、前側接地を想定した接地荷重中心点と後側接地を想定した接地荷重中心点について異なる値を最安定としてもよい。また、降車時には前傾接地した後に乗員15が降車すると重心位置が後方に移動するため、停止中は前側の最安定点をストッパ接地点側に乗員15の体重に応じた量だけ近付けてもよい。
【0120】
次に、ストッパ目標状態の決定処理について説明する。
【0121】
図11は本発明の実施の形態における接地荷重偏心度の予測値と目標値との関係を示す図、図12は本発明の実施の形態におけるストッパ目標状態の決定処理の動作を示すフローチャートである。
【0122】
ストッパ目標状態の決定処理において、主制御ECU21は、まず、接地荷重偏心度の目標値を決定する(ステップS4−4−1)。具体的には、接地状態の予測処理によって予測した接地荷重偏心度の値に基づき、次の式(5)によって、接地荷重偏心度の目標値を決定する。なお、上付きの符号*は目標値であることを示す符号である。また、図11には、接地荷重偏心度の予測値と目標値との関係が示されている。
【0123】
【数5】
【0124】
ここでは、接地荷重偏心度が安定な範囲にあるように、かつ、緩やかに最安定な値に収束するように、目標値を決定する。そのために、接地荷重偏心度の推定値に基づいて、接地荷重偏心度の目標値を決定する。
【0125】
具体的には、接地荷重偏心度が不安定な範囲にある場合、すなわち、γ<γMin 又はγ>γMax である場合、安定な範囲内の所定値を目標値とする。これにより、接地荷重偏心度を迅速に安定な範囲内まで変化させ、不安定な状態を回避する。また、接地荷重偏心度が安定な範囲にある場合、すなわち、γMin <γ<γMax である場合、推定値よりも少し小さな値を目標値とする。これにより、接地荷重偏心度を緩やかに最安定点へ誘導し、その安定度を強くする。
【0126】
このように、緊急度に応じて対応を変えることで、非緊急時の過剰な制御に伴うエネルギの浪費や振動発生を回避することができる。
【0127】
なお、本実施の形態では、単純な線形関数を組み合わせた関数で接地荷重偏心度の目標値を設定しているが、より複雑な非線形の関数を用いてもよい。例えば、式(5)における閾(しきい)値付近の不連続な変化を滑らかにすることで、同閾値付近でのストッパ16や車体の動作の急な変化を軽減させることができる。また、本実施の形態では、接地荷重偏心度の予測値が正の場合と負の場合で同様の関数から目標値を設定しているが、その特性が異なってもよい。例えば、正の場合の目標値の関数の勾(こう)配をより小さく設定することで、車体転倒の防止をより強くすることができる。さらに、本実施の形態では、前側接地を想定した場合と後側接地を想定した場合で同じ関数を用いているが、それが異なっていてもよい。例えば、前側接地想定時の目標値の関数の最大値をより小さく設定することで、緊急停止時に可能性が高くなる前側への車体転倒の防止をより強く実行することができる。
【0128】
また、本実施の形態では、接地荷重偏心度の目標値を同予測値に基づいて設定することで収束速度などの制御特性を調整しているが、後述のフィードバック制御において特性を調整してもよい。例えば、接地荷重偏心度の予測値が所定の閾値を超過している場合にはフィードバックゲインを大きくし、同閾値以下の場合には同ゲインを小さくすることで、本実施の形態と同様の効果を実現できる。
【0129】
続いて、主制御ECU21は、ストッパ状態量の目標値を決定する(ステップS4−4−2)。具体的には、接地荷重偏心度の目標値及び変動特性量の取得処理によって取得した車両重心位置に基づき、次の式(6)及び(7)によって、ストッパ長さの目標値を決定する。なお、式(6)はストッパ16の前方部16fの長さの目標値を示し、式(7)はストッパ16の後方部16rの長さの目標値を示している。
【0130】
【数6】
【0131】
【数7】
【0132】
このように、接地荷重偏心度の目標値に応じて、ストッパ16の目標状態を決定する。つまり、接地荷重偏心度の目標値と有効減速度とによって、ストッパ長さの目標値を決定する。この場合、ストッパ接地点及び接地荷重中心点が接地荷重偏心度の目標値を実現する配置になるようなストッパ長さを幾何学的条件等に基づいて算出し、それを目標値として設定する。
【0133】
なお、ストッパ長さを接地荷重偏心度と有効減速度との陽関数で表すこと、すなわち、直接求めることは困難であることから、本実施の形態においては、数値的な方程式の解法(ニュートン法)を用いている。
【0134】
【数8】
【0135】
なお、本実施の形態においては、非線形の陰関数によってストッパ長さの目標値を決定しているが、より簡単な線形式又は陽関数によって決定してもよい。また、関数をマップとして具備し、それを用いて決定してもよい。
【0136】
また、本実施の形態においては、接地荷重偏心度という指標を用いることによって車体の姿勢安定性の扱いを容易にしているが、有効減速度及びストッパ長さから直接的にストッパ長さの目標値を設定してもよい。さらに、接地荷重偏心度の目標値を、一度、接地荷重中心点及びストッパ接地点の相対位置の目標値に置き換えた後に、ストッパ長さの目標値を決定してもよい。
【0137】
次に、ストッパ出力の制御処理について説明する。
【0138】
図13は本発明の実施の形態におけるストッパ出力の制御処理の動作を示すフローチャートである。
【0139】
ストッパ出力の制御処理において、主制御ECU21は、まず、ストッパモータ62のストッパトルク指令値を決定する(ステップS4−5−1)。具体的には、ストッパ長さ及びストッパ伸縮速度の目標値と計測値との偏差に基づき、次の式(12)によって、ストッパモータ62のストッパトルク指令値を決定する。なお、τS,f は前方部16fを伸縮させるストッパモータ62のストッパトルク指令値であり、τS,r は後方部16rを伸縮させるストッパモータ62のストッパトルク指令値である。また、以降の説明において、τS,f 及びτS,r を統合的に説明する場合には、ストッパトルク指令値τS として説明する。
【0140】
【数9】
【0141】
このように、フィードバック制御(PID制御)によって、ストッパ16の目標状態を実現するようにストッパトルク指令値を決定する。
【0142】
なお、本実施の形態においては、ストッパ長さを制御対象としたフィードバック制御を実行しているが、他の状態量を対象としてもよい。例えば、ストッパ接地点、接地荷重中心点、又は、接地荷重偏心度を制御量としたフィードバック制御を実行してもよい。さらに、スライディングモード制御等の他のフィードバック制御、又は、フィードフォワード制御を導入してもよい。
【0143】
最後に、主制御ECU21は、ストッパ制御システム60に指令値を与える(ステップS4−5−2)。この場合、主制御ECU21は、前述のように決定したストッパモータ62のストッパトルク指令値をストッパ制御ECU23に送信する。
【0144】
このように、本実施の形態においては、走行速度を考慮してストッパ事前適応制御を行う。つまり、倒立制御実行時において、車両10の走行速度に応じてストッパ16を制御する。具体的には、車両制御停止時における減速度の時間変化を予測し、その減速度に伴う慣性力に対して車体姿勢を安定に保持できるように、あらかじめストッパ16を制御する。また、車両速度に基づいて車両制動時間を予測するのと共に、車体傾斜角に基づいて車体傾斜時間を予測し、両時間を比較することで減速の影響を評価する。なお、車両進行方向側のストッパ16についてのみ、慣性力の影響を考慮する。
【0145】
これにより、高速走行中の緊急停止における安全性を保障し、常に安全に、安心して、快適に利用できる倒立型の車両10を提供することができる。
【0146】
なお、本実施の形態においては、伸縮型ストッパによる構成を説明したが、他の種類のストッパを用いてもよい。
【0147】
例えば、支持部13とストッパ16がモータを介して相対的に回転可能な状態で結合された構造とし、モータのトルクによってストッパ16の回転角のみを制御することで、ストッパ接地時の車体傾斜角を調整して車体姿勢の安定化を達成してもよい。この場合、前後各々の制御はできないが、伸縮型に比べて簡素なシステムで倒立制御停止時における車体姿勢の安定性を実現できる。
【0148】
また、ストッパスライダ機構を具備し、該スライダ機構の相対的に並進移動する部分の一方を支持部13に固定し、他方をストッパ16に固定することで、ストッパ16が支持部13と相対的に並進移動する構造を用いてもよい。この場合、ストッパ16を駆動輪12の回転軸から遠ざけるほど、遠ざけた側のストッパ16が接地した時の車体の傾斜角が小さくなり、その方向に転倒する可能性が低下する。
【0149】
また、本実施の形態においては、すべりねじ伝動装置を介してストッパ16の前方部16f及び後方部16rを伸縮させる構造であるが、これに加えて、前方部16fと前方接地部16aの間、及び、後方部16rと後方接地部16bの間にそれぞれコイルばねを介し、また、電源投入時に各コイルばねが所定のひずみ量で固定されるのと共に電源遮断時に解放される係合装置を具備した構造を用いてもよい。この場合、倒立制御の停止と共に電源を遮断した時にコイルばねの付与力により突出した前方接地部16a及び/又は後方接地部16rが接地した状態における車体姿勢の安定性を倒立制御実行時に予測し、不安定であると判定した場合にはすべりねじ伝動装置を動作させて、予測される接地状態を安定化させることができる。
【0150】
なお、本発明は前記実施の形態に限定されるものではなく、本発明の趣旨に基づいて種々変形させることが可能であり、それらを本発明の範囲から排除するものではない。
【産業上の利用可能性】
【0151】
本発明は、倒立振り子の姿勢制御を利用した車両に適用することができる。
【符号の説明】
【0152】
10 車両
12 駆動輪
16 ストッパ
16a 前方接地部
16b 後方接地部
16f 前方部
16r 後方部
17 重心
20 制御ECU
【特許請求の範囲】
【請求項1】
回転可能に車体に取り付けられた駆動輪と、
前記車体の姿勢角度を制限する姿勢制限手段と、
前記駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、
該車両制御装置は、
車両の走行速度に応じて減速度を予測する減速度予測手段と、
該減速度予測手段によって予測された減速度に応じて、前記姿勢制限手段の位置及び/又は形状を制御する姿勢制限制御手段とを備えることを特徴とする車両。
【請求項2】
前記減速度予測手段は、車両が停止するまでの時間である車両制動時間を予測し、
前記車両制御装置は、前記姿勢制限手段が機能するまでの時間である車体傾斜時間を予測する傾斜時間予測手段を更に備え、
前記姿勢制限制御手段は、前記減速度予測手段によって予測された前記車両制動時間と前記傾斜時間予測手段によって予測された前記車体傾斜時間に応じて、前記姿勢制限手段を制御する請求項1に記載の車両。
【請求項3】
前記姿勢制限制御手段は、前記車両制動時間が前記車体傾斜時間よりも短い場合には、第1の状態に前記姿勢制限手段を制御し、前記車両制動時間が前記車体傾斜時間よりも長い場合には、第1の状態と異なる第2の状態に前記姿勢制限手段を制御する請求項2に記載の車両。
【請求項4】
前記傾斜時間予測手段は、前記車体の姿勢角度に応じて前記車体傾斜時間を予測する請求項2又は3に記載の車両。
【請求項5】
前記車両制御装置は、前記減速度予測手段によって予測された減速度の時間変化から接地荷重中心点を予測する接地荷重中心点予測手段と、を更に備え、
前記姿勢制限手段は、該接地荷重中心点予測手段によって予測された接地荷重中心点に応じて、前記姿勢制限手段を制御する請求項1〜4のいずれか1項に記載の車両。
【請求項6】
前記姿勢制限手段は、路面に接地した状態で前記車体の姿勢を制限し、
前記姿勢制限制御手段は、前記接地荷重中心点予測手段によって予測された接地荷重中心点の位置である第1の位置と、前記駆動輪が路面に接地する位置である第2の位置と、前記姿勢制限手段が路面に接地する位置である第3の位置について、前記第1の位置が前記第2の位置と前記第3の位置との間にあるように前記姿勢制限手段を制御する請求項5に記載の車両。
【請求項7】
前記第2の位置と前記第3の位置から等しい距離にある第4の位置について、該第4の位置に対する前記第1の位置の相対位置を表す接地荷重偏心度を算出する接地荷重偏心度算出手段を更に備え、
前記姿勢制限制御手段は、算出された接地荷重偏心度が所定範囲内になるように前記姿勢制限手段を制御する請求項5又は6に記載の車両。
【請求項8】
前記制限値制御手段は、前記車体の姿勢の制御が行われている時に前記姿勢制限手段を制御する請求項1〜7のいずれか1項に記載の車両。
【請求項9】
前記車体の姿勢の制御の続行が可能か不可能かを判定する制御可能判定手段と、
前記車体の姿勢の制御を続行するか停止するかを指令する信号を取得する制御指令取得手段と、を更に備え、
前記車両制御装置は、前記制御可能判定手段が不可能と判定した時、又は、前記制御指令取得手段が停止を指令する信号を取得した時に、前記姿勢制限手段を固定する請求項1〜8のいずれか1項に記載の車両。
【請求項10】
前記姿勢制限手段は、前記駆動輪の回転軸に平行で前記駆動輪に接する所定の平面である基準面について、前記車体の姿勢角度を固定したとき、常に前記基準面に分断されること無く、前記基準面に接した状態を維持したまま位置及び/又は形状を変化させる機構を備える請求項1〜9のいずれか1項に記載の車両。
【請求項1】
回転可能に車体に取り付けられた駆動輪と、
前記車体の姿勢角度を制限する姿勢制限手段と、
前記駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、
該車両制御装置は、
車両の走行速度に応じて減速度を予測する減速度予測手段と、
該減速度予測手段によって予測された減速度に応じて、前記姿勢制限手段の位置及び/又は形状を制御する姿勢制限制御手段とを備えることを特徴とする車両。
【請求項2】
前記減速度予測手段は、車両が停止するまでの時間である車両制動時間を予測し、
前記車両制御装置は、前記姿勢制限手段が機能するまでの時間である車体傾斜時間を予測する傾斜時間予測手段を更に備え、
前記姿勢制限制御手段は、前記減速度予測手段によって予測された前記車両制動時間と前記傾斜時間予測手段によって予測された前記車体傾斜時間に応じて、前記姿勢制限手段を制御する請求項1に記載の車両。
【請求項3】
前記姿勢制限制御手段は、前記車両制動時間が前記車体傾斜時間よりも短い場合には、第1の状態に前記姿勢制限手段を制御し、前記車両制動時間が前記車体傾斜時間よりも長い場合には、第1の状態と異なる第2の状態に前記姿勢制限手段を制御する請求項2に記載の車両。
【請求項4】
前記傾斜時間予測手段は、前記車体の姿勢角度に応じて前記車体傾斜時間を予測する請求項2又は3に記載の車両。
【請求項5】
前記車両制御装置は、前記減速度予測手段によって予測された減速度の時間変化から接地荷重中心点を予測する接地荷重中心点予測手段と、を更に備え、
前記姿勢制限手段は、該接地荷重中心点予測手段によって予測された接地荷重中心点に応じて、前記姿勢制限手段を制御する請求項1〜4のいずれか1項に記載の車両。
【請求項6】
前記姿勢制限手段は、路面に接地した状態で前記車体の姿勢を制限し、
前記姿勢制限制御手段は、前記接地荷重中心点予測手段によって予測された接地荷重中心点の位置である第1の位置と、前記駆動輪が路面に接地する位置である第2の位置と、前記姿勢制限手段が路面に接地する位置である第3の位置について、前記第1の位置が前記第2の位置と前記第3の位置との間にあるように前記姿勢制限手段を制御する請求項5に記載の車両。
【請求項7】
前記第2の位置と前記第3の位置から等しい距離にある第4の位置について、該第4の位置に対する前記第1の位置の相対位置を表す接地荷重偏心度を算出する接地荷重偏心度算出手段を更に備え、
前記姿勢制限制御手段は、算出された接地荷重偏心度が所定範囲内になるように前記姿勢制限手段を制御する請求項5又は6に記載の車両。
【請求項8】
前記制限値制御手段は、前記車体の姿勢の制御が行われている時に前記姿勢制限手段を制御する請求項1〜7のいずれか1項に記載の車両。
【請求項9】
前記車体の姿勢の制御の続行が可能か不可能かを判定する制御可能判定手段と、
前記車体の姿勢の制御を続行するか停止するかを指令する信号を取得する制御指令取得手段と、を更に備え、
前記車両制御装置は、前記制御可能判定手段が不可能と判定した時、又は、前記制御指令取得手段が停止を指令する信号を取得した時に、前記姿勢制限手段を固定する請求項1〜8のいずれか1項に記載の車両。
【請求項10】
前記姿勢制限手段は、前記駆動輪の回転軸に平行で前記駆動輪に接する所定の平面である基準面について、前記車体の姿勢角度を固定したとき、常に前記基準面に分断されること無く、前記基準面に接した状態を維持したまま位置及び/又は形状を変化させる機構を備える請求項1〜9のいずれか1項に記載の車両。
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【図13】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【図13】
【公開番号】特開2010−173604(P2010−173604A)
【公開日】平成22年8月12日(2010.8.12)
【国際特許分類】
【出願番号】特願2009−21509(P2009−21509)
【出願日】平成21年2月2日(2009.2.2)
【出願人】(591261509)株式会社エクォス・リサーチ (1,360)
【Fターム(参考)】
【公開日】平成22年8月12日(2010.8.12)
【国際特許分類】
【出願日】平成21年2月2日(2009.2.2)
【出願人】(591261509)株式会社エクォス・リサーチ (1,360)
【Fターム(参考)】
[ Back to top ]