車両
【課題】駆動輪回転状態の計測値と推定値とを比較することによって、駆動輪回転状態の計測値の異常を確実に検出することができるようにする。
【解決手段】回転可能に車体に取り付けられた駆動輪１２と、該駆動輪１２に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、前記駆動輪の回転角速度を計測する回転計測手段と、鉛直軸に対する前記車体の傾斜状態及び前記駆動トルクによって前記駆動輪１２の回転角速度を推定する回転推定手段と、前記回転計測手段によって計測された回転角速度と前記回転推定手段によって推定された回転角速度との差の絶対値が所定値より大きい場合に前記回転計測手段によって計測された回転角速度が異常であると判定する判定手段と、を備える。
【解決手段】回転可能に車体に取り付けられた駆動輪１２と、該駆動輪１２に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、前記駆動輪の回転角速度を計測する回転計測手段と、鉛直軸に対する前記車体の傾斜状態及び前記駆動トルクによって前記駆動輪１２の回転角速度を推定する回転推定手段と、前記回転計測手段によって計測された回転角速度と前記回転推定手段によって推定された回転角速度との差の絶対値が所定値より大きい場合に前記回転計測手段によって計測された回転角速度が異常であると判定する判定手段と、を備える。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、倒立振り子の姿勢制御を利用した車両に関するものである。
【背景技術】
【０００２】
従来、倒立振り子の姿勢制御を利用した車両に関する技術が提案されている。例えば、同軸上に配設された２つの駆動輪を有し、運転者の重心移動による車体の姿勢変化を感知して駆動する車両、球体状の単一の駆動輪に取り付けられた車体の姿勢を制御しながら移動する車両等の技術が提案されている（例えば、特許文献１参照。）。
【０００３】
この場合、センサで車体の傾斜動作や駆動輪の回転動作の状態を検出しながら、車体や駆動輪の動作を制御して車両を停止又は移動させるようになっている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２００４−１２９４３５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
前記従来の車両においては、センサによって取得した駆動輪の回転状態の計測値によって車両の走行と共に車体の姿勢を制御しているため、計測値として正しい値を取得できない場合、すなわち、異常状態である場合、その異常を検出して、異常状態に応じた制御を実行する必要がある。例えば、センサが故障した場合、センサから送信される故障状態を示す信号を受信したときに、センサの計測値が異常状態にあると判断できる。
【０００６】
しかしながら、センサの出力信号へのノイズの混入等によって異常な計測値を取得したときには、センサ自体の故障でないため、異常を検出することができない。
【０００７】
もっとも、このような事態に備えて、あらかじめ複数のセンサを用意し、各センサの計測値を相互に参照して計測値が正常であることを確認することが考えられる。しかし、複数のセンサを用意すると、高価で複雑なシステムになってしまう。つまり、安価で簡素なシステムによって、十分な安全性や利便性を保障することは、困難である。
【０００８】
本発明は、前記従来の車両の問題点を解決して、駆動輪回転状態の計測値と推定値とを比較することによって、駆動輪回転状態の計測値の異常を確実に検出することができ、より安全で便利で安価な車両を提供することを目的とする。
【課題を解決するための手段】
【０００９】
そのために、本発明の車両においては、回転可能に車体に取り付けられた駆動輪と、該駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、前記駆動輪の回転角速度を計測する回転計測手段と、鉛直軸に対する前記車体の傾斜状態及び前記駆動トルクによって前記駆動輪の回転角速度を推定する回転推定手段と、前記回転計測手段によって計測された回転角速度と前記回転推定手段によって推定された回転角速度との差の絶対値が所定値より大きい場合に前記回転計測手段によって計測された回転角速度が異常であると判定する判定手段と、を備える。
【００１０】
本発明の他の車両においては、さらに、前記車両制御装置は、前記判定手段が前記回転計測手段によって計測された回転角速度が異常であると判定すると、異常を報知する報知手段を更に備える。
【００１１】
本発明の更に他の車両においては、さらに、前記判定手段は、前記回転計測手段によって計測された回転角速度を前記車体の姿勢の制御に使用することが可能であるか否かを判定し、前記車両制御装置は、前記判定手段が可能であると判定した場合には前記回転計測手段によって計測された回転角速度に応じて前記駆動トルクの値を決定し、前記判定手段が可能でないと判定した場合には前記回転推定手段によって推定された回転角速度に応じて前記駆動トルクの値を決定する。
【００１２】
本発明の更に他の車両においては、さらに、前記判定手段は、前記差の絶対値が第１の所定値より大きく、かつ、第２の所定値以下である場合には、前記回転計測手段によって計測された回転角速度が異常であるが、前記車体の姿勢の制御に使用することが可能であると判定し、前記差の絶対値が第２の所定値より大きい場合には、前記回転計測手段によって計測された回転角速度が異常であり、前記車体の姿勢の制御に使用することが可能でないと判定する。
【００１３】
本発明の更に他の車両においては、さらに、前記判定手段は、前記差の絶対値の累乗を第１の所定時間にわたって積分した第１の時間積分値が第１の所定積分値より大きく、かつ、前記差の絶対値の累乗を第２の所定時間にわたって積分した第２の時間積分値が第２の所定積分値以下である場合には前記回転計測手段によって計測された回転角速度が異常であるが、前記車体の姿勢の制御に使用することが可能であると判定し、前記第２の時間積分値が第２の所定積分値より大きい場合には前記回転計測手段によって計測された回転角速度が異常であり、前記車体の姿勢の制御に使用することが可能でないと判定する。
【００１４】
本発明の更に他の車両においては、さらに、前記判定手段は、前記第１の所定時間より短い前記第２の所定時間と、前記第１の所定積分値を前記第１の所定時間で除した値よりも前記第２の所定積分値を前記第２の所定時間で除した値の方が大きくなるような前記第２の所定積分値に基づいて判定する。
【００１５】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記車両の走行抵抗の特性量である抵抗パラメータを取得する抵抗パラメータ取得手段を更に備え、前記傾斜推定手段は、前記抵抗パラメータ取得手段によって取得された抵抗パラメータによって前記回転角速度の推定値を補正する。
【００１６】
本発明の更に他の車両においては、さらに、路面形状を計測する路面形状計測手段を更に備え、前記抵抗パラメータ取得手段は、前記路面形状計測手段によって計測された前記路面形状によって前記抵抗パラメータを推定する。
【００１７】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記車体の重心位置のずれ量を取得する重心ずれ量取得手段を更に備え、前記回転推定手段は、前記重心ずれ量取得手段によって取得された重心ずれ量によって前記回転角速度の推定値を補正する。
【００１８】
本発明の更に他の車両においては、さらに、前記乗員及び／又は重量物を搭載する搭乗部と、該搭乗部の荷重分布を計測する荷重分布計測手段と、を更に備え、前記重心ずれ量取得手段は、前記荷重分布計測手段によって計測された前記荷重分布によって前記重心ずれ量を推定する。
【発明の効果】
【００１９】
請求項１の構成によれば、検証用のセンサを別途用意することなく、駆動輪の回転角速度の計測値の異常を確実に検出することが可能であり、安価で安全な倒立型車両を実現できる。
【００２０】
請求項２の構成によれば、計測値の異常時において、その異常に対応する制御の結果として通常時と同様の動作を実現できている場合においても、乗員に駆動輪回転角速度計測値が異常状態にあることを確実に認識させ、乗員に点検や修理を促すことができる。
【００２１】
請求項３の構成によれば、倒立姿勢での走行中に駆動輪回転角速度計測値の取得が突然不可能になった場合においても、倒立姿勢での走行状態を維持し、退避走行等を可能とする。
【００２２】
請求項４の構成によれば、駆動輪回転角速度の計測値と推定値のどちらを用いるかを計測値の異常の程度に応じて判断することで、適切な制御方法を選択することができる。
【００２３】
請求項５の構成によれば、計測値の時間履歴を判断材料とし、更に２つの異なる基準を設けることで、異常状態及び計測値の使用可否をより適切に判断できる。
【００２４】
請求項６の構成によれば、深刻な異常を短時間で検出することで、深刻な異常への対応を早めるのと共に、判定が困難である微妙な異常を長時間のデータに基づいて判定することで、異常判定の精度を高めることができる。
【００２５】
請求項７の構成によれば、走行抵抗の影響を考慮することで、走行路面の勾（こう）配や粗さの違いに伴う駆動輪回転角速度の推定精度の低下を防ぐことができる。
【００２６】
請求項８の構成によれば、路面形状を計測することで、走行抵抗の特性をより正確に推定し、走行抵抗による影響を正しく補償することができる。
【００２７】
請求項９の構成によれば、車体傾斜状態の力学モデルに基づく駆動輪回転角加速度の推定値を駆動輪回転角速度の推定に用いる場合に、車体の重心位置のずれを考慮することで、より高精度に駆動輪回転角加速度及び駆動輪回転角速度を推定できる。
【００２８】
請求項１０の構成によれば、搭乗部の荷重分布を計測することで、車体の重心位置を正確に把握し、重心位置のずれによる影響を正確に補償することができる。
【図面の簡単な説明】
【００２９】
【図１】本発明の実施の形態における車両の構成を示す図である。
【図２】本発明の実施の形態における車両の制御システムの構成を示すブロック図である。
【図３】本発明の実施の形態における車両の走行及び姿勢制御処理の動作を示すフローチャートである。
【図４】本発明の実施の形態における状態量の取得処理の動作を示すフローチャートである。
【図５】本発明の実施の形態における車両の各重心位置を示す図である。
【図６】本発明の実施の形態における主状態量取得処理の動作を示すフローチャートである。
【図７】本発明の実施の形態における目標走行状態の決定処理の動作を示すフローチャートである。
【図８】本発明の実施の形態における目標車体姿勢の決定処理の動作を示すフローチャートである。
【図９】本発明の実施の形態におけるアクチュエータ出力の決定処理の動作を示すフローチャートである。
【発明を実施するための形態】
【００３０】
以下、本発明の実施の形態について図面を参照しながら詳細に説明する。
【００３１】
図１は本発明の実施の形態における車両の構成を示す図、図２は本発明の実施の形態における車両の制御システムの構成を示すブロック図である。
【００３２】
図において、１０は、本実施の形態における車両であり、車体の本体部１１、駆動輪１２、支持部１３、及び、乗員１５が搭乗するとともに、搭載物１８が搭載される搭乗部１４を有し、前記車両１０は、車体を前後に傾斜させることができるようになっている。そして、倒立振り子の姿勢制御と同様に車体の姿勢を制御する。図１に示される例において、車両１０は右方向に前進し、左方向に後退することができる。
【００３３】
前記駆動輪１２は、車体の一部である支持部１３に対して回転可能に支持され、駆動アクチュエータとしての駆動モータ５２によって駆動される。なお、駆動輪１２の軸は図１に示す平面に垂直な方向に存在し、駆動輪１２はその軸を中心に回転する。また、前記駆動輪１２は、単数であっても複数であってもよいが、複数である場合、同軸上に並列に配設される。本実施の形態においては、駆動輪１２が２つであるものとして説明する。この場合、各駆動輪１２は個別の駆動モータ５２によって独立して駆動される。なお、駆動アクチュエータとしては、例えば、油圧モータ、内燃機関等を使用することもできるが、ここでは、電気モータである駆動モータ５２を使用するものとして説明する。
【００３４】
また、車体の一部である本体部１１は、支持部１３によって下方から支持され、駆動輪１２の上方に位置する。そして、本体部１１には、車両１０の運転者である乗員１５が搭乗する搭乗部１４が取り付けられている。
【００３５】
本実施の形態においては、説明の都合上、搭乗部１４には乗員１５が搭乗するとともに荷物等としての搭載物１８が搭載されている例について説明するが、搭乗部１４には必ずしも乗員１５が搭乗している必要はなく、例えば、車両１０がリモートコントロールによって操縦される場合には、搭乗部１４に乗員１５が搭乗していなくてもよい。また、同様に、搭乗部１４には必ずしも搭載物１８が搭載されている必要はなく、搭載物１８は省略することができる。
【００３６】
なお、前記搭乗部１４は、乗用車、バス等の自動車に使用されるシートと同様のものであり、座面部、背もたれ部及びヘッドレストを備える。
【００３７】
前記搭乗部１４の脇（わき）には、目標走行状態取得装置としてのジョイスティック３１を備える入力装置３０が配設されている。乗員１５は、操縦装置であるジョイスティック３１を操作することによって、車両１０を操縦する、すなわち、車両１０の加速、減速、旋回、その場回転、停止、制動等の走行指令を入力するようになっている。なお、乗員１５が操作して走行指令を入力することができる装置であれば、ジョイスティック３１に代えて他の装置、例えば、ジョグダイヤル、タッチパネル、押しボタン等の装置を目標走行状態取得装置として使用することもできる。
【００３８】
なお、車両１０がリモートコントロールによって操縦される場合には、前記ジョイスティック３１に代えて、コントローラからの走行指令を有線又は無線で受信する受信装置を目標走行状態取得装置として使用することができる。また、車両１０があらかじめ決められた走行指令データに従って自動走行する場合には、前記ジョイスティック３１に代えて、半導体メモリ、ハードディスク等の記憶媒体に記憶された走行指令データを読み取るデータ読取り装置を目標走行状態取得装置として使用することができる。
【００３９】
また、図示していないが、入力装置３０には、報知手段としての表示ランプが配設されている。車両１０の状態が異常であるとき、表示ランプを点灯させることで、乗員１５にそれを認識させることができる。
【００４０】
なお、表示ランプに代えて、画面上に所定の内容を表示するディスプレイや所定の発信音又は音声を発するスピーカ等の装置を報知手段として使用することもできる。
【００４１】
さらに、車両１０の支持部１３には、姿勢制限手段としてのストッパ１６が取り付けられている。そして、倒立制御を停止した時には、前記ストッパ１６の前端又は後端のストッパ接地点が路面に接地することによって車体の姿勢角度を制限し、車体が所定角度、すなわち、車体傾斜角制限値以上に傾斜することを防止する。
【００４２】
また、車両１０は、車両制御装置としての制御ＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）２０を有し、該制御ＥＣＵ２０は、主制御ＥＣＵ２１及び駆動輪制御ＥＣＵ２２を備える。前記制御ＥＣＵ２０並びに主制御ＥＣＵ２１及び駆動輪制御ＥＣＵ２２は、ＣＰＵ、ＭＰＵ等の演算手段、磁気ディスク、半導体メモリ等の記憶手段、入出力インターフェイス等を備え、車両１０の各部の動作を制御するコンピュータシステムであり、例えば、本体部１１に配設されるが、支持部１３や搭乗部１４に配設されていてもよい。また、前記主制御ＥＣＵ２１及び駆動輪制御ＥＣＵ２２は、それぞれ、別個に構成されていてもよいし、一体に構成されていてもよい。
【００４３】
そして、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、駆動輪センサ５１及び駆動モータ５２とともに、駆動輪１２の動作を制御する駆動輪制御システム５０の一部として機能する。前記駆動輪センサ５１は、レゾルバ、エンコーダ等から成り、回転計測手段として機能し、駆動輪１２の回転状態を示す駆動輪回転角及び／又は回転角速度を検出し、主制御ＥＣＵ２１に送信する。また、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、該駆動輪制御ＥＣＵ２２は、受信した駆動トルク指令値に相当する入力電圧を駆動モータ５２に供給する。そして、該駆動モータ５２は、入力電圧に従って駆動輪１２に駆動トルクを付与し、これにより、駆動アクチュエータとして機能する。
【００４４】
また、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、車体傾斜センサ４１及び駆動モータ５２とともに、車体の姿勢を制御する車体制御システム４０の一部として機能する。前記車体傾斜センサ４１は、加速度センサ、ジャイロセンサ等から成り、傾斜計測手段として機能し、車体の傾斜状態を示す車体傾斜角及び／又は傾斜角速度を検出し、主制御ＥＣＵ２１に送信する。そして、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信する。
【００４５】
さらに、主制御ＥＣＵ２１は、荷重分布計測手段としての搭乗部センサ６１とともに、搭乗部１４の座面荷重分布を計測する搭乗部計測システム６０の一部として機能する。前記搭乗部センサ６１は、搭乗部１４の取付部に配設された複数の１軸荷重センサ等から成り、搭載荷重パラメータとして搭乗部１４上の乗員１５及び搭載物１８の重量及び荷重分布を検出し、主制御ＥＣＵ２１に送信する。
【００４６】
さらに、主制御ＥＣＵ２１は、路面形状計測手段としての路面センサ７１とともに、路面の状態を計測する路面計測システム７０の一部として機能する。前記路面センサ７１は、車体の前後、例えば、本体部１１の下面の前後端等に配設された撮像装置等の画像センサから成り、撮影した路面画像データを主制御ＥＣＵ２１に送信する。
【００４７】
加えて、主制御ＥＣＵ２１には、入力装置３０のジョイスティック３１から走行指令が入力される。そして、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信する。
【００４８】
さらに、主制御ＥＣＵ２１は、駆動輪１２の回転状態を推定する回転推定手段として機能するとともに、駆動輪１２の回転状態の計測値を取得すること及び計測値を制御に使用することが可能であるかを判定する判定手段、走行抵抗パラメータを取得する抵抗パラメータ取得手段、及び、車体重心ずれ量を取得する車体重心ずれ量取得手段としても機能する。
【００４９】
なお、各センサは、複数の状態量を取得するものであってもよい。例えば、車体傾斜センサ４１として加速度センサとジャイロセンサとを併用し、両者の計測値から車体傾斜角と傾斜角速度とを決定するようにしてもよい。また、図１に記載された数字以外の記号については、後述する。
【００５０】
次に、前記構成の車両１０の動作について説明する。まず、走行及び姿勢制御処理の概要について説明する。
【００５１】
図３は本発明の実施の形態における車両の走行及び姿勢制御処理の動作を示すフローチャートである。
【００５２】
本実施の形態においては、駆動輪センサ５１による駆動輪回転状態の測定値と推定値とを比較して、駆動輪回転角速度の計測値の異常を検出する。具体的には、車体傾斜角加速度と駆動トルクの時間履歴から駆動輪回転角速度を推定する。また、搭乗部センサ６１による車体重心ずれ量の計測値によって、駆動輪回転角速度の推定値を補正する。さらに、駆動輪回転角加速度を別の力学モデルにより推定し、走行抵抗推定値に応じて補正する。そして、駆動輪回転角速度の計測値と推定値の差が所定値より大きい場合、駆動輪回転角速度の計測値を異常とみなす。これにより、駆動輪回転角速度の計測値の異常を確実に検出することを可能とし、より安全で便利で安価な倒立型の車両１０を提供することができる。
【００５３】
走行及び姿勢制御処理において、制御ＥＣＵ２０は、まず、状態量の取得処理を実行し（ステップＳ１）、各センサ、すなわち、駆動輪センサ５１、車体傾斜センサ４１、搭乗部センサ６１及び路面センサ７１、並びに、状態量推定手段によって、駆動輪１２の回転状態及び車体の傾斜状態を取得する。
【００５４】
次に、制御ＥＣＵ２０は、目標走行状態の決定処理を実行し（ステップＳ２）、ジョイスティック３１の操作量に基づいて、車両１０の加速度の目標値、及び、駆動輪１２の回転角速度の目標値を決定する。
【００５５】
次に、制御ＥＣＵ２０は、目標車体姿勢の決定処理を実行し（ステップＳ３）、目標走行状態の決定処理によって決定された車両１０の加速度の目標値と駆動輪１２の回転角速度の目標値に基づいて、車体姿勢の目標値として、車体傾斜角の目標値を決定する。
【００５６】
最後に、制御ＥＣＵ２０は、アクチュエータ出力の決定処理を実行し（ステップＳ４）、状態量の取得処理によって取得された各状態量、目標走行状態の決定処理によって決定された目標走行状態、及び、目標車体姿勢の決定処理によって決定された目標車体姿勢に基づいて、各アクチュエータの出力、すなわち、駆動モータ５２の出力を決定する。
【００５７】
次に、走行及び姿勢制御処理の詳細について説明する。まず、状態量の取得処理について説明する。
【００５８】
図４は本発明の実施の形態における状態量の取得処理の動作を示すフローチャートである。
【００５９】
本実施の形態においては、状態量、入力、パラメータ、物理定数等を次のような記号によって表す。なお、図１には状態量やパラメータの一部が示されている。また、図１において、ｘp は車体の前後方向座標軸、ｚp は車体の上下方向座標軸、６２は乗員１５及び搭載物１８の重心位置（座標：ｘpG、ｚpG）である。
ＦS(i)：搭乗部センサ計測値（引張荷重を正、添字（ｉ）はｉ番目のセンサを表す）
ｘpS(i) ：搭乗部センサ位置（添字（ｉ）はｉ番目のセンサを表す）
θ1 ：車体傾斜角
λS ：搭乗部位置
α ：車両加速度〔Ｇ〕
ｍS0：乗員（搭載物）を除く搭乗部の重量
ｘS0：乗員（搭載物）を除く搭乗部の重心位置
ｌ1 ：車軸から搭乗部重心までの距離（基準値）
ｆ0 ：角速度換算振動数（所定値）
θR,sh：慣性力傾斜角の閾（しきい）値（所定値）
αS,sh：搭乗部相対加速度の閾値（所定値）
ζ0 ＝Δｔ／ＴLPF
Δｔ：搭乗部センサ計測周期（所定値）
ＴLPF ：ローパスフィルタ時定数（所定値）
ｇ：重力加速度〔ｍ／ｓ2 〕
状態量の取得処理において、主制御ＥＣＵ２１は、まず、主たる状態量である駆動輪回転状態量及び車体傾斜状態量をそれぞれ取得するための主状態量取得処理を実行する（ステップＳ１−１）。
【００６０】
次に、主状態量取得処理について説明する。
【００６１】
図５は本発明の実施の形態における車両の各重心位置を示す図、図６は本発明の実施の形態における主状態量取得処理の動作を示すフローチャートである。
【００６２】
続いて、主制御ＥＣＵ２１は、車体重心ずれ量を推定する（ステップＳ１−１−２）。具体的には、まず、乗員１５と搭載物１８の重量ｍp を下記の式によって取得する。なお、図５において、１７は車両１０の重心位置（座標：ＸG 、ＺG ）である。
【００６３】
【数１】
【００６４】
また、乗員１５と搭載物１８の重心位置ｘpGを下記の式によって取得する。
【００６５】
【数２】
【００６６】
ここで、上付き添字（ｎ）は時系列のｎ番目のデータであることを表す。なお、各時系列データの初期値には、所定の各基準値をあらかじめ与える。
【００６７】
【数３】
【００６８】
このように、本実施の形態においては、複数の搭乗部センサ６１の計測値に基づいて、搭載荷重パラメータを推定する。つまり、乗員１５と搭載物１８を合わせた重量ｍp 、及び、その重心位置を推定する。具体的には、搭乗部センサ６１の計測値の総和に基づいて、重量ｍp を推定する。また、複数の搭乗部センサ６１によって計測された搭乗部１４の前後の荷重分布に基づいて、重心位置を推定する。
【００６９】
ここで、θR ≦θR,shの場合、すなわち、重力と慣性力の合力が搭乗部１４に対して比較的垂直な方向に作用している場合、（例えば、直立停止状態にある場合）、荷重分布に基づいて重心位置ｘpGの値のみを修正する。
【００７０】
また、θR ＞θR,shの場合、すなわち、重力と慣性力の合力が搭乗部１４に水平な方向にある程度作用する場合、（例えば、車体傾斜時や車両１０の加減速時）、荷重分布に基づいて重心高さｚpGの値のみを修正する。
【００７１】
すなわち、重心位置及び重心高さの推定においては、搭乗部１４に作用するピッチングモーメントの発生要因を考慮し、重心高さがほとんど寄与しないときには重心位置を高精度に推定し、重心高さがピッチングモーメントにある程度寄与するときには既に推定した重心位置に基づいて重心高さを推定する。また、一方の推定時には他方の値を固定する。これにより、搭乗部センサ６１のみで高精度に重心位置を推定することができる。
【００７２】
また、車体姿勢の変化が大きいときには、重心位置推定値を固定する。αS ＞αS,shの場合、すなわち、車体傾斜角速度や角加速度が所定の閾値よりも大きい場合、重心位置の推定値を修正せず、その前の推定値を維持する。このように、搭乗部１４に作用するピッチングモーメントの発生要因を考慮して、それが重心位置の違いのみによると判断した場合に限り、重心位置を推定する。したがって、倒立車両特有の現象である車体姿勢変化の影響を回避し、搭乗部センサ６１のみで高精度で安定な推定を実行できる。
【００７３】
また、本実施の形態においては、複数の搭乗部センサ６１による座面荷重分布の計測値に基づいて、重心位置を推定しているが、他のセンサを追加して推定してもよい。例えば、レーザレーダ等によって乗員１５及び搭載物１８の形状を取得する形状センサを備え、取得した形状に基づいて重心の高さを推定してもよい。
【００７４】
また、搭乗部センサ６１として、より簡素なシステムを用いてもよい。例えば、搭乗部センサ６１を１つだけ備え、その計測値である重量から統計的知見に基づいて重心位置を推定してもよい。また、センサの代わりに入力装置を備え、乗員１５が自身の体重や身長及び搭載物１８の重量や形状のデータを入力装置によって入力又は送信し、そのデータに基づいて、重心位置を推定してもよい。
【００７５】
そして、主制御ＥＣＵ２１は、取得した搭乗者パラメータである重量ｍp 及び重心位置ｘpGに基づき、次の式（１）によって、車体重心ずれ量δx を推定する。
【００７６】
【数４】
【００７７】
ここで、ｍ1bは乗員１５及び搭載物１８がないときの車両重量、δx0は乗員１５及び搭載物１８がなく、直立時における搭乗部１４の基準位置が駆動輪接地点を通る鉛直軸上にあるときの重心位置である。
【００７８】
このように、本実施の形態においては、搭乗者パラメータに基づいて、車体重心ずれ量δx を推定する。つまり、乗員１５及び搭載物１８の重心位置について、基準値との差異を考慮する。このように、実際の車体パラメータを把握することで、より高精度な推定及び判定を実現できる。
【００７９】
続いて、主制御ＥＣＵ２１は、走行抵抗パラメータを取得する（ステップＳ１−１−３）。具体的には、次の式（２）によって走行抵抗定数τD0を決定し、次の式（３）によって走行抵抗比例係数ＣD を決定する。
τD0＝ＭｇＲW sin η＋（１＋βR ）τD0,S ・・・式（２）
ＣD ＝（１＋βR ）ＣD,S ・・・式（３）
なお、ηは路面勾配であり、路面センサ７１によって取得された路面画像データに基づいて決定される。また、βR は走行抵抗増加率であり、こちらも路面センサ７１によって取得された路面画像データに基づいて決定される。さらに、τD0,S及びＣD,S は走行抵抗パラメータ基準値であり、所定値をあらかじめ与える。
【００８０】
本実施の形態においては、路面センサ７１によって取得された路面情報に基づいて、走行抵抗パラメータである走行抵抗定数τD0及び走行抵抗比例係数ＣD を決定する。
【００８１】
また、路面の形状を考慮して、走行抵抗パラメータを修正する。具体的には、路面勾配ηに応じて、走行抵抗定数τD0を増加させる。なお、坂路上での車両走行状態に関する力学モデルに基づき、適切な値を走行抵抗定数として与える。これにより、坂路を走行中であっても、高精度な状態量の推定及び異常判定を実現できる。
【００８２】
さらに、路面の状態を考慮して、走行抵抗比例係数ＣD を修正する。具体的には、路面画像データに基づいて路面の状態を推定し、その結果に応じて走行抵抗パラメータを修正する。凸凹路等の走行抵抗が高いと予想される路面を検出した場合には、走行抵抗増加率βR に所定の正の値を与える。また、コンクリート路面等の走行抵抗が低いと予想される路面を検出した場合には、走行抵抗増加率βR に所定の負の値を与える。これにより、路面の状態に関わらず、高精度な状態量の推定及び異常判定を実現できる。
【００８３】
なお、本実施の形態においては、路面センサ７１としての画像センサによって取得された情報に基づいて、走行抵抗パラメータを修正しているが、他の方法で修正してもよい。例えば、路面状態を含む地図情報を取得可能なナビゲーションシステムを具備し、その地図情報と現在の車両位置とに基づいて、路面状態及び走行抵抗パラメータを取得してもよい。また、路面の状態を選択的又は定量的に入力可能な路面情報入力装置を具備し、使用環境に応じて乗員１５が入力した情報に基づいて、路面状態及び走行抵抗パラメータを取得してもよい。
【００８４】
続いて、主制御ＥＣＵ２１は、駆動輪回転状態量を推定する（ステップＳ１−１−４）。具体的には、各状態量と駆動トルクの時間履歴、及び、各推定パラメータから、次の式（４）により駆動輪回転角速度を推定する。
【００８５】
【数５】
【００８６】
本実施の形態においては、車体傾斜状態と駆動トルクの時間履歴、及び、パラメータ推定値を用いて、駆動輪１２の回転運動に関する力学モデルに基づいて、駆動輪回転角速度を推定する。その際、駆動トルク、車両１０の加減速に対する慣性、車体傾斜による重心移動の作用、及び、走行抵抗トルクを考慮し、それらの大きさの関係から、走行抵抗トルクを推定する。そして、該走行抵抗トルクと駆動輪回転角速度に線形関係があるという仮定の下で、駆動輪回転角速度を推定する。このように、力学モデルにおける各状態とトルクの理論的な関係を利用することで、未知の駆動輪回転角速度を推定できる。
【００８７】
また、走行抵抗パラメータの計測値によって、駆動輪回転角速度の推定値を決定する。具体的には、駆動輪１２の回転運動に関する力学モデルとの偏差に相当する走行抵抗トルクの特性を計測によって取得することにより、推定の精度を向上させる。これにより、走行抵抗の作用が駆動輪回転状態の計測値の異常誤差と認識されることを防止して、より信頼性の高い異常判定が可能となる。
【００８８】
さらに、駆動輪回転角加速度を別の力学モデルによって推定する。具体的には、駆動輪回転角加速度を駆動輪回転角速度とは独立な状態量とみなし、車体の傾斜運動に関する力学モデルによって推定する。その際、重力トルク、車体の回転慣性、車両の加減速に伴う慣性力、及び、駆動トルクの反トルクを考慮する。このように、駆動輪回転角加速度を別のモデルから推定することにより、加速度の積分に伴う誤差の蓄積、及び、推定計算の不安定化を回避し、安定で高精度な駆動輪回転角速度の推定を実現する。
【００８９】
なお、本実施の形態においては、簡単な線形モデルにより駆動輪回転角速度を推定しているが、より厳密なモデルによって推定してもよい。例えば、非線形的な作用や車体回転に対する粘性抵抗等の要素を考慮したモデルを用いて、より厳密に推定してもよい。また、より簡単なモデルによって推定してもよい。
【００９０】
続いて、主制御ＥＣＵ２１は、駆動輪回転状態量を取得する（ステップＳ１−１−５）。
【００９１】
続いて、主制御ＥＣＵ２１は、計測値は正常であるか否かを判断し（ステップＳ１−１−６）、正常でない場合には、さらに、異常疑惑であるか否かを判断する（ステップＳ１−１−７）。具体的には、計測値と推定値とを比較して計測値と推定値との偏差を次の式（５）によって求め、求めた偏差について偏差評価量ｅ1 及びｅ2 を次の式（６）によって算出し、算出した偏差評価量に基づいて計測値が正常であるか否か、及び、異常疑惑であるか否かを判断する。
【００９２】
【数６】
【００９３】
ここで、偏差評価量ｅ1 及びｅ2 のいずれもが偏差判定閾値以下である場合には、計測値は正常であると判断されるので、主制御ＥＣＵ２１は、車両１０の倒立制御に用いる値として計測値を採用し（ステップＳ１−１−８）、処理を終了する。
【００９４】
また、計測値が正常でない場合であって偏差評価量ｅ2 が偏差判定閾値ｅ2,shより大きいときには、異常疑惑であると判断されるので、主制御ＥＣＵ２１は、乗員１５に対して異常疑惑状態であることを報知する（ステップＳ１−１−９）。具体的には、入力装置３０に配設された表示ランプを点灯させる。そして、主制御ＥＣＵ２１は、車両１０の倒立制御に用いる値として計測値を採用し、処理を終了する。
【００９５】
一方、計測値が正常でない場合であって偏差評価量ｅ1 が偏差判定閾値ｅ1,shより大きいときには、異常疑惑でなく、緊急異常であると判断されるので、主制御ＥＣＵ２１は、乗員１５に対して緊急異常状態であることを報知する（ステップＳ１−１−１０）。そして、主制御ＥＣＵ２１は、車両１０の倒立制御に用いる値として推定値を採用し（ステップＳ１−１−１１）、処理を終了する。
【００９６】
本実施の形態においては、計測値と推定値との差を比較することで、計測値が異常であることを検出する。具体的には、計測値と推定値との差の絶対値の累乗によって異常判定を行う。これにより、大きな偏差をより大きく評価することが可能となり、より適切に異常状態を判断できる。また、所定の時間だけ積分した値によって異常判定を行う。これにより、過渡的で瞬間的な偏差に左右されることがなくなり、より適切に異常判定を判断できる。
【００９７】
また、本実施の形態においては、計測値が異常であると判断した場合に、その異常の程度に応じて、車両の走行と車体の姿勢の制御に引き続き計測値を用いることが可能であるか否かを判断する。具体的には、比較的短い判定時間における偏差の平均値が、比較的大きな閾値よりも更に大きい場合、計測値は短時間で急速に異常状態に至り、その異常の程度も大きいと考え、即時の計測値使用停止を必要とする「緊急異常」の状態であると判定する。この場合、計測値に代えて推定値に基づいて以降の制御を実行する。また、比較的長い判定時間における偏差の平均値が、比較的小さな閾値よりは大きい場合、計測値は徐々に異常状態へ悪化しているが、現時点ではその異常の程度は小さいと考え、即時の計測値使用停止は必要ないが、検査等は必要とする「異常疑惑」の状態であると判定する。この場合、引き続き計測値に基づいて制御を実行し、報知手段により利用者に検査を促す程度に留める。このように、異常状態の程度を適切に判断することにより、過剰な異常判定による利便性の低下や初期の微少な異常を許容することによる予防安全性の低下を防ぎ、便利で安全な倒立型車両を提供できる。
【００９８】
なお、本実施の形態においては、２つの偏差評価量について、その時間積分閾値や累乗指数に共通の値を用いているが、それぞれ異なる値を設定してもよい。例えば、緊急異常判定用の偏差評価量の決定式における累乗指数を大きくすることで、大小の偏差をより明確に選り分けてもよい。
【００９９】
また、本実施の形態においては、車体傾斜角について計測値と推定値を比較しているが、その変化率である車体傾斜角速度を考慮してもよい。例えば、計測値と推定値の各変化率に所定の時定数を乗じた値を元の計測値と推定値に加えた値によって、偏差評価量を求めてもよい。これにより、異常状態への遷移をより早くあるいは簡易に検出することができる。
【０１００】
さらに、本実施の形態においては、常時異常判定を行っているが、車両の状況に応じて一時的に異常判定を停止してもよい。例えば、路面センサ７１により、段差を検出した場合には、段差接触時あるいは該段差近傍に車両が位置する間は、偏差評価量の値を固定してもよい。これにより、段差による各状態量の変化を異常と誤認識することを回避できる。
【０１０１】
次に、目標走行状態の決定処理について説明する。
【０１０２】
図７は本発明の実施の形態における目標走行状態の決定処理の動作を示すフローチャートである。
【０１０３】
目標走行状態の決定処理において、主制御ＥＣＵ２１は、まず、操縦操作量を取得する（ステップＳ２−１）。この場合、乗員１５が、車両１０の加速、減速、旋回、その場回転、停止、制動等の走行指令を入力するために操作したジョイスティック３１の操作量を取得する。
【０１０４】
続いて、主制御ＥＣＵ２１は、取得したジョイスティック３１の操作量に基づいて、車両加速度の目標値を決定する（ステップＳ２−２）。例えば、ジョイスティック３１の前後方向への操作量に比例した値を車両加速度の目標値とする。
【０１０５】
続いて、主制御ＥＣＵ２１は、決定した車両加速度の目標値から、駆動輪回転角速度の目標値を算出する（ステップＳ２−３）。例えば、車両加速度の目標値を時間積分し、駆動輪接地半径ＲW で除した値を駆動輪回転角速度の目標値とする。
【０１０６】
次に、目標車体姿勢の決定処理について説明する。
【０１０７】
図８は本発明の実施の形態における目標車体姿勢の決定処理の動作を示すフローチャートである。
【０１０８】
目標車体姿勢の決定処理において、主制御ＥＣＵ２１は、まず、車体傾斜角の目標値を決定する（ステップＳ３−１）。この場合、目標走行状態の決定処理によって決定された車両加速度の目標値から、次の式（７）により車体傾斜角の目標値を決定する。
【０１０９】
【数７】
【０１１０】
なお、α* は、車両加速度の目標値である。このように、車両加速度に伴って車体に作用する慣性力と駆動トルクの反トルクとを考慮して、車体傾斜角の目標値を決定する。
【０１１１】
続いて、主制御ＥＣＵ２１は、残りの目標値を算出する（ステップＳ３−２）。すなわち、各目標値を時間微分又は時間積分することによって、駆動輪回転角及び車体傾斜角速度の目標値を算出する。
【０１１２】
次に、アクチュエータ出力の決定処理について説明する。
【０１１３】
図９は本発明の実施の形態におけるアクチュエータ出力の決定処理の動作を示すフローチャートである。
【０１１４】
アクチュエータ出力の決定処理において、主制御ＥＣＵ２１は、まず、各アクチュエータのフィードフォワード出力を決定する（ステップＳ４−１）。この場合、各目標値から、次の式（８）により駆動モータ５２のフィードフォワード出力を決定する。
【０１１５】
【数８】
【０１１６】
このように、目標車両加速度を実現するのに必要な駆動トルクを付加することで、車両１０の走行及び姿勢制御を高精度に実行する。
【０１１７】
続いて、主制御ＥＣＵ２１は、各アクチュエータのフィードバック出力を決定する（ステップＳ４−２）。この場合、各目標値と実際の状態量又は推定値との偏差から、次の式（９）により駆動モータ５２のフィードバック出力を決定する。
【０１１８】
【数９】
【０１１９】
ここで、各フィードバックゲインＫW1〜ＫW4の値には、例えば、最適レギュレータの値をあらかじめ設定しておく。
【０１２０】
なお、スライディングモード制御などの非線形のフィードバック制御を導入してもよい。また、より簡単な制御として、ＫW2及びＫW3を除くゲインのいくつかを零にしてもよい。さらに、定常偏差をなくすために、積分ゲインを導入してもよい。
【０１２１】
本実施の形態においては、駆動輪センサ５１による駆動輪回転角速度の計測値に基づいて制御する場合でも、回転推定手段による駆動輪回転角速度の推定値に基づいて制御する場合でも、換言すれば、駆動輪回転角速度計測値の取得が可能でも不可能でも、前記式（９）に示す同一の制御則によって走行及び姿勢制御を実行する。これにより、制御則が簡素化されるため、制御系の設計時やプログラミング時に費やす労力や制御動作時の演算コストを大幅に低減できる。
【０１２２】
最後に、主制御ＥＣＵ２１は、各要素制御システムに指令値を与える（ステップＳ４−３）。この場合、主制御ＥＣＵ２１は、前述のように決定したフィードフォワード出力とフィードバック出力との和を駆動トルク指令値として、駆動輪制御ＥＣＵ２２に送信する。
【０１２３】
このように、本実施の形態においては、車体傾斜状態と駆動トルクの時間履歴、及び、パラメータ推定値に基づいて、駆動輪回転角速度を推定する。また、走行抵抗パラメータの計測値によって、駆動輪回転角速度の推定値を決定する。さらに、駆動輪回転角加速度を別の力学モデルにより推定し、車体重心ずれ量の推定値を用いて補正する。そして、駆動輪回転角速度の計測値と推定値との差が所定値以上の場合、計測値を異常とみなす。これにより、駆動輪回転状態の計測値の異常を確実に検出することを可能とし、より安全で便利で安価な倒立型の車両１０を提供することができる。
【０１２４】
なお、本発明は前記実施の形態に限定されるものではなく、本発明の趣旨に基づいて種々変形させることが可能であり、それらを本発明の範囲から排除するものではない。
【産業上の利用可能性】
【０１２５】
本発明は、倒立振り子の姿勢制御を利用した車両に適用することができる。
【符号の説明】
【０１２６】
１０ 車両
１２ 駆動輪
１７ 重心位置
２０ 制御ＥＣＵ
２１ 主制御ＥＣＵ
５１ 駆動輪センサ
【技術分野】
【０００１】
本発明は、倒立振り子の姿勢制御を利用した車両に関するものである。
【背景技術】
【０００２】
従来、倒立振り子の姿勢制御を利用した車両に関する技術が提案されている。例えば、同軸上に配設された２つの駆動輪を有し、運転者の重心移動による車体の姿勢変化を感知して駆動する車両、球体状の単一の駆動輪に取り付けられた車体の姿勢を制御しながら移動する車両等の技術が提案されている（例えば、特許文献１参照。）。
【０００３】
この場合、センサで車体の傾斜動作や駆動輪の回転動作の状態を検出しながら、車体や駆動輪の動作を制御して車両を停止又は移動させるようになっている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２００４−１２９４３５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
前記従来の車両においては、センサによって取得した駆動輪の回転状態の計測値によって車両の走行と共に車体の姿勢を制御しているため、計測値として正しい値を取得できない場合、すなわち、異常状態である場合、その異常を検出して、異常状態に応じた制御を実行する必要がある。例えば、センサが故障した場合、センサから送信される故障状態を示す信号を受信したときに、センサの計測値が異常状態にあると判断できる。
【０００６】
しかしながら、センサの出力信号へのノイズの混入等によって異常な計測値を取得したときには、センサ自体の故障でないため、異常を検出することができない。
【０００７】
もっとも、このような事態に備えて、あらかじめ複数のセンサを用意し、各センサの計測値を相互に参照して計測値が正常であることを確認することが考えられる。しかし、複数のセンサを用意すると、高価で複雑なシステムになってしまう。つまり、安価で簡素なシステムによって、十分な安全性や利便性を保障することは、困難である。
【０００８】
本発明は、前記従来の車両の問題点を解決して、駆動輪回転状態の計測値と推定値とを比較することによって、駆動輪回転状態の計測値の異常を確実に検出することができ、より安全で便利で安価な車両を提供することを目的とする。
【課題を解決するための手段】
【０００９】
そのために、本発明の車両においては、回転可能に車体に取り付けられた駆動輪と、該駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、前記駆動輪の回転角速度を計測する回転計測手段と、鉛直軸に対する前記車体の傾斜状態及び前記駆動トルクによって前記駆動輪の回転角速度を推定する回転推定手段と、前記回転計測手段によって計測された回転角速度と前記回転推定手段によって推定された回転角速度との差の絶対値が所定値より大きい場合に前記回転計測手段によって計測された回転角速度が異常であると判定する判定手段と、を備える。
【００１０】
本発明の他の車両においては、さらに、前記車両制御装置は、前記判定手段が前記回転計測手段によって計測された回転角速度が異常であると判定すると、異常を報知する報知手段を更に備える。
【００１１】
本発明の更に他の車両においては、さらに、前記判定手段は、前記回転計測手段によって計測された回転角速度を前記車体の姿勢の制御に使用することが可能であるか否かを判定し、前記車両制御装置は、前記判定手段が可能であると判定した場合には前記回転計測手段によって計測された回転角速度に応じて前記駆動トルクの値を決定し、前記判定手段が可能でないと判定した場合には前記回転推定手段によって推定された回転角速度に応じて前記駆動トルクの値を決定する。
【００１２】
本発明の更に他の車両においては、さらに、前記判定手段は、前記差の絶対値が第１の所定値より大きく、かつ、第２の所定値以下である場合には、前記回転計測手段によって計測された回転角速度が異常であるが、前記車体の姿勢の制御に使用することが可能であると判定し、前記差の絶対値が第２の所定値より大きい場合には、前記回転計測手段によって計測された回転角速度が異常であり、前記車体の姿勢の制御に使用することが可能でないと判定する。
【００１３】
本発明の更に他の車両においては、さらに、前記判定手段は、前記差の絶対値の累乗を第１の所定時間にわたって積分した第１の時間積分値が第１の所定積分値より大きく、かつ、前記差の絶対値の累乗を第２の所定時間にわたって積分した第２の時間積分値が第２の所定積分値以下である場合には前記回転計測手段によって計測された回転角速度が異常であるが、前記車体の姿勢の制御に使用することが可能であると判定し、前記第２の時間積分値が第２の所定積分値より大きい場合には前記回転計測手段によって計測された回転角速度が異常であり、前記車体の姿勢の制御に使用することが可能でないと判定する。
【００１４】
本発明の更に他の車両においては、さらに、前記判定手段は、前記第１の所定時間より短い前記第２の所定時間と、前記第１の所定積分値を前記第１の所定時間で除した値よりも前記第２の所定積分値を前記第２の所定時間で除した値の方が大きくなるような前記第２の所定積分値に基づいて判定する。
【００１５】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記車両の走行抵抗の特性量である抵抗パラメータを取得する抵抗パラメータ取得手段を更に備え、前記傾斜推定手段は、前記抵抗パラメータ取得手段によって取得された抵抗パラメータによって前記回転角速度の推定値を補正する。
【００１６】
本発明の更に他の車両においては、さらに、路面形状を計測する路面形状計測手段を更に備え、前記抵抗パラメータ取得手段は、前記路面形状計測手段によって計測された前記路面形状によって前記抵抗パラメータを推定する。
【００１７】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記車体の重心位置のずれ量を取得する重心ずれ量取得手段を更に備え、前記回転推定手段は、前記重心ずれ量取得手段によって取得された重心ずれ量によって前記回転角速度の推定値を補正する。
【００１８】
本発明の更に他の車両においては、さらに、前記乗員及び／又は重量物を搭載する搭乗部と、該搭乗部の荷重分布を計測する荷重分布計測手段と、を更に備え、前記重心ずれ量取得手段は、前記荷重分布計測手段によって計測された前記荷重分布によって前記重心ずれ量を推定する。
【発明の効果】
【００１９】
請求項１の構成によれば、検証用のセンサを別途用意することなく、駆動輪の回転角速度の計測値の異常を確実に検出することが可能であり、安価で安全な倒立型車両を実現できる。
【００２０】
請求項２の構成によれば、計測値の異常時において、その異常に対応する制御の結果として通常時と同様の動作を実現できている場合においても、乗員に駆動輪回転角速度計測値が異常状態にあることを確実に認識させ、乗員に点検や修理を促すことができる。
【００２１】
請求項３の構成によれば、倒立姿勢での走行中に駆動輪回転角速度計測値の取得が突然不可能になった場合においても、倒立姿勢での走行状態を維持し、退避走行等を可能とする。
【００２２】
請求項４の構成によれば、駆動輪回転角速度の計測値と推定値のどちらを用いるかを計測値の異常の程度に応じて判断することで、適切な制御方法を選択することができる。
【００２３】
請求項５の構成によれば、計測値の時間履歴を判断材料とし、更に２つの異なる基準を設けることで、異常状態及び計測値の使用可否をより適切に判断できる。
【００２４】
請求項６の構成によれば、深刻な異常を短時間で検出することで、深刻な異常への対応を早めるのと共に、判定が困難である微妙な異常を長時間のデータに基づいて判定することで、異常判定の精度を高めることができる。
【００２５】
請求項７の構成によれば、走行抵抗の影響を考慮することで、走行路面の勾（こう）配や粗さの違いに伴う駆動輪回転角速度の推定精度の低下を防ぐことができる。
【００２６】
請求項８の構成によれば、路面形状を計測することで、走行抵抗の特性をより正確に推定し、走行抵抗による影響を正しく補償することができる。
【００２７】
請求項９の構成によれば、車体傾斜状態の力学モデルに基づく駆動輪回転角加速度の推定値を駆動輪回転角速度の推定に用いる場合に、車体の重心位置のずれを考慮することで、より高精度に駆動輪回転角加速度及び駆動輪回転角速度を推定できる。
【００２８】
請求項１０の構成によれば、搭乗部の荷重分布を計測することで、車体の重心位置を正確に把握し、重心位置のずれによる影響を正確に補償することができる。
【図面の簡単な説明】
【００２９】
【図１】本発明の実施の形態における車両の構成を示す図である。
【図２】本発明の実施の形態における車両の制御システムの構成を示すブロック図である。
【図３】本発明の実施の形態における車両の走行及び姿勢制御処理の動作を示すフローチャートである。
【図４】本発明の実施の形態における状態量の取得処理の動作を示すフローチャートである。
【図５】本発明の実施の形態における車両の各重心位置を示す図である。
【図６】本発明の実施の形態における主状態量取得処理の動作を示すフローチャートである。
【図７】本発明の実施の形態における目標走行状態の決定処理の動作を示すフローチャートである。
【図８】本発明の実施の形態における目標車体姿勢の決定処理の動作を示すフローチャートである。
【図９】本発明の実施の形態におけるアクチュエータ出力の決定処理の動作を示すフローチャートである。
【発明を実施するための形態】
【００３０】
以下、本発明の実施の形態について図面を参照しながら詳細に説明する。
【００３１】
図１は本発明の実施の形態における車両の構成を示す図、図２は本発明の実施の形態における車両の制御システムの構成を示すブロック図である。
【００３２】
図において、１０は、本実施の形態における車両であり、車体の本体部１１、駆動輪１２、支持部１３、及び、乗員１５が搭乗するとともに、搭載物１８が搭載される搭乗部１４を有し、前記車両１０は、車体を前後に傾斜させることができるようになっている。そして、倒立振り子の姿勢制御と同様に車体の姿勢を制御する。図１に示される例において、車両１０は右方向に前進し、左方向に後退することができる。
【００３３】
前記駆動輪１２は、車体の一部である支持部１３に対して回転可能に支持され、駆動アクチュエータとしての駆動モータ５２によって駆動される。なお、駆動輪１２の軸は図１に示す平面に垂直な方向に存在し、駆動輪１２はその軸を中心に回転する。また、前記駆動輪１２は、単数であっても複数であってもよいが、複数である場合、同軸上に並列に配設される。本実施の形態においては、駆動輪１２が２つであるものとして説明する。この場合、各駆動輪１２は個別の駆動モータ５２によって独立して駆動される。なお、駆動アクチュエータとしては、例えば、油圧モータ、内燃機関等を使用することもできるが、ここでは、電気モータである駆動モータ５２を使用するものとして説明する。
【００３４】
また、車体の一部である本体部１１は、支持部１３によって下方から支持され、駆動輪１２の上方に位置する。そして、本体部１１には、車両１０の運転者である乗員１５が搭乗する搭乗部１４が取り付けられている。
【００３５】
本実施の形態においては、説明の都合上、搭乗部１４には乗員１５が搭乗するとともに荷物等としての搭載物１８が搭載されている例について説明するが、搭乗部１４には必ずしも乗員１５が搭乗している必要はなく、例えば、車両１０がリモートコントロールによって操縦される場合には、搭乗部１４に乗員１５が搭乗していなくてもよい。また、同様に、搭乗部１４には必ずしも搭載物１８が搭載されている必要はなく、搭載物１８は省略することができる。
【００３６】
なお、前記搭乗部１４は、乗用車、バス等の自動車に使用されるシートと同様のものであり、座面部、背もたれ部及びヘッドレストを備える。
【００３７】
前記搭乗部１４の脇（わき）には、目標走行状態取得装置としてのジョイスティック３１を備える入力装置３０が配設されている。乗員１５は、操縦装置であるジョイスティック３１を操作することによって、車両１０を操縦する、すなわち、車両１０の加速、減速、旋回、その場回転、停止、制動等の走行指令を入力するようになっている。なお、乗員１５が操作して走行指令を入力することができる装置であれば、ジョイスティック３１に代えて他の装置、例えば、ジョグダイヤル、タッチパネル、押しボタン等の装置を目標走行状態取得装置として使用することもできる。
【００３８】
なお、車両１０がリモートコントロールによって操縦される場合には、前記ジョイスティック３１に代えて、コントローラからの走行指令を有線又は無線で受信する受信装置を目標走行状態取得装置として使用することができる。また、車両１０があらかじめ決められた走行指令データに従って自動走行する場合には、前記ジョイスティック３１に代えて、半導体メモリ、ハードディスク等の記憶媒体に記憶された走行指令データを読み取るデータ読取り装置を目標走行状態取得装置として使用することができる。
【００３９】
また、図示していないが、入力装置３０には、報知手段としての表示ランプが配設されている。車両１０の状態が異常であるとき、表示ランプを点灯させることで、乗員１５にそれを認識させることができる。
【００４０】
なお、表示ランプに代えて、画面上に所定の内容を表示するディスプレイや所定の発信音又は音声を発するスピーカ等の装置を報知手段として使用することもできる。
【００４１】
さらに、車両１０の支持部１３には、姿勢制限手段としてのストッパ１６が取り付けられている。そして、倒立制御を停止した時には、前記ストッパ１６の前端又は後端のストッパ接地点が路面に接地することによって車体の姿勢角度を制限し、車体が所定角度、すなわち、車体傾斜角制限値以上に傾斜することを防止する。
【００４２】
また、車両１０は、車両制御装置としての制御ＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）２０を有し、該制御ＥＣＵ２０は、主制御ＥＣＵ２１及び駆動輪制御ＥＣＵ２２を備える。前記制御ＥＣＵ２０並びに主制御ＥＣＵ２１及び駆動輪制御ＥＣＵ２２は、ＣＰＵ、ＭＰＵ等の演算手段、磁気ディスク、半導体メモリ等の記憶手段、入出力インターフェイス等を備え、車両１０の各部の動作を制御するコンピュータシステムであり、例えば、本体部１１に配設されるが、支持部１３や搭乗部１４に配設されていてもよい。また、前記主制御ＥＣＵ２１及び駆動輪制御ＥＣＵ２２は、それぞれ、別個に構成されていてもよいし、一体に構成されていてもよい。
【００４３】
そして、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、駆動輪センサ５１及び駆動モータ５２とともに、駆動輪１２の動作を制御する駆動輪制御システム５０の一部として機能する。前記駆動輪センサ５１は、レゾルバ、エンコーダ等から成り、回転計測手段として機能し、駆動輪１２の回転状態を示す駆動輪回転角及び／又は回転角速度を検出し、主制御ＥＣＵ２１に送信する。また、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、該駆動輪制御ＥＣＵ２２は、受信した駆動トルク指令値に相当する入力電圧を駆動モータ５２に供給する。そして、該駆動モータ５２は、入力電圧に従って駆動輪１２に駆動トルクを付与し、これにより、駆動アクチュエータとして機能する。
【００４４】
また、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、車体傾斜センサ４１及び駆動モータ５２とともに、車体の姿勢を制御する車体制御システム４０の一部として機能する。前記車体傾斜センサ４１は、加速度センサ、ジャイロセンサ等から成り、傾斜計測手段として機能し、車体の傾斜状態を示す車体傾斜角及び／又は傾斜角速度を検出し、主制御ＥＣＵ２１に送信する。そして、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信する。
【００４５】
さらに、主制御ＥＣＵ２１は、荷重分布計測手段としての搭乗部センサ６１とともに、搭乗部１４の座面荷重分布を計測する搭乗部計測システム６０の一部として機能する。前記搭乗部センサ６１は、搭乗部１４の取付部に配設された複数の１軸荷重センサ等から成り、搭載荷重パラメータとして搭乗部１４上の乗員１５及び搭載物１８の重量及び荷重分布を検出し、主制御ＥＣＵ２１に送信する。
【００４６】
さらに、主制御ＥＣＵ２１は、路面形状計測手段としての路面センサ７１とともに、路面の状態を計測する路面計測システム７０の一部として機能する。前記路面センサ７１は、車体の前後、例えば、本体部１１の下面の前後端等に配設された撮像装置等の画像センサから成り、撮影した路面画像データを主制御ＥＣＵ２１に送信する。
【００４７】
加えて、主制御ＥＣＵ２１には、入力装置３０のジョイスティック３１から走行指令が入力される。そして、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信する。
【００４８】
さらに、主制御ＥＣＵ２１は、駆動輪１２の回転状態を推定する回転推定手段として機能するとともに、駆動輪１２の回転状態の計測値を取得すること及び計測値を制御に使用することが可能であるかを判定する判定手段、走行抵抗パラメータを取得する抵抗パラメータ取得手段、及び、車体重心ずれ量を取得する車体重心ずれ量取得手段としても機能する。
【００４９】
なお、各センサは、複数の状態量を取得するものであってもよい。例えば、車体傾斜センサ４１として加速度センサとジャイロセンサとを併用し、両者の計測値から車体傾斜角と傾斜角速度とを決定するようにしてもよい。また、図１に記載された数字以外の記号については、後述する。
【００５０】
次に、前記構成の車両１０の動作について説明する。まず、走行及び姿勢制御処理の概要について説明する。
【００５１】
図３は本発明の実施の形態における車両の走行及び姿勢制御処理の動作を示すフローチャートである。
【００５２】
本実施の形態においては、駆動輪センサ５１による駆動輪回転状態の測定値と推定値とを比較して、駆動輪回転角速度の計測値の異常を検出する。具体的には、車体傾斜角加速度と駆動トルクの時間履歴から駆動輪回転角速度を推定する。また、搭乗部センサ６１による車体重心ずれ量の計測値によって、駆動輪回転角速度の推定値を補正する。さらに、駆動輪回転角加速度を別の力学モデルにより推定し、走行抵抗推定値に応じて補正する。そして、駆動輪回転角速度の計測値と推定値の差が所定値より大きい場合、駆動輪回転角速度の計測値を異常とみなす。これにより、駆動輪回転角速度の計測値の異常を確実に検出することを可能とし、より安全で便利で安価な倒立型の車両１０を提供することができる。
【００５３】
走行及び姿勢制御処理において、制御ＥＣＵ２０は、まず、状態量の取得処理を実行し（ステップＳ１）、各センサ、すなわち、駆動輪センサ５１、車体傾斜センサ４１、搭乗部センサ６１及び路面センサ７１、並びに、状態量推定手段によって、駆動輪１２の回転状態及び車体の傾斜状態を取得する。
【００５４】
次に、制御ＥＣＵ２０は、目標走行状態の決定処理を実行し（ステップＳ２）、ジョイスティック３１の操作量に基づいて、車両１０の加速度の目標値、及び、駆動輪１２の回転角速度の目標値を決定する。
【００５５】
次に、制御ＥＣＵ２０は、目標車体姿勢の決定処理を実行し（ステップＳ３）、目標走行状態の決定処理によって決定された車両１０の加速度の目標値と駆動輪１２の回転角速度の目標値に基づいて、車体姿勢の目標値として、車体傾斜角の目標値を決定する。
【００５６】
最後に、制御ＥＣＵ２０は、アクチュエータ出力の決定処理を実行し（ステップＳ４）、状態量の取得処理によって取得された各状態量、目標走行状態の決定処理によって決定された目標走行状態、及び、目標車体姿勢の決定処理によって決定された目標車体姿勢に基づいて、各アクチュエータの出力、すなわち、駆動モータ５２の出力を決定する。
【００５７】
次に、走行及び姿勢制御処理の詳細について説明する。まず、状態量の取得処理について説明する。
【００５８】
図４は本発明の実施の形態における状態量の取得処理の動作を示すフローチャートである。
【００５９】
本実施の形態においては、状態量、入力、パラメータ、物理定数等を次のような記号によって表す。なお、図１には状態量やパラメータの一部が示されている。また、図１において、ｘp は車体の前後方向座標軸、ｚp は車体の上下方向座標軸、６２は乗員１５及び搭載物１８の重心位置（座標：ｘpG、ｚpG）である。
ＦS(i)：搭乗部センサ計測値（引張荷重を正、添字（ｉ）はｉ番目のセンサを表す）
ｘpS(i) ：搭乗部センサ位置（添字（ｉ）はｉ番目のセンサを表す）
θ1 ：車体傾斜角
λS ：搭乗部位置
α ：車両加速度〔Ｇ〕
ｍS0：乗員（搭載物）を除く搭乗部の重量
ｘS0：乗員（搭載物）を除く搭乗部の重心位置
ｌ1 ：車軸から搭乗部重心までの距離（基準値）
ｆ0 ：角速度換算振動数（所定値）
θR,sh：慣性力傾斜角の閾（しきい）値（所定値）
αS,sh：搭乗部相対加速度の閾値（所定値）
ζ0 ＝Δｔ／ＴLPF
Δｔ：搭乗部センサ計測周期（所定値）
ＴLPF ：ローパスフィルタ時定数（所定値）
ｇ：重力加速度〔ｍ／ｓ2 〕
状態量の取得処理において、主制御ＥＣＵ２１は、まず、主たる状態量である駆動輪回転状態量及び車体傾斜状態量をそれぞれ取得するための主状態量取得処理を実行する（ステップＳ１−１）。
【００６０】
次に、主状態量取得処理について説明する。
【００６１】
図５は本発明の実施の形態における車両の各重心位置を示す図、図６は本発明の実施の形態における主状態量取得処理の動作を示すフローチャートである。
【００６２】
続いて、主制御ＥＣＵ２１は、車体重心ずれ量を推定する（ステップＳ１−１−２）。具体的には、まず、乗員１５と搭載物１８の重量ｍp を下記の式によって取得する。なお、図５において、１７は車両１０の重心位置（座標：ＸG 、ＺG ）である。
【００６３】
【数１】
【００６４】
また、乗員１５と搭載物１８の重心位置ｘpGを下記の式によって取得する。
【００６５】
【数２】
【００６６】
ここで、上付き添字（ｎ）は時系列のｎ番目のデータであることを表す。なお、各時系列データの初期値には、所定の各基準値をあらかじめ与える。
【００６７】
【数３】
【００６８】
このように、本実施の形態においては、複数の搭乗部センサ６１の計測値に基づいて、搭載荷重パラメータを推定する。つまり、乗員１５と搭載物１８を合わせた重量ｍp 、及び、その重心位置を推定する。具体的には、搭乗部センサ６１の計測値の総和に基づいて、重量ｍp を推定する。また、複数の搭乗部センサ６１によって計測された搭乗部１４の前後の荷重分布に基づいて、重心位置を推定する。
【００６９】
ここで、θR ≦θR,shの場合、すなわち、重力と慣性力の合力が搭乗部１４に対して比較的垂直な方向に作用している場合、（例えば、直立停止状態にある場合）、荷重分布に基づいて重心位置ｘpGの値のみを修正する。
【００７０】
また、θR ＞θR,shの場合、すなわち、重力と慣性力の合力が搭乗部１４に水平な方向にある程度作用する場合、（例えば、車体傾斜時や車両１０の加減速時）、荷重分布に基づいて重心高さｚpGの値のみを修正する。
【００７１】
すなわち、重心位置及び重心高さの推定においては、搭乗部１４に作用するピッチングモーメントの発生要因を考慮し、重心高さがほとんど寄与しないときには重心位置を高精度に推定し、重心高さがピッチングモーメントにある程度寄与するときには既に推定した重心位置に基づいて重心高さを推定する。また、一方の推定時には他方の値を固定する。これにより、搭乗部センサ６１のみで高精度に重心位置を推定することができる。
【００７２】
また、車体姿勢の変化が大きいときには、重心位置推定値を固定する。αS ＞αS,shの場合、すなわち、車体傾斜角速度や角加速度が所定の閾値よりも大きい場合、重心位置の推定値を修正せず、その前の推定値を維持する。このように、搭乗部１４に作用するピッチングモーメントの発生要因を考慮して、それが重心位置の違いのみによると判断した場合に限り、重心位置を推定する。したがって、倒立車両特有の現象である車体姿勢変化の影響を回避し、搭乗部センサ６１のみで高精度で安定な推定を実行できる。
【００７３】
また、本実施の形態においては、複数の搭乗部センサ６１による座面荷重分布の計測値に基づいて、重心位置を推定しているが、他のセンサを追加して推定してもよい。例えば、レーザレーダ等によって乗員１５及び搭載物１８の形状を取得する形状センサを備え、取得した形状に基づいて重心の高さを推定してもよい。
【００７４】
また、搭乗部センサ６１として、より簡素なシステムを用いてもよい。例えば、搭乗部センサ６１を１つだけ備え、その計測値である重量から統計的知見に基づいて重心位置を推定してもよい。また、センサの代わりに入力装置を備え、乗員１５が自身の体重や身長及び搭載物１８の重量や形状のデータを入力装置によって入力又は送信し、そのデータに基づいて、重心位置を推定してもよい。
【００７５】
そして、主制御ＥＣＵ２１は、取得した搭乗者パラメータである重量ｍp 及び重心位置ｘpGに基づき、次の式（１）によって、車体重心ずれ量δx を推定する。
【００７６】
【数４】
【００７７】
ここで、ｍ1bは乗員１５及び搭載物１８がないときの車両重量、δx0は乗員１５及び搭載物１８がなく、直立時における搭乗部１４の基準位置が駆動輪接地点を通る鉛直軸上にあるときの重心位置である。
【００７８】
このように、本実施の形態においては、搭乗者パラメータに基づいて、車体重心ずれ量δx を推定する。つまり、乗員１５及び搭載物１８の重心位置について、基準値との差異を考慮する。このように、実際の車体パラメータを把握することで、より高精度な推定及び判定を実現できる。
【００７９】
続いて、主制御ＥＣＵ２１は、走行抵抗パラメータを取得する（ステップＳ１−１−３）。具体的には、次の式（２）によって走行抵抗定数τD0を決定し、次の式（３）によって走行抵抗比例係数ＣD を決定する。
τD0＝ＭｇＲW sin η＋（１＋βR ）τD0,S ・・・式（２）
ＣD ＝（１＋βR ）ＣD,S ・・・式（３）
なお、ηは路面勾配であり、路面センサ７１によって取得された路面画像データに基づいて決定される。また、βR は走行抵抗増加率であり、こちらも路面センサ７１によって取得された路面画像データに基づいて決定される。さらに、τD0,S及びＣD,S は走行抵抗パラメータ基準値であり、所定値をあらかじめ与える。
【００８０】
本実施の形態においては、路面センサ７１によって取得された路面情報に基づいて、走行抵抗パラメータである走行抵抗定数τD0及び走行抵抗比例係数ＣD を決定する。
【００８１】
また、路面の形状を考慮して、走行抵抗パラメータを修正する。具体的には、路面勾配ηに応じて、走行抵抗定数τD0を増加させる。なお、坂路上での車両走行状態に関する力学モデルに基づき、適切な値を走行抵抗定数として与える。これにより、坂路を走行中であっても、高精度な状態量の推定及び異常判定を実現できる。
【００８２】
さらに、路面の状態を考慮して、走行抵抗比例係数ＣD を修正する。具体的には、路面画像データに基づいて路面の状態を推定し、その結果に応じて走行抵抗パラメータを修正する。凸凹路等の走行抵抗が高いと予想される路面を検出した場合には、走行抵抗増加率βR に所定の正の値を与える。また、コンクリート路面等の走行抵抗が低いと予想される路面を検出した場合には、走行抵抗増加率βR に所定の負の値を与える。これにより、路面の状態に関わらず、高精度な状態量の推定及び異常判定を実現できる。
【００８３】
なお、本実施の形態においては、路面センサ７１としての画像センサによって取得された情報に基づいて、走行抵抗パラメータを修正しているが、他の方法で修正してもよい。例えば、路面状態を含む地図情報を取得可能なナビゲーションシステムを具備し、その地図情報と現在の車両位置とに基づいて、路面状態及び走行抵抗パラメータを取得してもよい。また、路面の状態を選択的又は定量的に入力可能な路面情報入力装置を具備し、使用環境に応じて乗員１５が入力した情報に基づいて、路面状態及び走行抵抗パラメータを取得してもよい。
【００８４】
続いて、主制御ＥＣＵ２１は、駆動輪回転状態量を推定する（ステップＳ１−１−４）。具体的には、各状態量と駆動トルクの時間履歴、及び、各推定パラメータから、次の式（４）により駆動輪回転角速度を推定する。
【００８５】
【数５】
【００８６】
本実施の形態においては、車体傾斜状態と駆動トルクの時間履歴、及び、パラメータ推定値を用いて、駆動輪１２の回転運動に関する力学モデルに基づいて、駆動輪回転角速度を推定する。その際、駆動トルク、車両１０の加減速に対する慣性、車体傾斜による重心移動の作用、及び、走行抵抗トルクを考慮し、それらの大きさの関係から、走行抵抗トルクを推定する。そして、該走行抵抗トルクと駆動輪回転角速度に線形関係があるという仮定の下で、駆動輪回転角速度を推定する。このように、力学モデルにおける各状態とトルクの理論的な関係を利用することで、未知の駆動輪回転角速度を推定できる。
【００８７】
また、走行抵抗パラメータの計測値によって、駆動輪回転角速度の推定値を決定する。具体的には、駆動輪１２の回転運動に関する力学モデルとの偏差に相当する走行抵抗トルクの特性を計測によって取得することにより、推定の精度を向上させる。これにより、走行抵抗の作用が駆動輪回転状態の計測値の異常誤差と認識されることを防止して、より信頼性の高い異常判定が可能となる。
【００８８】
さらに、駆動輪回転角加速度を別の力学モデルによって推定する。具体的には、駆動輪回転角加速度を駆動輪回転角速度とは独立な状態量とみなし、車体の傾斜運動に関する力学モデルによって推定する。その際、重力トルク、車体の回転慣性、車両の加減速に伴う慣性力、及び、駆動トルクの反トルクを考慮する。このように、駆動輪回転角加速度を別のモデルから推定することにより、加速度の積分に伴う誤差の蓄積、及び、推定計算の不安定化を回避し、安定で高精度な駆動輪回転角速度の推定を実現する。
【００８９】
なお、本実施の形態においては、簡単な線形モデルにより駆動輪回転角速度を推定しているが、より厳密なモデルによって推定してもよい。例えば、非線形的な作用や車体回転に対する粘性抵抗等の要素を考慮したモデルを用いて、より厳密に推定してもよい。また、より簡単なモデルによって推定してもよい。
【００９０】
続いて、主制御ＥＣＵ２１は、駆動輪回転状態量を取得する（ステップＳ１−１−５）。
【００９１】
続いて、主制御ＥＣＵ２１は、計測値は正常であるか否かを判断し（ステップＳ１−１−６）、正常でない場合には、さらに、異常疑惑であるか否かを判断する（ステップＳ１−１−７）。具体的には、計測値と推定値とを比較して計測値と推定値との偏差を次の式（５）によって求め、求めた偏差について偏差評価量ｅ1 及びｅ2 を次の式（６）によって算出し、算出した偏差評価量に基づいて計測値が正常であるか否か、及び、異常疑惑であるか否かを判断する。
【００９２】
【数６】
【００９３】
ここで、偏差評価量ｅ1 及びｅ2 のいずれもが偏差判定閾値以下である場合には、計測値は正常であると判断されるので、主制御ＥＣＵ２１は、車両１０の倒立制御に用いる値として計測値を採用し（ステップＳ１−１−８）、処理を終了する。
【００９４】
また、計測値が正常でない場合であって偏差評価量ｅ2 が偏差判定閾値ｅ2,shより大きいときには、異常疑惑であると判断されるので、主制御ＥＣＵ２１は、乗員１５に対して異常疑惑状態であることを報知する（ステップＳ１−１−９）。具体的には、入力装置３０に配設された表示ランプを点灯させる。そして、主制御ＥＣＵ２１は、車両１０の倒立制御に用いる値として計測値を採用し、処理を終了する。
【００９５】
一方、計測値が正常でない場合であって偏差評価量ｅ1 が偏差判定閾値ｅ1,shより大きいときには、異常疑惑でなく、緊急異常であると判断されるので、主制御ＥＣＵ２１は、乗員１５に対して緊急異常状態であることを報知する（ステップＳ１−１−１０）。そして、主制御ＥＣＵ２１は、車両１０の倒立制御に用いる値として推定値を採用し（ステップＳ１−１−１１）、処理を終了する。
【００９６】
本実施の形態においては、計測値と推定値との差を比較することで、計測値が異常であることを検出する。具体的には、計測値と推定値との差の絶対値の累乗によって異常判定を行う。これにより、大きな偏差をより大きく評価することが可能となり、より適切に異常状態を判断できる。また、所定の時間だけ積分した値によって異常判定を行う。これにより、過渡的で瞬間的な偏差に左右されることがなくなり、より適切に異常判定を判断できる。
【００９７】
また、本実施の形態においては、計測値が異常であると判断した場合に、その異常の程度に応じて、車両の走行と車体の姿勢の制御に引き続き計測値を用いることが可能であるか否かを判断する。具体的には、比較的短い判定時間における偏差の平均値が、比較的大きな閾値よりも更に大きい場合、計測値は短時間で急速に異常状態に至り、その異常の程度も大きいと考え、即時の計測値使用停止を必要とする「緊急異常」の状態であると判定する。この場合、計測値に代えて推定値に基づいて以降の制御を実行する。また、比較的長い判定時間における偏差の平均値が、比較的小さな閾値よりは大きい場合、計測値は徐々に異常状態へ悪化しているが、現時点ではその異常の程度は小さいと考え、即時の計測値使用停止は必要ないが、検査等は必要とする「異常疑惑」の状態であると判定する。この場合、引き続き計測値に基づいて制御を実行し、報知手段により利用者に検査を促す程度に留める。このように、異常状態の程度を適切に判断することにより、過剰な異常判定による利便性の低下や初期の微少な異常を許容することによる予防安全性の低下を防ぎ、便利で安全な倒立型車両を提供できる。
【００９８】
なお、本実施の形態においては、２つの偏差評価量について、その時間積分閾値や累乗指数に共通の値を用いているが、それぞれ異なる値を設定してもよい。例えば、緊急異常判定用の偏差評価量の決定式における累乗指数を大きくすることで、大小の偏差をより明確に選り分けてもよい。
【００９９】
また、本実施の形態においては、車体傾斜角について計測値と推定値を比較しているが、その変化率である車体傾斜角速度を考慮してもよい。例えば、計測値と推定値の各変化率に所定の時定数を乗じた値を元の計測値と推定値に加えた値によって、偏差評価量を求めてもよい。これにより、異常状態への遷移をより早くあるいは簡易に検出することができる。
【０１００】
さらに、本実施の形態においては、常時異常判定を行っているが、車両の状況に応じて一時的に異常判定を停止してもよい。例えば、路面センサ７１により、段差を検出した場合には、段差接触時あるいは該段差近傍に車両が位置する間は、偏差評価量の値を固定してもよい。これにより、段差による各状態量の変化を異常と誤認識することを回避できる。
【０１０１】
次に、目標走行状態の決定処理について説明する。
【０１０２】
図７は本発明の実施の形態における目標走行状態の決定処理の動作を示すフローチャートである。
【０１０３】
目標走行状態の決定処理において、主制御ＥＣＵ２１は、まず、操縦操作量を取得する（ステップＳ２−１）。この場合、乗員１５が、車両１０の加速、減速、旋回、その場回転、停止、制動等の走行指令を入力するために操作したジョイスティック３１の操作量を取得する。
【０１０４】
続いて、主制御ＥＣＵ２１は、取得したジョイスティック３１の操作量に基づいて、車両加速度の目標値を決定する（ステップＳ２−２）。例えば、ジョイスティック３１の前後方向への操作量に比例した値を車両加速度の目標値とする。
【０１０５】
続いて、主制御ＥＣＵ２１は、決定した車両加速度の目標値から、駆動輪回転角速度の目標値を算出する（ステップＳ２−３）。例えば、車両加速度の目標値を時間積分し、駆動輪接地半径ＲW で除した値を駆動輪回転角速度の目標値とする。
【０１０６】
次に、目標車体姿勢の決定処理について説明する。
【０１０７】
図８は本発明の実施の形態における目標車体姿勢の決定処理の動作を示すフローチャートである。
【０１０８】
目標車体姿勢の決定処理において、主制御ＥＣＵ２１は、まず、車体傾斜角の目標値を決定する（ステップＳ３−１）。この場合、目標走行状態の決定処理によって決定された車両加速度の目標値から、次の式（７）により車体傾斜角の目標値を決定する。
【０１０９】
【数７】
【０１１０】
なお、α* は、車両加速度の目標値である。このように、車両加速度に伴って車体に作用する慣性力と駆動トルクの反トルクとを考慮して、車体傾斜角の目標値を決定する。
【０１１１】
続いて、主制御ＥＣＵ２１は、残りの目標値を算出する（ステップＳ３−２）。すなわち、各目標値を時間微分又は時間積分することによって、駆動輪回転角及び車体傾斜角速度の目標値を算出する。
【０１１２】
次に、アクチュエータ出力の決定処理について説明する。
【０１１３】
図９は本発明の実施の形態におけるアクチュエータ出力の決定処理の動作を示すフローチャートである。
【０１１４】
アクチュエータ出力の決定処理において、主制御ＥＣＵ２１は、まず、各アクチュエータのフィードフォワード出力を決定する（ステップＳ４−１）。この場合、各目標値から、次の式（８）により駆動モータ５２のフィードフォワード出力を決定する。
【０１１５】
【数８】
【０１１６】
このように、目標車両加速度を実現するのに必要な駆動トルクを付加することで、車両１０の走行及び姿勢制御を高精度に実行する。
【０１１７】
続いて、主制御ＥＣＵ２１は、各アクチュエータのフィードバック出力を決定する（ステップＳ４−２）。この場合、各目標値と実際の状態量又は推定値との偏差から、次の式（９）により駆動モータ５２のフィードバック出力を決定する。
【０１１８】
【数９】
【０１１９】
ここで、各フィードバックゲインＫW1〜ＫW4の値には、例えば、最適レギュレータの値をあらかじめ設定しておく。
【０１２０】
なお、スライディングモード制御などの非線形のフィードバック制御を導入してもよい。また、より簡単な制御として、ＫW2及びＫW3を除くゲインのいくつかを零にしてもよい。さらに、定常偏差をなくすために、積分ゲインを導入してもよい。
【０１２１】
本実施の形態においては、駆動輪センサ５１による駆動輪回転角速度の計測値に基づいて制御する場合でも、回転推定手段による駆動輪回転角速度の推定値に基づいて制御する場合でも、換言すれば、駆動輪回転角速度計測値の取得が可能でも不可能でも、前記式（９）に示す同一の制御則によって走行及び姿勢制御を実行する。これにより、制御則が簡素化されるため、制御系の設計時やプログラミング時に費やす労力や制御動作時の演算コストを大幅に低減できる。
【０１２２】
最後に、主制御ＥＣＵ２１は、各要素制御システムに指令値を与える（ステップＳ４−３）。この場合、主制御ＥＣＵ２１は、前述のように決定したフィードフォワード出力とフィードバック出力との和を駆動トルク指令値として、駆動輪制御ＥＣＵ２２に送信する。
【０１２３】
このように、本実施の形態においては、車体傾斜状態と駆動トルクの時間履歴、及び、パラメータ推定値に基づいて、駆動輪回転角速度を推定する。また、走行抵抗パラメータの計測値によって、駆動輪回転角速度の推定値を決定する。さらに、駆動輪回転角加速度を別の力学モデルにより推定し、車体重心ずれ量の推定値を用いて補正する。そして、駆動輪回転角速度の計測値と推定値との差が所定値以上の場合、計測値を異常とみなす。これにより、駆動輪回転状態の計測値の異常を確実に検出することを可能とし、より安全で便利で安価な倒立型の車両１０を提供することができる。
【０１２４】
なお、本発明は前記実施の形態に限定されるものではなく、本発明の趣旨に基づいて種々変形させることが可能であり、それらを本発明の範囲から排除するものではない。
【産業上の利用可能性】
【０１２５】
本発明は、倒立振り子の姿勢制御を利用した車両に適用することができる。
【符号の説明】
【０１２６】
１０ 車両
１２ 駆動輪
１７ 重心位置
２０ 制御ＥＣＵ
２１ 主制御ＥＣＵ
５１ 駆動輪センサ
【特許請求の範囲】
【請求項１】
回転可能に車体に取り付けられた駆動輪と、
該駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、
該車両制御装置は、
前記駆動輪の回転角速度を計測する回転計測手段と、
鉛直軸に対する前記車体の傾斜状態及び前記駆動トルクによって前記駆動輪の回転角速度を推定する回転推定手段と、
前記回転計測手段によって計測された回転角速度と前記回転推定手段によって推定された回転角速度との差の絶対値が所定値より大きい場合に前記回転計測手段によって計測された回転角速度が異常であると判定する判定手段と、を備えることを特徴とする車両。
【請求項２】
前記車両制御装置は、前記判定手段が前記回転計測手段によって計測された回転角速度が異常であると判定すると、異常を報知する報知手段を更に備える請求項１に記載の車両。
【請求項３】
前記判定手段は、前記回転計測手段によって計測された回転角速度を前記車体の姿勢の制御に使用することが可能であるか否かを判定し、
前記車両制御装置は、前記判定手段が可能であると判定した場合には前記回転計測手段によって計測された回転角速度に応じて前記駆動トルクの値を決定し、前記判定手段が可能でないと判定した場合には前記回転推定手段によって推定された回転角速度に応じて前記駆動トルクの値を決定する請求項１又は２に記載の車両。
【請求項４】
前記判定手段は、前記差の絶対値が第１の所定値より大きく、かつ、第２の所定値以下である場合には、前記回転計測手段によって計測された回転角速度が異常であるが、前記車体の姿勢の制御に使用することが可能であると判定し、前記差の絶対値が第２の所定値より大きい場合には、前記回転計測手段によって計測された回転角速度が異常であり、前記車体の姿勢の制御に使用することが可能でないと判定する請求項３に記載の車両。
【請求項５】
前記判定手段は、前記差の絶対値の累乗を第１の所定時間にわたって積分した第１の時間積分値が第１の所定積分値より大きく、かつ、前記差の絶対値の累乗を第２の所定時間にわたって積分した第２の時間積分値が第２の所定積分値以下である場合には前記回転計測手段によって計測された回転角速度が異常であるが、前記車体の姿勢の制御に使用することが可能であると判定し、前記第２の時間積分値が第２の所定積分値より大きい場合には前記回転計測手段によって計測された回転角速度が異常であり、前記車体の姿勢の制御に使用することが可能でないと判定する請求項３に記載の車両。
【請求項６】
前記判定手段は、前記第１の所定時間より短い前記第２の所定時間と、前記第１の所定積分値を前記第１の所定時間で除した値よりも前記第２の所定積分値を前記第２の所定時間で除した値の方が大きくなるような前記第２の所定積分値に基づいて判定する請求項５に記載の車両。
【請求項７】
前記車両制御装置は、前記車両の走行抵抗の特性量である抵抗パラメータを取得する抵抗パラメータ取得手段を更に備え、
前記傾斜推定手段は、前記抵抗パラメータ取得手段によって取得された抵抗パラメータによって前記回転角速度の推定値を補正する請求項１〜６のいずれか１項に記載の車両。
【請求項８】
路面形状を計測する路面形状計測手段を更に備え、
前記抵抗パラメータ取得手段は、前記路面形状計測手段によって計測された前記路面形状によって前記抵抗パラメータを推定する請求項７に記載の車両。
【請求項９】
前記車両制御装置は、前記車体の重心位置のずれ量を取得する重心ずれ量取得手段を更に備え、
前記回転推定手段は、前記重心ずれ量取得手段によって取得された重心ずれ量によって前記回転角速度の推定値を補正する請求項１〜８のいずれか１項に記載の車両。
【請求項１０】
前記乗員及び／又は重量物を搭載する搭乗部と、
該搭乗部の荷重分布を計測する荷重分布計測手段と、を更に備え、
前記重心ずれ量取得手段は、前記荷重分布計測手段によって計測された前記荷重分布によって前記重心ずれ量を推定する請求項９に記載の車両。
【請求項１】
回転可能に車体に取り付けられた駆動輪と、
該駆動輪に付与する駆動トルクを制御して前記車体の姿勢を制御する車両制御装置とを有し、
該車両制御装置は、
前記駆動輪の回転角速度を計測する回転計測手段と、
鉛直軸に対する前記車体の傾斜状態及び前記駆動トルクによって前記駆動輪の回転角速度を推定する回転推定手段と、
前記回転計測手段によって計測された回転角速度と前記回転推定手段によって推定された回転角速度との差の絶対値が所定値より大きい場合に前記回転計測手段によって計測された回転角速度が異常であると判定する判定手段と、を備えることを特徴とする車両。
【請求項２】
前記車両制御装置は、前記判定手段が前記回転計測手段によって計測された回転角速度が異常であると判定すると、異常を報知する報知手段を更に備える請求項１に記載の車両。
【請求項３】
前記判定手段は、前記回転計測手段によって計測された回転角速度を前記車体の姿勢の制御に使用することが可能であるか否かを判定し、
前記車両制御装置は、前記判定手段が可能であると判定した場合には前記回転計測手段によって計測された回転角速度に応じて前記駆動トルクの値を決定し、前記判定手段が可能でないと判定した場合には前記回転推定手段によって推定された回転角速度に応じて前記駆動トルクの値を決定する請求項１又は２に記載の車両。
【請求項４】
前記判定手段は、前記差の絶対値が第１の所定値より大きく、かつ、第２の所定値以下である場合には、前記回転計測手段によって計測された回転角速度が異常であるが、前記車体の姿勢の制御に使用することが可能であると判定し、前記差の絶対値が第２の所定値より大きい場合には、前記回転計測手段によって計測された回転角速度が異常であり、前記車体の姿勢の制御に使用することが可能でないと判定する請求項３に記載の車両。
【請求項５】
前記判定手段は、前記差の絶対値の累乗を第１の所定時間にわたって積分した第１の時間積分値が第１の所定積分値より大きく、かつ、前記差の絶対値の累乗を第２の所定時間にわたって積分した第２の時間積分値が第２の所定積分値以下である場合には前記回転計測手段によって計測された回転角速度が異常であるが、前記車体の姿勢の制御に使用することが可能であると判定し、前記第２の時間積分値が第２の所定積分値より大きい場合には前記回転計測手段によって計測された回転角速度が異常であり、前記車体の姿勢の制御に使用することが可能でないと判定する請求項３に記載の車両。
【請求項６】
前記判定手段は、前記第１の所定時間より短い前記第２の所定時間と、前記第１の所定積分値を前記第１の所定時間で除した値よりも前記第２の所定積分値を前記第２の所定時間で除した値の方が大きくなるような前記第２の所定積分値に基づいて判定する請求項５に記載の車両。
【請求項７】
前記車両制御装置は、前記車両の走行抵抗の特性量である抵抗パラメータを取得する抵抗パラメータ取得手段を更に備え、
前記傾斜推定手段は、前記抵抗パラメータ取得手段によって取得された抵抗パラメータによって前記回転角速度の推定値を補正する請求項１〜６のいずれか１項に記載の車両。
【請求項８】
路面形状を計測する路面形状計測手段を更に備え、
前記抵抗パラメータ取得手段は、前記路面形状計測手段によって計測された前記路面形状によって前記抵抗パラメータを推定する請求項７に記載の車両。
【請求項９】
前記車両制御装置は、前記車体の重心位置のずれ量を取得する重心ずれ量取得手段を更に備え、
前記回転推定手段は、前記重心ずれ量取得手段によって取得された重心ずれ量によって前記回転角速度の推定値を補正する請求項１〜８のいずれか１項に記載の車両。
【請求項１０】
前記乗員及び／又は重量物を搭載する搭乗部と、
該搭乗部の荷重分布を計測する荷重分布計測手段と、を更に備え、
前記重心ずれ量取得手段は、前記荷重分布計測手段によって計測された前記荷重分布によって前記重心ずれ量を推定する請求項９に記載の車両。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図９】
【公開番号】特開２０１０−２０８５３１（Ｐ２０１０−２０８５３１Ａ）
【公開日】平成２２年９月２４日（２０１０．９．２４）
【国際特許分類】
【出願番号】特願２００９−５７６５０（Ｐ２００９−５７６５０）
【出願日】平成２１年３月１１日（２００９．３．１１）
【出願人】（５９１２６１５０９）株式会社エクォス・リサーチ (1,360)
【Ｆターム（参考）】
【公開日】平成２２年９月２４日（２０１０．９．２４）
【国際特許分類】
【出願日】平成２１年３月１１日（２００９．３．１１）
【出願人】（５９１２６１５０９）株式会社エクォス・リサーチ (1,360)
【Ｆターム（参考）】
[ Back to top ]