車両
【課題】ブレーキを解除した場合に能動重量部が移動する方向を予測する移動方向予測手段が目標位置に近付く方向への移動を予測したときにはブレーキを解除することによって、能動重量部が中立位置から大きく外れた位置で停止して固定された場合であっても、車体の姿勢が適切な状態に自動的に復帰するようにして、車体傾斜によって乗員に与える不快感や不安感、及び、操縦性の低下が解消され、使い勝手がよく、かつ、安全に使用することができるようにする。
【解決手段】車両制御装置は、能動重量部ブレーキを解除した際の能動重量部の移動方向を予測する移動方向予測手段を備え、能動重量部が目標位置に近付く方向へ移動することを移動方向予測手段が予測した場合に能動重量部ブレーキを解除する。
【解決手段】車両制御装置は、能動重量部ブレーキを解除した際の能動重量部の移動方向を予測する移動方向予測手段を備え、能動重量部が目標位置に近付く方向へ移動することを移動方向予測手段が予測した場合に能動重量部ブレーキを解除する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、倒立振り子の姿勢制御を利用した車両に関するものである。
【背景技術】
【０００２】
従来、倒立振り子の姿勢制御を利用した車両に関する技術が提案されている。例えば、同軸上に配設された２つの駆動輪を有し、乗員の重心移動による車体の姿勢変化を感知して駆動する車両、球体状の単一の駆動輪に取り付けられた車体の姿勢を制御しながら移動する車両等の技術が提案されている（例えば、特許文献１参照。）。
【０００３】
この場合、カウンタウェイトとしての能動重量部を前後に移動させることで、倒立制御を行って、車両を移動させるようになっている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２００４−１２９４３５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
しかしながら、前記従来の車両においては、能動重量部を固定することにより、該能動重量部が自由に移動して倒立制御の妨げになるのを防ぐことが必要な場合がある。例えば、能動重量部を移動させるアクチュエータの異常時には、ブレーキを作動して能動重量部を固定する必要がある。しかし、このような制御では、安全性や快適性を十分に保障できない場合がある。
【０００６】
具体的には、能動重量部が基準位置（車両の重心が駆動輪接地点を通る鉛直線上にあるような位置）から大きく外れた位置にある場合に、ブレーキ作動によって固定されるときがある。例えば、車両の急加速時には、能動重量部を車両前方に大きく移動させる必要があるが、この時にブレーキが作動すると、車両の加減速に関わらず、能動重量部は常に前方に存在することになるので、安全性や快適性を十分に保障できない。車体のバランスを保つために、車体が常に後方に大きく傾いた状態に維持されるため、乗員に不快感や不安感を与える可能性がある。また、車両の重心可動量、すなわち、車両の加速性能又は減速性能が大きく制限されるため、場合によっては加速又は減速が不可能となる可能性がある。
【０００７】
本発明は、前記従来の車両の問題点を解決して、ブレーキを解除した場合に能動重量部が移動する方向を予測する移動方向予測手段が目標位置に近付く方向への移動を予測したときにはブレーキを解除することによって、能動重量部が中立位置から大きく外れた位置で停止して固定された場合であっても、車体の姿勢が適切な状態に自動的に復帰するようにして、車体傾斜によって乗員に与える不快感や不安感、及び、操縦性の低下が解消され、使い勝手がよく、かつ、安全に使用することができる車両を提供することを目的とする。
【課題を解決するための手段】
【０００８】
そのために、本発明の車両においては、回転可能に車体に取り付けられた駆動輪と、前記車体に対して移動可能に取り付けられた能動重量部と、該能動重量部を車体に対して固定する能動重量部ブレーキと、前記駆動輪に与える駆動トルク及び前記能動重量部の位置を制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、前記能動重量部ブレーキを解除した際の能動重量部の移動方向を予測する移動方向予測手段を備え、前記能動重量部が目標位置に近付く方向へ移動することを前記移動方向予測手段が予測した場合に前記能動重量部ブレーキを解除する。
【０００９】
本発明の他の車両においては、さらに、前記移動方向予測手段は、前記能動重量部の移動速度及び前記能動重量部に作用する作用力の推定値によって前記移動方向を予測する。
【００１０】
本発明の更に他の車両においては、さらに、前記移動方向予測手段は、前記作用力が所定時間だけ作用した後の移動速度を推定して前記移動方向を予測する。
【００１１】
本発明の更に他の車両においては、さらに、前記移動方向予測手段は、車体傾斜角及び車両速度によって前記作用力を推定する。
【００１２】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記能動重量部の移動速度が所定の閾（しきい）値より高い場合に前記能動重量部ブレーキを作動する。
【００１３】
本発明の更に他の車両においては、さらに、所定の周期で断続的に発信する周期信号を取得する周期信号取得手段を更に備え、前記車両制御装置は、前記周期信号取得手段が前記周期信号を取得できないときに前記能動重量部ブレーキの解除を禁止する。
【００１４】
本発明の更に他の車両においては、さらに、前記車両制御装置は、移動許可手段を備え、乗員が前記移動許可手段を操作して、能動重量部ブレーキの解除を許可した場合に前記能動重量部ブレーキを解除する。
【００１５】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記能動重量部を移動させる能動重量部アクチュエータの推力発生が不可能な場合に前記能動重量部ブレーキの制御を実行する。
【発明の効果】
【００１６】
請求項１の構成によれば、車体の姿勢が適切な状態に自動的に復帰するようにして、車体傾斜によって乗員に与える不快感や不安感、及び、操縦性の低下を解消することができる。
【００１７】
請求項２及び３の構成によれば、能動重量部の移動方向を正確に予測することができる。
【００１８】
請求項４の構成によれば、能動重量部に作用する力の大きさを計測しなくても、能動重量部の移動方向を予測することができる。
【００１９】
請求項５又は６の構成によれば、能動重量部が高速で移動することによる乗員の不安感、及び、高速移動から急停止した時の衝撃を低減することができる。
【００２０】
請求項７の構成によれば、能動重量部が不意に移動することによる乗員の不安感を防止することができる。
【００２１】
請求項８の構成によれば、アクチュエータに異常が発生しても、車体の姿勢を適切な状態に自動的に復帰させることができる。
【図面の簡単な説明】
【００２２】
【図１】本発明の第１の実施の形態における車両の姿勢変化を示す概略図である。
【図２】本発明の第１の実施の形態における車両システムの構成を示すブロック図である。
【図３】本発明の第１の実施の形態における車両制御処理の動作を示すフローチャートである。
【図４】本発明の第１の実施の形態におけるブレーキ制御処理の動作を示すフローチャートである。
【図５】本発明の第２の実施の形態における車両システムの構成を示すブロック図である。
【図６】本発明の第２の実施の形態におけるブレーキ制御処理の動作を示すフローチャートである。
【発明を実施するための形態】
【００２３】
以下、本発明の実施の形態について図面を参照しながら詳細に説明する。
【００２４】
図１は本発明の第１の実施の形態における車両の姿勢変化を示す概略図、図２は本発明の第１の実施の形態における車両システムの構成を示すブロック図である。なお、図１において、（ａ）は加速走行、（ｂ）はブレーキ作動、（ｃ）はブレーキ解除、（ｄ）は状態復帰を示す。
【００２５】
図１において、１０は、本実施の形態における車両であり、車体の本体部１１、駆動輪１２、支持部１３及び乗員１５が搭乗する搭乗部１４を有し、前記車両１０は、車体を前後に傾斜させることができるようになっている。そして、倒立振り子の姿勢制御と同様に車体の姿勢を制御する。図１に示される例において、車両１０は右方向に前進し、左方向に後退することができる。
【００２６】
前記駆動輪１２は、車体の一部である支持部１３に対して回転可能に支持され、駆動アクチュエータとしての駆動モータ５２によって駆動される。なお、駆動輪１２の軸は図１に示す平面に垂直な方向に存在し、駆動輪１２はその軸を中心に回転する。また、前記駆動輪１２は、単数であっても複数であってもよいが、複数である場合、同軸上に並列に配設される。本実施の形態においては、駆動輪１２が２つであるものとして説明する。この場合、各駆動輪１２は個別の駆動モータ５２によって独立して駆動される。なお、駆動アクチュエータとしては、例えば、油圧モータ、内燃機関等を使用することもできるが、ここでは、電気モータである駆動モータ５２を使用するものとして説明する。
【００２７】
また、車体の一部である本体部１１は、支持部１３によって下方から支持され、駆動輪１２の上方に位置する。そして、本体部１１には、能動重量部として機能する搭乗部１４が、車両１０の前後方向に本体部１１に対して相対的に並進可能となるように、換言すると、車体回転円の接線方向に相対的に移動可能となるように、取り付けられている。
【００２８】
ここで、能動重量部は、ある程度の質量を備え、本体部１１に対して並進する、すなわち、前後に移動させることによって、車両１０の重心位置を能動的に補正するものである。そして、能動重量部は、必ずしも搭乗部１４である必要はなく、例えば、バッテリ等の重量のある周辺機器を並進可能に本体部１１に対して取り付けた装置であってもよいし、ウェイト、錘（おもり）、バランサ等の専用の重量部材を並進可能に本体部１１に対して取り付けた装置であってもよい。また、搭乗部１４、重量のある周辺機器、専用の重量部材等を併用するものであってもよい。
【００２９】
本実施の形態においては、説明の都合上、乗員１５が搭乗する搭乗部１４が能動重量部として機能する例について説明するが、搭乗部１４には必ずしも乗員１５が搭乗している必要はなく、例えば、車両１０がリモートコントロールによって操縦される場合には、搭乗部１４に乗員１５が搭乗していなくてもよいし、乗員１５に代えて、貨物が積載されていてもよい。前記搭乗部１４は、乗用車、バス等の自動車に使用されるシートと同様のものであり、足置き部、座面部、背もたれ部及びヘッドレストを備え、図示されない移動機構を介して本体部１１に取り付けられている。
【００３０】
また、前記移動機構は、リニアガイド装置等の低抵抗の直線移動機構、及び、能動重量部アクチュエータとしての能動重量部モータ６２を備え、該能動重量部モータ６２によって搭乗部１４を駆動し、本体部１１に対して進行方向に前後させるようになっている。なお、能動重量部アクチュエータとしては、例えば、油圧モータ、リニアモータ等を使用することもできるが、ここでは、回転式の電気モータである能動重量部モータ６２を使用するものとして説明する。
【００３１】
リニアガイド装置は、例えば、本体部１１に取り付けられている案内レールと、搭乗部１４に取り付けられ、案内レールに沿ってスライドするキャリッジと、案内レールとキャリッジとの間に介在するボール、コロ等の転動体とを備える。そして、案内レールには、その左右側面部に２本の軌道溝が長手方向に沿って直線状に形成されている。また、キャリッジの断面はコ字状に形成され、その対向する２つの側面部内側には、２本の軌道溝が、案内レールの軌道溝と各々対向するように形成されている。転動体は、軌道溝の間に組み込まれており、案内レールとキャリッジとの相対的直線運動に伴って軌道溝内を転動するようになっている。なお、キャリッジには、軌道溝の両端をつなぐ戻し通路が形成されており、転動体は軌道溝及び戻し通路を循環するようになっている。
【００３２】
また、リニアガイド装置は、該リニアガイド装置の動きを締結するブレーキ装置としての能動重量部ブレーキ６３を備える。該能動重量部ブレーキ６３は、電力供給時に開放されるもの、例えば、無励磁作動型の電磁ブレーキであることが望ましい。車両１０が停車しているときのように搭乗部１４の動作が不要であるときには、能動重量部ブレーキ６３によって案内レールにキャリッジを固定することで、本体部１１と搭乗部１４との相対的位置関係を保持する。そして、動作が必要であるときには、能動重量部ブレーキ６３を解除し、本体部１１側の基準位置と搭乗部１４側の基準位置との距離が所定値となるように制御される。
【００３３】
前記搭乗部１４の脇（わき）には、目標走行状態取得装置としてのジョイスティック３１を備える入力装置３０が配設されている。乗員１５は、操縦装置であるジョイスティック３１を操作することによって、車両１０を操縦する、すなわち、車両１０の加速、減速、旋回、その場回転、停止、制動等の走行指令を入力するようになっている。なお、乗員１５が操作して走行指令を入力することができる装置であれば、ジョイスティック３１に代えて他の装置、例えば、ペダル、ハンドル、ジョグダイヤル、タッチパネル、押しボタン等の装置を目標走行状態取得装置として使用することもできる。
【００３４】
また、前記入力装置３０は、移動許可手段としての復帰許可スイッチ３２を備える。そして、乗員１５が能動重量部ブレーキ６３の解除を許可する場合には、復帰許可スイッチ３２を操作することによって、許可信号が送信されるようになっている。
【００３５】
なお、車両１０がリモートコントロールによって操縦される場合には、前記ジョイスティック３１及び復帰許可スイッチ３２に代えて、コントローラからの走行指令を有線又は無線で受信する受信装置を目標走行状態取得装置として使用することができる。また、車両１０があらかじめ決められた走行指令データに従って自動走行する場合には、前記ジョイスティック３１及び復帰許可スイッチ３２に代えて、半導体メモリ、ハードディスク等の記憶媒体に記憶された走行指令データを読み取るデータ読取り装置を目標走行状態取得装置として使用することができる。
【００３６】
また、車両システムは、図２に示されるように、車両制御装置２０を有し、該車両制御装置２０は主制御ＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３を備える。前記主制御ＥＣＵ２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３は、ＣＰＵ、ＭＰＵ等の演算手段、磁気ディスク、半導体メモリ等の記憶手段、入出力インターフェイス等を備え、車両１０の各部の動作を制御するコンピュータシステムであり、例えば、本体部１１に配設されるが、支持部１３や搭乗部１４に配設されていてもよい。また、前記主制御ＥＣＵ２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３は、それぞれ、別個に構成されていてもよいし、一体に構成されていてもよい。
【００３７】
そして、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、駆動輪センサ５１及び駆動モータ５２とともに、駆動輪１２の動作を制御する駆動輪制御システム５０の一部として機能する。前記駆動輪センサ５１は、レゾルバ、エンコーダ等から成り、駆動輪回転状態計測装置として機能し、駆動輪１２の回転状態を示す駆動輪回転角及び／又は回転角速度を検出し、主制御ＥＣＵ２１に送信する。また、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、該駆動輪制御ＥＣＵ２２は、受信した駆動トルク指令値に相当する入力電圧を駆動モータ５２に供給する。そして、該駆動モータ５２は、入力電圧に従って駆動輪１２に駆動トルクを付与し、これにより、駆動アクチュエータとして機能する。
【００３８】
また、主制御ＥＣＵ２１は、能動重量部制御ＥＣＵ２３、能動重量部センサ６１、能動重量部モータ６２及び能動重量部ブレーキ６３とともに、能動重量部である搭乗部１４の動作を制御する能動重量部制御システム６０の一部として機能する。前記能動重量部センサ６１は、エンコーダ等から成り、能動重量部移動状態計測装置として機能し、搭乗部１４の移動状態を示す能動重量部位置及び／又は移動速度を検出し、主制御ＥＣＵ２１に送信する。すると、該主制御ＥＣＵ２１は、能動重量部推力指令値を能動重量部制御ＥＣＵ２３に送信し、該能動重量部制御ＥＣＵ２３は、受信した能動重量部推力指令値に相当する入力電圧を能動重量部モータ６２に供給する。また、主制御ＥＣＵ２１は、作動電圧を能動重量部ブレーキ６３に供給する。そして、前記能動重量部モータ６２は、入力電圧に従って搭乗部１４を並進移動させる推力を搭乗部１４に付与し、これにより、能動重量部アクチュエータとして機能する。また、前記能動重量部ブレーキ６３は、作動電圧に従って搭乗部１４を本体部１１に対して移動不能に保持するブレーキ装置として機能する。
【００３９】
なお、本実施の形態においては、主制御ＥＣＵ２１から能動重量部ブレーキ６３に作動電圧を直接入力しているが、主制御ＥＣＵ２１が能動重量部制御ＥＣＵ２３にブレーキ動作信号を送信し、能動重量部制御ＥＣＵ２３が能動重量部ブレーキ６３に作動電圧を与えるようにしてもよい。
【００４０】
さらに、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、能動重量部制御ＥＣＵ２３、車体傾斜センサ４１、駆動モータ５２、能動重量部モータ６２及び能動重量部ブレーキ６３とともに、車体の姿勢を制御する車体制御システム４０の一部として機能する。前記車体傾斜センサ４１は、加速度センサ、ジャイロセンサ等から成り、車体傾斜状態計測装置として機能し、車体の傾斜状態を示す車体傾斜角及び／又は傾斜角速度を検出し、主制御ＥＣＵ２１に送信する。そして、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、能動重量部推力指令値を能動重量部制御ＥＣＵ２３に送信する。
【００４１】
なお、各センサは、複数の状態量を取得するものであってもよい。例えば、車体傾斜センサ４１として加速度センサとジャイロセンサとを併用し、両者の計測値から車体傾斜角と車体傾斜角速度とを決定してもよい。
【００４２】
また、車両制御装置２０は、機能の観点から、能動重量部ブレーキ６３を解除した際の搭乗部１４の移動方向を予測する移動方向予測手段と、所定の周期で断続的に発信する周期信号を取得する周期信号取得手段を備える。
【００４３】
前記車両制御装置２０によって姿勢制御が行われることで、車両１０は、加速走行時には、図１（ａ）に示されるように、搭乗部１４を前方に移動した状態で加速する。そして、加速走行中に能動重量部モータ６２に異常が発生すると、すなわち、アクチュエータ異常が発生すると、能動重量部ブレーキ６３を作動させる。すると、加速終了後、車体の倒立姿勢を保つために、図１（ｂ）に示されるように、車体を後方に傾ける。続いて、所定の条件が満たされるとブレーキ解除が行われ、能動重量部ブレーキ６３を解除して重力による搭乗部１４の後方移動を許可する。すると、図１（ｃ）に示されるように、搭乗部１４の後方移動と共に、車体の倒立姿勢を保つために車体を起き上がらせる。そして、図１（ｄ）に示されるように、搭乗部１４が基準位置に復帰し、車体姿勢が直立状態に復帰すると、この状態、すなわち、復帰状態で、再度能動重量部ブレーキ６３を作動させ、搭乗部１４を基準位置で固定する。
【００４４】
次に、前記構成の車両１０の動作について詳細に説明する。まず、車両制御処理の概要について説明する。
【００４５】
図３は本発明の第１の実施の形態における車両制御処理の動作を示すフローチャートである。
【００４６】
車両制御処理において、車両制御装置２０は、まず、モータ正常判定を行い、モータが正常であるか否かを判定する（ステップＳ１）。この場合、能動重量部モータ６２が推力を発生可能であるか否かを判定する。具体的には、能動重量部制御ＥＣＵ２３がモータ診断手段を備え、能動重量部モータ６２が推力を発生不能、すなわち、異常と診断した場合に所定の信号を主制御ＥＣＵ２１に送信する。すると、該主制御ＥＣＵ２１は、その信号を受信した場合に、モータが正常ではないと判定する。
【００４７】
そして、モータが正常であると判定すると、車両制御装置２０は、ブレーキ解除を行う（ステップＳ２）。この場合、能動重量部ブレーキ６３を解除して、能動重量部としての搭乗部１４を移動可能とする。具体的には、主制御ＥＣＵ２１は、能動重量部ブレーキ６３に作動電圧を入力する。
【００４８】
続いて、車両制御装置２０は、通常走行・姿勢制御処理を実行し（ステップＳ３）、搭乗部１４を適切に移動させながら、車体の姿勢を保持しつつ、乗員１５からの走行指令を実現して車両制御処理を終了する。なお、該車両制御処理は、所定の時間間隔（例えば、１００〔μｓ〕毎）で繰り返し実行される。
【００４９】
一方、モータが正常であるか否かを判定して異常である場合、車両制御装置２０は、ブレーキ制御処理を実行する（ステップＳ４）。ブレーキ制御処理では、車両１０の状態に応じて、能動重量部ブレーキ６３を作動又は解除する。
【００５０】
続いて、車両制御装置２０は、非常走行・姿勢制御処理を実行し（ステップＳ５）、搭乗部１４が固定された状態で、車体の姿勢を保持しつつ、乗員１５からの走行指令を実現して車両制御処理を終了する。
【００５１】
次に、ブレーキ制御処理について説明する。
【００５２】
図４は本発明の第１の実施の形態におけるブレーキ制御処理の動作を示すフローチャートである。
【００５３】
本実施の形態においては、状態量やパラメータを次のような記号によって表す。
θW ：駆動輪回転角〔ｒａｄ〕
θ1 ：車体傾斜角（鉛直軸基準）〔ｒａｄ〕
λS ：搭乗部位置（能動重量部位置）〔ｍ〕
ｇ：重力加速度〔ｍ／ｓ2 〕
ＲW ：駆動輪接地半径〔ｍ〕
ｍS ：搭乗部質量（能動重量部質量：搭載物を含む）〔ｋｇ〕
【００５４】
続いて、主制御ＥＣＵ２１は、解放時移動速度を予測する（ステップＳ４−２）。この場合、主制御ＥＣＵ２１は、各状態量から、能動重量部ブレーキ６３を解除して搭乗部１４を解放した時の搭乗部１４の移動速度の推定値を下記の式によって取得する。
【００５５】
【数１】
【００５６】
上記の式によって得られる推定値は、少し先の未来における搭乗部１４の移動速度を推定した値である。なお、Ｔは進み時間（所定値）である。また、ＦS は搭乗部１４に作用する作用力であり、下記の式によって表される。
【００５７】
【数２】
【００５８】
作用力ＦS を表す上記の式の各項は以下の作用に相当する。
第１項：車体が傾くことによる重力の作用
第２項：車両１０が加減速することによる慣性力の作用
第３項：車体の回転運動による慣性力の作用
第４項：搭乗部１４の移動速度に対する粘性摩擦力の作用
なお、上記式の中の車体傾斜角加速度及び駆動輪回転角加速度の値は、車体傾斜角及び駆動輪回転角の計測値を２階時間微分（差分）することで得られる。また、搭乗部移動速度の値は、搭乗部位置の値を１階時間微分（差分）することで得られる。
【００５９】
このように、本実施の形態においては、搭乗部１４を解放した場合に予測される搭乗部１４の移動速度を求める。つまり、現時点で能動重量部ブレーキ６３を解除した場合、又は、解除状態を継続した場合における所定時間後の搭乗部移動速度を予測する。具体的には、搭乗部１４に作用している力である作用力に基づいて、解放時移動速度を予測する。例えば、搭乗部１４が静止している場合、目標位置に向かう方向に作用力が働いているときには、能動重量部ブレーキ６３の解除時に搭乗部１４が目標位置へ向けて移動すると予測し、能動重量部ブレーキ６３を解除して搭乗部１４を解放する。このように、搭乗部１４に作用する力を考慮することで、確実に搭乗部１４を適切な方向に移動させることができる。
【００６０】
また、車体傾斜状態、駆動輪回転状態、及び、搭乗部移動状態に基づいて、作用力を推定する。具体的には、作用力として、車体傾斜に伴う重力の作用、駆動輪回転加速度に伴う慣性力の作用、車体傾斜加速度に伴う慣性力の作用、及び、搭乗部１４の移動速度に対する粘性摩擦力を考慮する。これにより、専用のセンサを追加することなく、高精度に作用力すなわち解放時移動速度を予測できる。
【００６１】
さらに、現時点での搭乗部１４の移動速度に基づいて、解放時移動速度を予測する。例えば、目標位置に向かう搭乗部１４の移動速度が所定の値よりも高い場合、作用力の方向に関わらず、能動重量部ブレーキ６３を解除状態に維持し、慣性による搭乗部１４の移動を継続させる。このように、搭乗部１４の慣性を活用することで、より効率的に素早く搭乗部１４を目標位置に近付けることができる。
【００６２】
さらに、車両速度又は駆動輪回転角速度に基づいて、減速時間を決定する。この場合、車両速度が高いほど、車両１０が停止するまでの時間が長く、車体傾斜に及ぼす影響が大きい、すなわち、前方傾斜確率が大きいと判断する。
【００６３】
なお、本実施の形態においては、作用力として重力、粘性摩擦力、慣性力等を考慮しているが、その一部を省略してもよい。また、乾性摩擦、モータの逆起電力等の他の要素を考慮してもよい。
【００６４】
また、本実施の形態においては、非線形の関数によって作用力を決定しているが、線形近似した簡単な関数によって決定してもよい。また、非線形の関数をマップとして具備し、それを用いて決定してもよい。
【００６５】
さらに、本実施の形態においては、作用力の大きさや方向を推定手段によって取得しているが、別の手段によって取得してもよい。例えば、能動重量部ブレーキ６３に作用する摩擦力の大きさを計測する力センサを備え、その計測値に基づいて作用力の大きさや方向を決定してもよい。
【００６６】
続いて、主制御ＥＣＵ２１は、移動方向判定を行い、方向がＯＫであるか否かを判定する（ステップＳ４−３）。すなわち、搭乗部１４の予測される移動方向が基準位置へ向かう方向であるか否かを判定する。判定条件、すなわち、適切な方向であると判定する条件は、下記の式によって表される。
【００６７】
【数３】
【００６８】
なお、搭乗部位置（能動重量部位置）λS の値は、基準位置を零とする。該基準位置は、車体が直立状態にあるときの車両１０の重心が、鉛直線及び駆動輪１２の回転軸に平行で駆動輪１２の接地点を通る平面上に位置するような搭乗部１４の位置を表す。
【００６９】
本実施の形態における移動方向判定では、予測される能動重量部ブレーキ６３の解除時における搭乗部１４の移動方向が目標位置へ向かう方向であるか否かを判定する。具体的には、搭乗部１４の目標位置に相当する値を零とするとき、実際の搭乗部１４の位置と推定された解放時移動速度との積が所定の負の値よりも小さい場合に、適切な方向であると判定する。このように、搭乗部１４が適切な方向に移動すると予測される場合にのみ能動重量部ブレーキ６３を解除することで、推力を与えるアクチュエータを用いることなく搭乗部１４を適切な位置まで移動させることが可能となり、アクチュエータ故障時の車体傾斜による乗員１５の不安感や不快感を解消できる。
【００７０】
また、搭乗部１４を移動させる目標となる位置である目標位置を基準位置とする。そして、搭乗部１４が基準位置に向けて移動すると判断される場合に、能動重量部ブレーキ６３を解除する。このように、搭乗部１４を基準位置とすることで、車両１０の停止時に搭乗部１４を水平な姿勢に保持することが可能となり、乗員１５の不安感や不快感を解消するのと共に、重心移動可能量を前後で同程度とすることで、加速性能と減速性能の一方のみを著しく低下させることを防ぎ、ある程度の操縦性を保障できる。
【００７１】
このように、本実施の形態においては、搭乗部１４を移動させる目標となる位置を点として与えているが、ある程度の範囲として目標位置を与えてもよい。これにより、目標位置付近での細かいブレーキ制御が不要になり、ブレーキ状態の頻繁な切替に伴う振動の発生を防ぐことができる。
【００７２】
また、本実施の形態においては、目標位置を所定の基準位置に設定しているが、目標位置を状況に応じて変化させてもよい。例えば、乗員１５や搭載物の重心位置を取得する搭載荷重重心位置取得手段を備え、その値に応じて目標位置を修正してもよい。これにより、搭載荷重の状態に関わらず、搭乗部１４を必ず水平に保持することができる。
【００７３】
さらに、車両１０の走行目標に応じて、目標位置を変化させてもよい。例えば、乗員１５によって加速目標が入力された場合には、目標位置を車両１０の目標進行方向側に移してもよい。これにより、能動重量部モータ６２の故障時においても、正常時に近い加減速性能を達成できる。
【００７４】
そして、移動方向判定の結果、搭乗部１４の予測される移動方向が基準位置へ向かう方向であり、方向がＯＫであると判定された場合、主制御ＥＣＵ２１は、移動速度判定を行い、速度がＯＫであるか否かを判定する（ステップＳ４−４）。なお、方向がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−７）、ブレーキ制御処理を終了する。
【００７５】
移動速度判定では、搭乗部１４の移動速度が許容範囲内であるか否かを判定する。そして、実際の搭乗部１４の移動速度の絶対値と予測された解放時移動速度の絶対値が共に所定の閾値以下である場合に、許容範囲内であると判定する。搭乗部１４の移動速度が高くなると能動重量部ブレーキ６３を作動することで、搭乗部１４の移動速度を所定の制限値以下に抑え、速く移動することによる乗員１５の不安感、及び、その後の停止時における衝撃に対する乗員１５の不快感や倒立姿勢制御への悪影響を軽減する。
【００７６】
そして、移動速度判定の結果、搭乗部１４の予測される移動速度が許容範囲内であり、速度がＯＫであると判定された場合、主制御ＥＣＵ２１は、乗員許可判定を行い、許可がＯＫであるか否かを判定する（ステップＳ４−５）。なお、速度がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−７）、ブレーキ制御処理を終了する。
【００７７】
乗員許可判定では、乗員１５が能動重量部ブレーキ６３の解除を許可しているか否かを判定する。主制御ＥＣＵ２１は、復帰許可スイッチ３２の操作状態を許可信号受信の有無によって判定し、許可信号を受信した場合には、乗員１５は許可していると判定する。これにより、能動重量部ブレーキ６３の解除に伴う搭乗部１４の不意の動作によって乗員１５に不安感を与えることを防ぐと共に、能動重量部モータ６２が異常状態にあることを乗員１５に認識させることができる。
【００７８】
なお、本実施の形態においては、乗員１５が能動重量部ブレーキ６３の解除を許可しない限り、移動方向予測によるブレーキ制御を実行しないが、特定の条件下では、乗員１５の許可状況に関わらずブレーキ制御を実行してもよい。例えば、搭乗部１４が目標位置から所定の距離以上離れた位置で固定された場合には、乗員１５の許可状況に関わらず、ブレーキ制御を実行してもよい。これにより、搭乗部１４を適切な位置に移動させる好機を確実に活かすことができる。
【００７９】
そして、乗員許可判定の結果、乗員１５が能動重量部ブレーキ６３の解除を許可し、許可がＯＫであると判定された場合、主制御ＥＣＵ２１は、能動重量部ブレーキ６３を解除し（ステップＳ４−６）、ブレーキ制御処理を終了する。なお、許可がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−７）、ブレーキ制御処理を終了する。
【００８０】
ブレーキ制御処理では、３つの条件がすべて適切である場合に限り、能動重量部ブレーキ６３を解除する。具体的には、主制御ＥＣＵ２１から能動重量部ブレーキ６３に作動電圧を入力する。
【００８１】
なお、本実施の形態においては、能動重量部モータ６２の異常時に限り、前記ブレーキ制御処理を実行しているが、他の場合で実行してもよい。例えば、バッテリの残量低下により節電を要求された場合にブレーキ制御処理を実行することで、消費電力を低減することができる。
【００８２】
このように、本実施の形態においては、能動重量部ブレーキ６３を解除した場合に搭乗部１４が移動する方向を予測し、その方向が目標位置に近付く方向であるときに能動重量部ブレーキ６３を解除する。具体的には、搭乗部１４の移動速度と作用力推定値によって移動方向を予測する。この場合、作用力が所定時間だけ作用した後の移動速度を推定して、移動方向を予測する。そして、搭乗部１４の停止時において、作用力が目標位置の方向に働くと予測される場合に能動重量部ブレーキ６３を解除する。また、搭乗部１４の移動時において、目標位置に向かう移動速度が所定の閾値よりも高い場合に能動重量部ブレーキ６３を解除する。さらに、車体傾斜角と車両加速度によって作用力を推定する。つまり、重力、摩擦力及び車両１０の加減速と車体の傾斜に伴う慣性力の影響を考慮する。
【００８３】
また、搭乗部１４の移動速度が所定の閾値よりも高い場合には、能動重量部ブレーキ６３を作動する。さらに、復帰許可スイッチ３２を備え、乗員１５が能動重量部ブレーキ６３の解除を許可した場合に、能動重量部ブレーキ６３を解除する。さらに、搭乗部１４を移動させる能動重量部モータ６２の推力発生が不可能な場合にブレーキ制御処理を実行する。なお、車体が直立状態にあるときに車両１０の重心が駆動輪１２の接地点を通る鉛直線上にあるような搭乗部位置を目標位置とする。
【００８４】
これにより、能動重量部モータ６２の異常に伴い、搭乗部１４が中立位置から大きく外れた位置で停止して固定された場合であっても、車体の姿勢が適切な状態に自動的に復帰するようにして、車体傾斜によって乗員１５に与えられる不快感や不安感、及び、操縦性の低下を解消することができる。
【００８５】
次に、本発明の第２の実施の形態について説明する。なお、第１の実施の形態と同じ構造を有するものについては、同じ符号を付与することによってその説明を省略する。また、前記第１の実施の形態と同じ動作及び同じ効果についても、その説明を省略する。
【００８６】
図５は本発明の第２の実施の形態における車両システムの構成を示すブロック図である。
【００８７】
本実施の形態においては、搭乗部１４の移動状態の計測値を用いずに、ブレーキ制御処理を実行する。
【００８８】
能動重量部モータ６２の故障状態によっては、推力の付加と搭乗部位置の取得が同時に不可能となる場合がある。例えば、能動重量部モータ６２の電流制御に必要な位相角の取得と搭乗部位置の取得に共通のセンサを用いる場合、そのセンサが故障すると、推力制御と搭乗部位置の取得が同時に不可能になる。このような故障モードに備えて、別のフェイルセーフ手段を用意することが必要であり、安価な車両１０の実現が困難になる可能性がある。
【００８９】
そこで、本実施の形態においては、能動重量部ブレーキ６３の解除継続時間を制限する。具体的には、周期信号取得手段を備え、周期信号出力時に限り、能動重量部ブレーキ６３の解除を許可する。また、作用力の方向と異常発生直前の搭乗部位置に基づいて、能動重量部ブレーキ６３の状態を制御する。具体的には、作用力の値と異常発生直前の搭乗部位置の値との積が負である場合、能動重量部ブレーキ６３を解除する。さらに、基準位置検出手段を備え、搭乗部１４が基準位置に到達したとき能動重量部ブレーキ６３の解除を禁止する。
【００９０】
これにより、搭乗部１４の推力付加と移動状態取得の両方が不可能であっても、ブレーキ制御処理の実行が可能となり、より安全で安価な倒立型の車両１０を提供することができる。
【００９１】
図５に示されるように、本実施の形態においては、能動重量部制御システム６０は、基準位置検出手段としての基準位置検出センサ６４を備える。該基準位置検出センサ６４は、搭乗部１４が基準位置に到達したことを検出すると、到達信号を主制御ＥＣＵ２１に送信する。
【００９２】
本実施の形態においては、基準位置検出センサ６４として、光検出型の近接センサを用いる。具体的には、搭乗部１４を含む可動部に遮蔽（へい）板を具備し、固定部である本体部１１の搭乗部１４の基準位置に相当する位置に発光部と受光部とを具備し、発光部からの光が遮蔽板によって遮られることで受光部が受光できない場合に、到達信号を主制御ＥＣＵ２１に送信する。
【００９３】
なお、その他の点の構成については、前記第１の実施の形態と同様であるので、その説明を省略する。
【００９４】
次に、本実施の形態における車両１０の動作について説明する。ここでは、ブレーキ制御処理について説明する。
【００９５】
図６は本発明の第２の実施の形態におけるブレーキ制御処理の動作を示すフローチャートである。
【００９６】
続いて、主制御ＥＣＵ２１は、作用力を予測する（ステップＳ４−１２）。この場合、主制御ＥＣＵ２１は、各状態量から、搭乗部１４に作用する作用力（搭乗部作用力）ＦS を下記の式によって取得する。
【００９７】
【数４】
【００９８】
作用力ＦS を表す上記の式の各項は以下の作用に相当する。
第１項：車体が傾くことによる重力の作用
第２項：車両１０が加減速することによる慣性力の作用
第３項：車体の回転運動による慣性力の作用
なお、上記式の中の車体傾斜角加速度及び駆動輪回転角加速度の値は、車体傾斜角及び駆動輪回転角の計測値を２階時間微分（差分）することで得られる。
【００９９】
続いて、主制御ＥＣＵ２１は、移動方向判定を行い、方向がＯＫであるか否かを判定する（ステップＳ４−１３）。すなわち、搭乗部作用力が基準位置へ向かう方向に作用しているか否かを判定する。判定条件、すなわち、適切な方向であると判定する条件は、下記の式によって表される。
【０１００】
【数５】
【０１０１】
本実施の形態における移動方向判定では、搭乗部１４に作用する力が搭乗部１４を目標位置へ向かう方向に作用しているか否かを判定する。具体的には、搭乗部１４の目標位置に相当する値を零とする場合、モータ異常発生直前の搭乗部位置と推定された作用力との積が所定の負の値よりも小さいときに、適切な方向であると判定する。このように、モータ異常検出直前の搭乗部位置について、その正負によって搭乗部１４を移動させるべき方向を判断することにより、モータ異常発生後に搭乗部１４の位置が不明であっても、搭乗部１４を目標位置に向けて移動させることが可能となり、モータ異常発生時の車体姿勢をある程度適切な状態に復帰させることができる。
【０１０２】
なお、本実施の形態においては、目標位置である基準位置に基準位置検出センサ６４を１つ備えるが、基準位置検出センサ６４を複数備え、各取付位置を目標位置の候補として、それらを搭載物重心位置や加減速目標に応じて選択できるようにしてもよい。これにより、選択的な目標位置に搭乗部１４を誘導することが可能となる。
【０１０３】
そして、移動方向判定の結果、搭乗部作用が基準位置へ向かう方向に作用し、方向がＯＫであると判定された場合、主制御ＥＣＵ２１は、周期信号許可判定を行い、時刻がＯＫであるか否かを判定する（ステップＳ４−１４）。なお、方向がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−１８）、ブレーキ制御処理を終了する。
【０１０４】
周期信号許可判定では、能動重量部ブレーキ６３の解除が許可されている時刻であるか否かを判定する。判定条件、すなわち、能動重量部ブレーキ６３を解除する条件は、下記の式によって表される。
【０１０５】
【数６】
【０１０６】
なお、ｔは時刻、ＴH は解除許可時間（所定値）、ＴL は解除禁止時間（所定値）である。
【０１０７】
周期信号許可判定（解除継続時間制限）では、時刻によって、能動重量部ブレーキ６３の解除を禁止する。具体的には、能動重量部ブレーキ６３の解除の許可と禁止を周期的に繰り返す。つまり、所定の解除許可時間だけ解除を許可した後、所定の解除禁止時間だけ解除を禁止することを繰り返す。このように、能動重量部ブレーキ６３の解除を継続する時間を所定の解除許可時間内に制限することで、搭乗部移動状態を取得できない場合でも、搭乗部１４の移動速度が過剰に上昇することを確実に防止できる。
【０１０８】
なお、本実施の形態においては、他の解除許可条件とは無関係に、周期的な能動重量部ブレーキ６３の強制作動を実行しているが、他の条件に適応させてもよい。例えば、移動方向判定で能動重量部ブレーキ６３の解除を許可された時点からの時間を時刻として、周期信号許可判定を実行してもよい。これにより、搭乗部１４をより効率的に素早く目標位置に誘導できる。
【０１０９】
そして、周期信号許可判定の結果、能動重量部ブレーキ６３の解除が許可され、時刻がＯＫであると判定された場合、主制御ＥＣＵ２１は、乗員許可判定を行い、許可がＯＫであるか否かを判定する（ステップＳ４−１５）。なお、時刻がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−１８）、ブレーキ制御処理を終了する。
【０１１０】
乗員許可判定では、乗員１５が能動重量部ブレーキ６３の解除を許可しているか否かを判定する。主制御ＥＣＵ２１は、復帰許可スイッチ３２の操作状態を許可信号受信の有無によって判断し、許可信号を受信した場合には、乗員１５は許可していると判定する。これにより、能動重量部ブレーキ６３の解除に伴う搭乗部１４の不意の動作によって乗員１５に不安感を与えることを防ぐと共に、能動重量部モータ６２が異常状態にあることを乗員１５に認識させることができる。
【０１１１】
そして、乗員許可判定の結果、乗員１５が能動重量部ブレーキ６３の解除を許可し、許可がＯＫであると判定された場合、主制御ＥＣＵ２１は、基準位置到達判定を行い、未到達であるか否かを判定する（ステップＳ４−１６）。なお、許可がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−１８）、ブレーキ制御処理を終了する。
【０１１２】
基準位置到達判定では、搭乗部１４が既に基準位置に到達しているか否かを判定する。この場合、主制御ＥＣＵ２１は、搭乗部１４が基準位置に到達しているか否かを到達信号受信の有無によって判断し、到達信号を受信した場合には、搭乗部１４が基準位置に到達していると判定する。これにより、搭乗部移動状態の計測値を取得不可能であっても、搭乗部１４を適切な位置で固定できる。
【０１１３】
なお、本実施の形態においては、搭乗部１４を移動させる目標となる位置を点として与えているが、ある程度の範囲として目標位置を与えてもよい。例えば、搭乗部１４の基準位置から所定の距離だけ前後離れた２点に基準位置検出センサ６４をそれぞれ取り付け、一方の基準位置検出センサ６４から到達信号を受信した時点で、搭乗部１４が許容範囲内に存在すると判断して、以降のブレーキ解除を禁止してもよい。
【０１１４】
そして、基準位置到達判定の結果、搭乗部１４が未だに基準位置に到達しておらず、未到達であると判定された場合、主制御ＥＣＵ２１は、能動重量部ブレーキ６３を解除し（ステップＳ４−１７）、ブレーキ制御処理を終了する。なお、到達していると判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−１８）、ブレーキ制御処理を終了する。
【０１１５】
ブレーキ制御処理では、４つの条件がすべて適切である場合に限り、能動重量部ブレーキ６３を解除する。具体的には、主制御ＥＣＵ２１から能動重量部ブレーキ６３に作動電圧を入力する。
【０１１６】
このように、本実施の形態においては、搭乗部１４の移動状態の計測値を用いずに、ブレーキ制御処理を実行する。具体的には、作用力の値と異常発生直前の搭乗部位置の値との積が負である場合、能動重量部ブレーキ６３を解除する。また、所定の解除時間だけ、能動重量部ブレーキ６３の解除を許可する。さらに、搭乗部１４が基準位置に到達したとき能動重量部ブレーキ６３の解除を禁止する。
【０１１７】
これにより、搭乗部１４の推力付加と移動状態取得の両方が不可能であっても、ブレーキ制御処理の実行が可能となり、より安全で安価な倒立型の車両１０を提供することができる。
【０１１８】
なお、本発明は前記実施の形態に限定されるものではなく、本発明の趣旨に基づいて種々変形させることが可能であり、それらを本発明の範囲から排除するものではない。
【産業上の利用可能性】
【０１１９】
本発明は、倒立振り子の姿勢制御を利用した車両に適用することができる。
【符号の説明】
【０１２０】
１０ 車両
１２ 駆動輪
１４ 搭乗部
１５ 乗員
２０ 車両制御装置
３２ 復帰許可スイッチ
６２ 能動重量部モータ
６３ 能動重量部ブレーキ
【技術分野】
【０００１】
本発明は、倒立振り子の姿勢制御を利用した車両に関するものである。
【背景技術】
【０００２】
従来、倒立振り子の姿勢制御を利用した車両に関する技術が提案されている。例えば、同軸上に配設された２つの駆動輪を有し、乗員の重心移動による車体の姿勢変化を感知して駆動する車両、球体状の単一の駆動輪に取り付けられた車体の姿勢を制御しながら移動する車両等の技術が提案されている（例えば、特許文献１参照。）。
【０００３】
この場合、カウンタウェイトとしての能動重量部を前後に移動させることで、倒立制御を行って、車両を移動させるようになっている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２００４−１２９４３５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
しかしながら、前記従来の車両においては、能動重量部を固定することにより、該能動重量部が自由に移動して倒立制御の妨げになるのを防ぐことが必要な場合がある。例えば、能動重量部を移動させるアクチュエータの異常時には、ブレーキを作動して能動重量部を固定する必要がある。しかし、このような制御では、安全性や快適性を十分に保障できない場合がある。
【０００６】
具体的には、能動重量部が基準位置（車両の重心が駆動輪接地点を通る鉛直線上にあるような位置）から大きく外れた位置にある場合に、ブレーキ作動によって固定されるときがある。例えば、車両の急加速時には、能動重量部を車両前方に大きく移動させる必要があるが、この時にブレーキが作動すると、車両の加減速に関わらず、能動重量部は常に前方に存在することになるので、安全性や快適性を十分に保障できない。車体のバランスを保つために、車体が常に後方に大きく傾いた状態に維持されるため、乗員に不快感や不安感を与える可能性がある。また、車両の重心可動量、すなわち、車両の加速性能又は減速性能が大きく制限されるため、場合によっては加速又は減速が不可能となる可能性がある。
【０００７】
本発明は、前記従来の車両の問題点を解決して、ブレーキを解除した場合に能動重量部が移動する方向を予測する移動方向予測手段が目標位置に近付く方向への移動を予測したときにはブレーキを解除することによって、能動重量部が中立位置から大きく外れた位置で停止して固定された場合であっても、車体の姿勢が適切な状態に自動的に復帰するようにして、車体傾斜によって乗員に与える不快感や不安感、及び、操縦性の低下が解消され、使い勝手がよく、かつ、安全に使用することができる車両を提供することを目的とする。
【課題を解決するための手段】
【０００８】
そのために、本発明の車両においては、回転可能に車体に取り付けられた駆動輪と、前記車体に対して移動可能に取り付けられた能動重量部と、該能動重量部を車体に対して固定する能動重量部ブレーキと、前記駆動輪に与える駆動トルク及び前記能動重量部の位置を制御して前記車体の姿勢を制御する車両制御装置とを有し、該車両制御装置は、前記能動重量部ブレーキを解除した際の能動重量部の移動方向を予測する移動方向予測手段を備え、前記能動重量部が目標位置に近付く方向へ移動することを前記移動方向予測手段が予測した場合に前記能動重量部ブレーキを解除する。
【０００９】
本発明の他の車両においては、さらに、前記移動方向予測手段は、前記能動重量部の移動速度及び前記能動重量部に作用する作用力の推定値によって前記移動方向を予測する。
【００１０】
本発明の更に他の車両においては、さらに、前記移動方向予測手段は、前記作用力が所定時間だけ作用した後の移動速度を推定して前記移動方向を予測する。
【００１１】
本発明の更に他の車両においては、さらに、前記移動方向予測手段は、車体傾斜角及び車両速度によって前記作用力を推定する。
【００１２】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記能動重量部の移動速度が所定の閾（しきい）値より高い場合に前記能動重量部ブレーキを作動する。
【００１３】
本発明の更に他の車両においては、さらに、所定の周期で断続的に発信する周期信号を取得する周期信号取得手段を更に備え、前記車両制御装置は、前記周期信号取得手段が前記周期信号を取得できないときに前記能動重量部ブレーキの解除を禁止する。
【００１４】
本発明の更に他の車両においては、さらに、前記車両制御装置は、移動許可手段を備え、乗員が前記移動許可手段を操作して、能動重量部ブレーキの解除を許可した場合に前記能動重量部ブレーキを解除する。
【００１５】
本発明の更に他の車両においては、さらに、前記車両制御装置は、前記能動重量部を移動させる能動重量部アクチュエータの推力発生が不可能な場合に前記能動重量部ブレーキの制御を実行する。
【発明の効果】
【００１６】
請求項１の構成によれば、車体の姿勢が適切な状態に自動的に復帰するようにして、車体傾斜によって乗員に与える不快感や不安感、及び、操縦性の低下を解消することができる。
【００１７】
請求項２及び３の構成によれば、能動重量部の移動方向を正確に予測することができる。
【００１８】
請求項４の構成によれば、能動重量部に作用する力の大きさを計測しなくても、能動重量部の移動方向を予測することができる。
【００１９】
請求項５又は６の構成によれば、能動重量部が高速で移動することによる乗員の不安感、及び、高速移動から急停止した時の衝撃を低減することができる。
【００２０】
請求項７の構成によれば、能動重量部が不意に移動することによる乗員の不安感を防止することができる。
【００２１】
請求項８の構成によれば、アクチュエータに異常が発生しても、車体の姿勢を適切な状態に自動的に復帰させることができる。
【図面の簡単な説明】
【００２２】
【図１】本発明の第１の実施の形態における車両の姿勢変化を示す概略図である。
【図２】本発明の第１の実施の形態における車両システムの構成を示すブロック図である。
【図３】本発明の第１の実施の形態における車両制御処理の動作を示すフローチャートである。
【図４】本発明の第１の実施の形態におけるブレーキ制御処理の動作を示すフローチャートである。
【図５】本発明の第２の実施の形態における車両システムの構成を示すブロック図である。
【図６】本発明の第２の実施の形態におけるブレーキ制御処理の動作を示すフローチャートである。
【発明を実施するための形態】
【００２３】
以下、本発明の実施の形態について図面を参照しながら詳細に説明する。
【００２４】
図１は本発明の第１の実施の形態における車両の姿勢変化を示す概略図、図２は本発明の第１の実施の形態における車両システムの構成を示すブロック図である。なお、図１において、（ａ）は加速走行、（ｂ）はブレーキ作動、（ｃ）はブレーキ解除、（ｄ）は状態復帰を示す。
【００２５】
図１において、１０は、本実施の形態における車両であり、車体の本体部１１、駆動輪１２、支持部１３及び乗員１５が搭乗する搭乗部１４を有し、前記車両１０は、車体を前後に傾斜させることができるようになっている。そして、倒立振り子の姿勢制御と同様に車体の姿勢を制御する。図１に示される例において、車両１０は右方向に前進し、左方向に後退することができる。
【００２６】
前記駆動輪１２は、車体の一部である支持部１３に対して回転可能に支持され、駆動アクチュエータとしての駆動モータ５２によって駆動される。なお、駆動輪１２の軸は図１に示す平面に垂直な方向に存在し、駆動輪１２はその軸を中心に回転する。また、前記駆動輪１２は、単数であっても複数であってもよいが、複数である場合、同軸上に並列に配設される。本実施の形態においては、駆動輪１２が２つであるものとして説明する。この場合、各駆動輪１２は個別の駆動モータ５２によって独立して駆動される。なお、駆動アクチュエータとしては、例えば、油圧モータ、内燃機関等を使用することもできるが、ここでは、電気モータである駆動モータ５２を使用するものとして説明する。
【００２７】
また、車体の一部である本体部１１は、支持部１３によって下方から支持され、駆動輪１２の上方に位置する。そして、本体部１１には、能動重量部として機能する搭乗部１４が、車両１０の前後方向に本体部１１に対して相対的に並進可能となるように、換言すると、車体回転円の接線方向に相対的に移動可能となるように、取り付けられている。
【００２８】
ここで、能動重量部は、ある程度の質量を備え、本体部１１に対して並進する、すなわち、前後に移動させることによって、車両１０の重心位置を能動的に補正するものである。そして、能動重量部は、必ずしも搭乗部１４である必要はなく、例えば、バッテリ等の重量のある周辺機器を並進可能に本体部１１に対して取り付けた装置であってもよいし、ウェイト、錘（おもり）、バランサ等の専用の重量部材を並進可能に本体部１１に対して取り付けた装置であってもよい。また、搭乗部１４、重量のある周辺機器、専用の重量部材等を併用するものであってもよい。
【００２９】
本実施の形態においては、説明の都合上、乗員１５が搭乗する搭乗部１４が能動重量部として機能する例について説明するが、搭乗部１４には必ずしも乗員１５が搭乗している必要はなく、例えば、車両１０がリモートコントロールによって操縦される場合には、搭乗部１４に乗員１５が搭乗していなくてもよいし、乗員１５に代えて、貨物が積載されていてもよい。前記搭乗部１４は、乗用車、バス等の自動車に使用されるシートと同様のものであり、足置き部、座面部、背もたれ部及びヘッドレストを備え、図示されない移動機構を介して本体部１１に取り付けられている。
【００３０】
また、前記移動機構は、リニアガイド装置等の低抵抗の直線移動機構、及び、能動重量部アクチュエータとしての能動重量部モータ６２を備え、該能動重量部モータ６２によって搭乗部１４を駆動し、本体部１１に対して進行方向に前後させるようになっている。なお、能動重量部アクチュエータとしては、例えば、油圧モータ、リニアモータ等を使用することもできるが、ここでは、回転式の電気モータである能動重量部モータ６２を使用するものとして説明する。
【００３１】
リニアガイド装置は、例えば、本体部１１に取り付けられている案内レールと、搭乗部１４に取り付けられ、案内レールに沿ってスライドするキャリッジと、案内レールとキャリッジとの間に介在するボール、コロ等の転動体とを備える。そして、案内レールには、その左右側面部に２本の軌道溝が長手方向に沿って直線状に形成されている。また、キャリッジの断面はコ字状に形成され、その対向する２つの側面部内側には、２本の軌道溝が、案内レールの軌道溝と各々対向するように形成されている。転動体は、軌道溝の間に組み込まれており、案内レールとキャリッジとの相対的直線運動に伴って軌道溝内を転動するようになっている。なお、キャリッジには、軌道溝の両端をつなぐ戻し通路が形成されており、転動体は軌道溝及び戻し通路を循環するようになっている。
【００３２】
また、リニアガイド装置は、該リニアガイド装置の動きを締結するブレーキ装置としての能動重量部ブレーキ６３を備える。該能動重量部ブレーキ６３は、電力供給時に開放されるもの、例えば、無励磁作動型の電磁ブレーキであることが望ましい。車両１０が停車しているときのように搭乗部１４の動作が不要であるときには、能動重量部ブレーキ６３によって案内レールにキャリッジを固定することで、本体部１１と搭乗部１４との相対的位置関係を保持する。そして、動作が必要であるときには、能動重量部ブレーキ６３を解除し、本体部１１側の基準位置と搭乗部１４側の基準位置との距離が所定値となるように制御される。
【００３３】
前記搭乗部１４の脇（わき）には、目標走行状態取得装置としてのジョイスティック３１を備える入力装置３０が配設されている。乗員１５は、操縦装置であるジョイスティック３１を操作することによって、車両１０を操縦する、すなわち、車両１０の加速、減速、旋回、その場回転、停止、制動等の走行指令を入力するようになっている。なお、乗員１５が操作して走行指令を入力することができる装置であれば、ジョイスティック３１に代えて他の装置、例えば、ペダル、ハンドル、ジョグダイヤル、タッチパネル、押しボタン等の装置を目標走行状態取得装置として使用することもできる。
【００３４】
また、前記入力装置３０は、移動許可手段としての復帰許可スイッチ３２を備える。そして、乗員１５が能動重量部ブレーキ６３の解除を許可する場合には、復帰許可スイッチ３２を操作することによって、許可信号が送信されるようになっている。
【００３５】
なお、車両１０がリモートコントロールによって操縦される場合には、前記ジョイスティック３１及び復帰許可スイッチ３２に代えて、コントローラからの走行指令を有線又は無線で受信する受信装置を目標走行状態取得装置として使用することができる。また、車両１０があらかじめ決められた走行指令データに従って自動走行する場合には、前記ジョイスティック３１及び復帰許可スイッチ３２に代えて、半導体メモリ、ハードディスク等の記憶媒体に記憶された走行指令データを読み取るデータ読取り装置を目標走行状態取得装置として使用することができる。
【００３６】
また、車両システムは、図２に示されるように、車両制御装置２０を有し、該車両制御装置２０は主制御ＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３を備える。前記主制御ＥＣＵ２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３は、ＣＰＵ、ＭＰＵ等の演算手段、磁気ディスク、半導体メモリ等の記憶手段、入出力インターフェイス等を備え、車両１０の各部の動作を制御するコンピュータシステムであり、例えば、本体部１１に配設されるが、支持部１３や搭乗部１４に配設されていてもよい。また、前記主制御ＥＣＵ２１、駆動輪制御ＥＣＵ２２及び能動重量部制御ＥＣＵ２３は、それぞれ、別個に構成されていてもよいし、一体に構成されていてもよい。
【００３７】
そして、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、駆動輪センサ５１及び駆動モータ５２とともに、駆動輪１２の動作を制御する駆動輪制御システム５０の一部として機能する。前記駆動輪センサ５１は、レゾルバ、エンコーダ等から成り、駆動輪回転状態計測装置として機能し、駆動輪１２の回転状態を示す駆動輪回転角及び／又は回転角速度を検出し、主制御ＥＣＵ２１に送信する。また、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、該駆動輪制御ＥＣＵ２２は、受信した駆動トルク指令値に相当する入力電圧を駆動モータ５２に供給する。そして、該駆動モータ５２は、入力電圧に従って駆動輪１２に駆動トルクを付与し、これにより、駆動アクチュエータとして機能する。
【００３８】
また、主制御ＥＣＵ２１は、能動重量部制御ＥＣＵ２３、能動重量部センサ６１、能動重量部モータ６２及び能動重量部ブレーキ６３とともに、能動重量部である搭乗部１４の動作を制御する能動重量部制御システム６０の一部として機能する。前記能動重量部センサ６１は、エンコーダ等から成り、能動重量部移動状態計測装置として機能し、搭乗部１４の移動状態を示す能動重量部位置及び／又は移動速度を検出し、主制御ＥＣＵ２１に送信する。すると、該主制御ＥＣＵ２１は、能動重量部推力指令値を能動重量部制御ＥＣＵ２３に送信し、該能動重量部制御ＥＣＵ２３は、受信した能動重量部推力指令値に相当する入力電圧を能動重量部モータ６２に供給する。また、主制御ＥＣＵ２１は、作動電圧を能動重量部ブレーキ６３に供給する。そして、前記能動重量部モータ６２は、入力電圧に従って搭乗部１４を並進移動させる推力を搭乗部１４に付与し、これにより、能動重量部アクチュエータとして機能する。また、前記能動重量部ブレーキ６３は、作動電圧に従って搭乗部１４を本体部１１に対して移動不能に保持するブレーキ装置として機能する。
【００３９】
なお、本実施の形態においては、主制御ＥＣＵ２１から能動重量部ブレーキ６３に作動電圧を直接入力しているが、主制御ＥＣＵ２１が能動重量部制御ＥＣＵ２３にブレーキ動作信号を送信し、能動重量部制御ＥＣＵ２３が能動重量部ブレーキ６３に作動電圧を与えるようにしてもよい。
【００４０】
さらに、主制御ＥＣＵ２１は、駆動輪制御ＥＣＵ２２、能動重量部制御ＥＣＵ２３、車体傾斜センサ４１、駆動モータ５２、能動重量部モータ６２及び能動重量部ブレーキ６３とともに、車体の姿勢を制御する車体制御システム４０の一部として機能する。前記車体傾斜センサ４１は、加速度センサ、ジャイロセンサ等から成り、車体傾斜状態計測装置として機能し、車体の傾斜状態を示す車体傾斜角及び／又は傾斜角速度を検出し、主制御ＥＣＵ２１に送信する。そして、該主制御ＥＣＵ２１は、駆動トルク指令値を駆動輪制御ＥＣＵ２２に送信し、能動重量部推力指令値を能動重量部制御ＥＣＵ２３に送信する。
【００４１】
なお、各センサは、複数の状態量を取得するものであってもよい。例えば、車体傾斜センサ４１として加速度センサとジャイロセンサとを併用し、両者の計測値から車体傾斜角と車体傾斜角速度とを決定してもよい。
【００４２】
また、車両制御装置２０は、機能の観点から、能動重量部ブレーキ６３を解除した際の搭乗部１４の移動方向を予測する移動方向予測手段と、所定の周期で断続的に発信する周期信号を取得する周期信号取得手段を備える。
【００４３】
前記車両制御装置２０によって姿勢制御が行われることで、車両１０は、加速走行時には、図１（ａ）に示されるように、搭乗部１４を前方に移動した状態で加速する。そして、加速走行中に能動重量部モータ６２に異常が発生すると、すなわち、アクチュエータ異常が発生すると、能動重量部ブレーキ６３を作動させる。すると、加速終了後、車体の倒立姿勢を保つために、図１（ｂ）に示されるように、車体を後方に傾ける。続いて、所定の条件が満たされるとブレーキ解除が行われ、能動重量部ブレーキ６３を解除して重力による搭乗部１４の後方移動を許可する。すると、図１（ｃ）に示されるように、搭乗部１４の後方移動と共に、車体の倒立姿勢を保つために車体を起き上がらせる。そして、図１（ｄ）に示されるように、搭乗部１４が基準位置に復帰し、車体姿勢が直立状態に復帰すると、この状態、すなわち、復帰状態で、再度能動重量部ブレーキ６３を作動させ、搭乗部１４を基準位置で固定する。
【００４４】
次に、前記構成の車両１０の動作について詳細に説明する。まず、車両制御処理の概要について説明する。
【００４５】
図３は本発明の第１の実施の形態における車両制御処理の動作を示すフローチャートである。
【００４６】
車両制御処理において、車両制御装置２０は、まず、モータ正常判定を行い、モータが正常であるか否かを判定する（ステップＳ１）。この場合、能動重量部モータ６２が推力を発生可能であるか否かを判定する。具体的には、能動重量部制御ＥＣＵ２３がモータ診断手段を備え、能動重量部モータ６２が推力を発生不能、すなわち、異常と診断した場合に所定の信号を主制御ＥＣＵ２１に送信する。すると、該主制御ＥＣＵ２１は、その信号を受信した場合に、モータが正常ではないと判定する。
【００４７】
そして、モータが正常であると判定すると、車両制御装置２０は、ブレーキ解除を行う（ステップＳ２）。この場合、能動重量部ブレーキ６３を解除して、能動重量部としての搭乗部１４を移動可能とする。具体的には、主制御ＥＣＵ２１は、能動重量部ブレーキ６３に作動電圧を入力する。
【００４８】
続いて、車両制御装置２０は、通常走行・姿勢制御処理を実行し（ステップＳ３）、搭乗部１４を適切に移動させながら、車体の姿勢を保持しつつ、乗員１５からの走行指令を実現して車両制御処理を終了する。なお、該車両制御処理は、所定の時間間隔（例えば、１００〔μｓ〕毎）で繰り返し実行される。
【００４９】
一方、モータが正常であるか否かを判定して異常である場合、車両制御装置２０は、ブレーキ制御処理を実行する（ステップＳ４）。ブレーキ制御処理では、車両１０の状態に応じて、能動重量部ブレーキ６３を作動又は解除する。
【００５０】
続いて、車両制御装置２０は、非常走行・姿勢制御処理を実行し（ステップＳ５）、搭乗部１４が固定された状態で、車体の姿勢を保持しつつ、乗員１５からの走行指令を実現して車両制御処理を終了する。
【００５１】
次に、ブレーキ制御処理について説明する。
【００５２】
図４は本発明の第１の実施の形態におけるブレーキ制御処理の動作を示すフローチャートである。
【００５３】
本実施の形態においては、状態量やパラメータを次のような記号によって表す。
θW ：駆動輪回転角〔ｒａｄ〕
θ1 ：車体傾斜角（鉛直軸基準）〔ｒａｄ〕
λS ：搭乗部位置（能動重量部位置）〔ｍ〕
ｇ：重力加速度〔ｍ／ｓ2 〕
ＲW ：駆動輪接地半径〔ｍ〕
ｍS ：搭乗部質量（能動重量部質量：搭載物を含む）〔ｋｇ〕
【００５４】
続いて、主制御ＥＣＵ２１は、解放時移動速度を予測する（ステップＳ４−２）。この場合、主制御ＥＣＵ２１は、各状態量から、能動重量部ブレーキ６３を解除して搭乗部１４を解放した時の搭乗部１４の移動速度の推定値を下記の式によって取得する。
【００５５】
【数１】
【００５６】
上記の式によって得られる推定値は、少し先の未来における搭乗部１４の移動速度を推定した値である。なお、Ｔは進み時間（所定値）である。また、ＦS は搭乗部１４に作用する作用力であり、下記の式によって表される。
【００５７】
【数２】
【００５８】
作用力ＦS を表す上記の式の各項は以下の作用に相当する。
第１項：車体が傾くことによる重力の作用
第２項：車両１０が加減速することによる慣性力の作用
第３項：車体の回転運動による慣性力の作用
第４項：搭乗部１４の移動速度に対する粘性摩擦力の作用
なお、上記式の中の車体傾斜角加速度及び駆動輪回転角加速度の値は、車体傾斜角及び駆動輪回転角の計測値を２階時間微分（差分）することで得られる。また、搭乗部移動速度の値は、搭乗部位置の値を１階時間微分（差分）することで得られる。
【００５９】
このように、本実施の形態においては、搭乗部１４を解放した場合に予測される搭乗部１４の移動速度を求める。つまり、現時点で能動重量部ブレーキ６３を解除した場合、又は、解除状態を継続した場合における所定時間後の搭乗部移動速度を予測する。具体的には、搭乗部１４に作用している力である作用力に基づいて、解放時移動速度を予測する。例えば、搭乗部１４が静止している場合、目標位置に向かう方向に作用力が働いているときには、能動重量部ブレーキ６３の解除時に搭乗部１４が目標位置へ向けて移動すると予測し、能動重量部ブレーキ６３を解除して搭乗部１４を解放する。このように、搭乗部１４に作用する力を考慮することで、確実に搭乗部１４を適切な方向に移動させることができる。
【００６０】
また、車体傾斜状態、駆動輪回転状態、及び、搭乗部移動状態に基づいて、作用力を推定する。具体的には、作用力として、車体傾斜に伴う重力の作用、駆動輪回転加速度に伴う慣性力の作用、車体傾斜加速度に伴う慣性力の作用、及び、搭乗部１４の移動速度に対する粘性摩擦力を考慮する。これにより、専用のセンサを追加することなく、高精度に作用力すなわち解放時移動速度を予測できる。
【００６１】
さらに、現時点での搭乗部１４の移動速度に基づいて、解放時移動速度を予測する。例えば、目標位置に向かう搭乗部１４の移動速度が所定の値よりも高い場合、作用力の方向に関わらず、能動重量部ブレーキ６３を解除状態に維持し、慣性による搭乗部１４の移動を継続させる。このように、搭乗部１４の慣性を活用することで、より効率的に素早く搭乗部１４を目標位置に近付けることができる。
【００６２】
さらに、車両速度又は駆動輪回転角速度に基づいて、減速時間を決定する。この場合、車両速度が高いほど、車両１０が停止するまでの時間が長く、車体傾斜に及ぼす影響が大きい、すなわち、前方傾斜確率が大きいと判断する。
【００６３】
なお、本実施の形態においては、作用力として重力、粘性摩擦力、慣性力等を考慮しているが、その一部を省略してもよい。また、乾性摩擦、モータの逆起電力等の他の要素を考慮してもよい。
【００６４】
また、本実施の形態においては、非線形の関数によって作用力を決定しているが、線形近似した簡単な関数によって決定してもよい。また、非線形の関数をマップとして具備し、それを用いて決定してもよい。
【００６５】
さらに、本実施の形態においては、作用力の大きさや方向を推定手段によって取得しているが、別の手段によって取得してもよい。例えば、能動重量部ブレーキ６３に作用する摩擦力の大きさを計測する力センサを備え、その計測値に基づいて作用力の大きさや方向を決定してもよい。
【００６６】
続いて、主制御ＥＣＵ２１は、移動方向判定を行い、方向がＯＫであるか否かを判定する（ステップＳ４−３）。すなわち、搭乗部１４の予測される移動方向が基準位置へ向かう方向であるか否かを判定する。判定条件、すなわち、適切な方向であると判定する条件は、下記の式によって表される。
【００６７】
【数３】
【００６８】
なお、搭乗部位置（能動重量部位置）λS の値は、基準位置を零とする。該基準位置は、車体が直立状態にあるときの車両１０の重心が、鉛直線及び駆動輪１２の回転軸に平行で駆動輪１２の接地点を通る平面上に位置するような搭乗部１４の位置を表す。
【００６９】
本実施の形態における移動方向判定では、予測される能動重量部ブレーキ６３の解除時における搭乗部１４の移動方向が目標位置へ向かう方向であるか否かを判定する。具体的には、搭乗部１４の目標位置に相当する値を零とするとき、実際の搭乗部１４の位置と推定された解放時移動速度との積が所定の負の値よりも小さい場合に、適切な方向であると判定する。このように、搭乗部１４が適切な方向に移動すると予測される場合にのみ能動重量部ブレーキ６３を解除することで、推力を与えるアクチュエータを用いることなく搭乗部１４を適切な位置まで移動させることが可能となり、アクチュエータ故障時の車体傾斜による乗員１５の不安感や不快感を解消できる。
【００７０】
また、搭乗部１４を移動させる目標となる位置である目標位置を基準位置とする。そして、搭乗部１４が基準位置に向けて移動すると判断される場合に、能動重量部ブレーキ６３を解除する。このように、搭乗部１４を基準位置とすることで、車両１０の停止時に搭乗部１４を水平な姿勢に保持することが可能となり、乗員１５の不安感や不快感を解消するのと共に、重心移動可能量を前後で同程度とすることで、加速性能と減速性能の一方のみを著しく低下させることを防ぎ、ある程度の操縦性を保障できる。
【００７１】
このように、本実施の形態においては、搭乗部１４を移動させる目標となる位置を点として与えているが、ある程度の範囲として目標位置を与えてもよい。これにより、目標位置付近での細かいブレーキ制御が不要になり、ブレーキ状態の頻繁な切替に伴う振動の発生を防ぐことができる。
【００７２】
また、本実施の形態においては、目標位置を所定の基準位置に設定しているが、目標位置を状況に応じて変化させてもよい。例えば、乗員１５や搭載物の重心位置を取得する搭載荷重重心位置取得手段を備え、その値に応じて目標位置を修正してもよい。これにより、搭載荷重の状態に関わらず、搭乗部１４を必ず水平に保持することができる。
【００７３】
さらに、車両１０の走行目標に応じて、目標位置を変化させてもよい。例えば、乗員１５によって加速目標が入力された場合には、目標位置を車両１０の目標進行方向側に移してもよい。これにより、能動重量部モータ６２の故障時においても、正常時に近い加減速性能を達成できる。
【００７４】
そして、移動方向判定の結果、搭乗部１４の予測される移動方向が基準位置へ向かう方向であり、方向がＯＫであると判定された場合、主制御ＥＣＵ２１は、移動速度判定を行い、速度がＯＫであるか否かを判定する（ステップＳ４−４）。なお、方向がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−７）、ブレーキ制御処理を終了する。
【００７５】
移動速度判定では、搭乗部１４の移動速度が許容範囲内であるか否かを判定する。そして、実際の搭乗部１４の移動速度の絶対値と予測された解放時移動速度の絶対値が共に所定の閾値以下である場合に、許容範囲内であると判定する。搭乗部１４の移動速度が高くなると能動重量部ブレーキ６３を作動することで、搭乗部１４の移動速度を所定の制限値以下に抑え、速く移動することによる乗員１５の不安感、及び、その後の停止時における衝撃に対する乗員１５の不快感や倒立姿勢制御への悪影響を軽減する。
【００７６】
そして、移動速度判定の結果、搭乗部１４の予測される移動速度が許容範囲内であり、速度がＯＫであると判定された場合、主制御ＥＣＵ２１は、乗員許可判定を行い、許可がＯＫであるか否かを判定する（ステップＳ４−５）。なお、速度がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−７）、ブレーキ制御処理を終了する。
【００７７】
乗員許可判定では、乗員１５が能動重量部ブレーキ６３の解除を許可しているか否かを判定する。主制御ＥＣＵ２１は、復帰許可スイッチ３２の操作状態を許可信号受信の有無によって判定し、許可信号を受信した場合には、乗員１５は許可していると判定する。これにより、能動重量部ブレーキ６３の解除に伴う搭乗部１４の不意の動作によって乗員１５に不安感を与えることを防ぐと共に、能動重量部モータ６２が異常状態にあることを乗員１５に認識させることができる。
【００７８】
なお、本実施の形態においては、乗員１５が能動重量部ブレーキ６３の解除を許可しない限り、移動方向予測によるブレーキ制御を実行しないが、特定の条件下では、乗員１５の許可状況に関わらずブレーキ制御を実行してもよい。例えば、搭乗部１４が目標位置から所定の距離以上離れた位置で固定された場合には、乗員１５の許可状況に関わらず、ブレーキ制御を実行してもよい。これにより、搭乗部１４を適切な位置に移動させる好機を確実に活かすことができる。
【００７９】
そして、乗員許可判定の結果、乗員１５が能動重量部ブレーキ６３の解除を許可し、許可がＯＫであると判定された場合、主制御ＥＣＵ２１は、能動重量部ブレーキ６３を解除し（ステップＳ４−６）、ブレーキ制御処理を終了する。なお、許可がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−７）、ブレーキ制御処理を終了する。
【００８０】
ブレーキ制御処理では、３つの条件がすべて適切である場合に限り、能動重量部ブレーキ６３を解除する。具体的には、主制御ＥＣＵ２１から能動重量部ブレーキ６３に作動電圧を入力する。
【００８１】
なお、本実施の形態においては、能動重量部モータ６２の異常時に限り、前記ブレーキ制御処理を実行しているが、他の場合で実行してもよい。例えば、バッテリの残量低下により節電を要求された場合にブレーキ制御処理を実行することで、消費電力を低減することができる。
【００８２】
このように、本実施の形態においては、能動重量部ブレーキ６３を解除した場合に搭乗部１４が移動する方向を予測し、その方向が目標位置に近付く方向であるときに能動重量部ブレーキ６３を解除する。具体的には、搭乗部１４の移動速度と作用力推定値によって移動方向を予測する。この場合、作用力が所定時間だけ作用した後の移動速度を推定して、移動方向を予測する。そして、搭乗部１４の停止時において、作用力が目標位置の方向に働くと予測される場合に能動重量部ブレーキ６３を解除する。また、搭乗部１４の移動時において、目標位置に向かう移動速度が所定の閾値よりも高い場合に能動重量部ブレーキ６３を解除する。さらに、車体傾斜角と車両加速度によって作用力を推定する。つまり、重力、摩擦力及び車両１０の加減速と車体の傾斜に伴う慣性力の影響を考慮する。
【００８３】
また、搭乗部１４の移動速度が所定の閾値よりも高い場合には、能動重量部ブレーキ６３を作動する。さらに、復帰許可スイッチ３２を備え、乗員１５が能動重量部ブレーキ６３の解除を許可した場合に、能動重量部ブレーキ６３を解除する。さらに、搭乗部１４を移動させる能動重量部モータ６２の推力発生が不可能な場合にブレーキ制御処理を実行する。なお、車体が直立状態にあるときに車両１０の重心が駆動輪１２の接地点を通る鉛直線上にあるような搭乗部位置を目標位置とする。
【００８４】
これにより、能動重量部モータ６２の異常に伴い、搭乗部１４が中立位置から大きく外れた位置で停止して固定された場合であっても、車体の姿勢が適切な状態に自動的に復帰するようにして、車体傾斜によって乗員１５に与えられる不快感や不安感、及び、操縦性の低下を解消することができる。
【００８５】
次に、本発明の第２の実施の形態について説明する。なお、第１の実施の形態と同じ構造を有するものについては、同じ符号を付与することによってその説明を省略する。また、前記第１の実施の形態と同じ動作及び同じ効果についても、その説明を省略する。
【００８６】
図５は本発明の第２の実施の形態における車両システムの構成を示すブロック図である。
【００８７】
本実施の形態においては、搭乗部１４の移動状態の計測値を用いずに、ブレーキ制御処理を実行する。
【００８８】
能動重量部モータ６２の故障状態によっては、推力の付加と搭乗部位置の取得が同時に不可能となる場合がある。例えば、能動重量部モータ６２の電流制御に必要な位相角の取得と搭乗部位置の取得に共通のセンサを用いる場合、そのセンサが故障すると、推力制御と搭乗部位置の取得が同時に不可能になる。このような故障モードに備えて、別のフェイルセーフ手段を用意することが必要であり、安価な車両１０の実現が困難になる可能性がある。
【００８９】
そこで、本実施の形態においては、能動重量部ブレーキ６３の解除継続時間を制限する。具体的には、周期信号取得手段を備え、周期信号出力時に限り、能動重量部ブレーキ６３の解除を許可する。また、作用力の方向と異常発生直前の搭乗部位置に基づいて、能動重量部ブレーキ６３の状態を制御する。具体的には、作用力の値と異常発生直前の搭乗部位置の値との積が負である場合、能動重量部ブレーキ６３を解除する。さらに、基準位置検出手段を備え、搭乗部１４が基準位置に到達したとき能動重量部ブレーキ６３の解除を禁止する。
【００９０】
これにより、搭乗部１４の推力付加と移動状態取得の両方が不可能であっても、ブレーキ制御処理の実行が可能となり、より安全で安価な倒立型の車両１０を提供することができる。
【００９１】
図５に示されるように、本実施の形態においては、能動重量部制御システム６０は、基準位置検出手段としての基準位置検出センサ６４を備える。該基準位置検出センサ６４は、搭乗部１４が基準位置に到達したことを検出すると、到達信号を主制御ＥＣＵ２１に送信する。
【００９２】
本実施の形態においては、基準位置検出センサ６４として、光検出型の近接センサを用いる。具体的には、搭乗部１４を含む可動部に遮蔽（へい）板を具備し、固定部である本体部１１の搭乗部１４の基準位置に相当する位置に発光部と受光部とを具備し、発光部からの光が遮蔽板によって遮られることで受光部が受光できない場合に、到達信号を主制御ＥＣＵ２１に送信する。
【００９３】
なお、その他の点の構成については、前記第１の実施の形態と同様であるので、その説明を省略する。
【００９４】
次に、本実施の形態における車両１０の動作について説明する。ここでは、ブレーキ制御処理について説明する。
【００９５】
図６は本発明の第２の実施の形態におけるブレーキ制御処理の動作を示すフローチャートである。
【００９６】
続いて、主制御ＥＣＵ２１は、作用力を予測する（ステップＳ４−１２）。この場合、主制御ＥＣＵ２１は、各状態量から、搭乗部１４に作用する作用力（搭乗部作用力）ＦS を下記の式によって取得する。
【００９７】
【数４】
【００９８】
作用力ＦS を表す上記の式の各項は以下の作用に相当する。
第１項：車体が傾くことによる重力の作用
第２項：車両１０が加減速することによる慣性力の作用
第３項：車体の回転運動による慣性力の作用
なお、上記式の中の車体傾斜角加速度及び駆動輪回転角加速度の値は、車体傾斜角及び駆動輪回転角の計測値を２階時間微分（差分）することで得られる。
【００９９】
続いて、主制御ＥＣＵ２１は、移動方向判定を行い、方向がＯＫであるか否かを判定する（ステップＳ４−１３）。すなわち、搭乗部作用力が基準位置へ向かう方向に作用しているか否かを判定する。判定条件、すなわち、適切な方向であると判定する条件は、下記の式によって表される。
【０１００】
【数５】
【０１０１】
本実施の形態における移動方向判定では、搭乗部１４に作用する力が搭乗部１４を目標位置へ向かう方向に作用しているか否かを判定する。具体的には、搭乗部１４の目標位置に相当する値を零とする場合、モータ異常発生直前の搭乗部位置と推定された作用力との積が所定の負の値よりも小さいときに、適切な方向であると判定する。このように、モータ異常検出直前の搭乗部位置について、その正負によって搭乗部１４を移動させるべき方向を判断することにより、モータ異常発生後に搭乗部１４の位置が不明であっても、搭乗部１４を目標位置に向けて移動させることが可能となり、モータ異常発生時の車体姿勢をある程度適切な状態に復帰させることができる。
【０１０２】
なお、本実施の形態においては、目標位置である基準位置に基準位置検出センサ６４を１つ備えるが、基準位置検出センサ６４を複数備え、各取付位置を目標位置の候補として、それらを搭載物重心位置や加減速目標に応じて選択できるようにしてもよい。これにより、選択的な目標位置に搭乗部１４を誘導することが可能となる。
【０１０３】
そして、移動方向判定の結果、搭乗部作用が基準位置へ向かう方向に作用し、方向がＯＫであると判定された場合、主制御ＥＣＵ２１は、周期信号許可判定を行い、時刻がＯＫであるか否かを判定する（ステップＳ４−１４）。なお、方向がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−１８）、ブレーキ制御処理を終了する。
【０１０４】
周期信号許可判定では、能動重量部ブレーキ６３の解除が許可されている時刻であるか否かを判定する。判定条件、すなわち、能動重量部ブレーキ６３を解除する条件は、下記の式によって表される。
【０１０５】
【数６】
【０１０６】
なお、ｔは時刻、ＴH は解除許可時間（所定値）、ＴL は解除禁止時間（所定値）である。
【０１０７】
周期信号許可判定（解除継続時間制限）では、時刻によって、能動重量部ブレーキ６３の解除を禁止する。具体的には、能動重量部ブレーキ６３の解除の許可と禁止を周期的に繰り返す。つまり、所定の解除許可時間だけ解除を許可した後、所定の解除禁止時間だけ解除を禁止することを繰り返す。このように、能動重量部ブレーキ６３の解除を継続する時間を所定の解除許可時間内に制限することで、搭乗部移動状態を取得できない場合でも、搭乗部１４の移動速度が過剰に上昇することを確実に防止できる。
【０１０８】
なお、本実施の形態においては、他の解除許可条件とは無関係に、周期的な能動重量部ブレーキ６３の強制作動を実行しているが、他の条件に適応させてもよい。例えば、移動方向判定で能動重量部ブレーキ６３の解除を許可された時点からの時間を時刻として、周期信号許可判定を実行してもよい。これにより、搭乗部１４をより効率的に素早く目標位置に誘導できる。
【０１０９】
そして、周期信号許可判定の結果、能動重量部ブレーキ６３の解除が許可され、時刻がＯＫであると判定された場合、主制御ＥＣＵ２１は、乗員許可判定を行い、許可がＯＫであるか否かを判定する（ステップＳ４−１５）。なお、時刻がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−１８）、ブレーキ制御処理を終了する。
【０１１０】
乗員許可判定では、乗員１５が能動重量部ブレーキ６３の解除を許可しているか否かを判定する。主制御ＥＣＵ２１は、復帰許可スイッチ３２の操作状態を許可信号受信の有無によって判断し、許可信号を受信した場合には、乗員１５は許可していると判定する。これにより、能動重量部ブレーキ６３の解除に伴う搭乗部１４の不意の動作によって乗員１５に不安感を与えることを防ぐと共に、能動重量部モータ６２が異常状態にあることを乗員１５に認識させることができる。
【０１１１】
そして、乗員許可判定の結果、乗員１５が能動重量部ブレーキ６３の解除を許可し、許可がＯＫであると判定された場合、主制御ＥＣＵ２１は、基準位置到達判定を行い、未到達であるか否かを判定する（ステップＳ４−１６）。なお、許可がＯＫでないと判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−１８）、ブレーキ制御処理を終了する。
【０１１２】
基準位置到達判定では、搭乗部１４が既に基準位置に到達しているか否かを判定する。この場合、主制御ＥＣＵ２１は、搭乗部１４が基準位置に到達しているか否かを到達信号受信の有無によって判断し、到達信号を受信した場合には、搭乗部１４が基準位置に到達していると判定する。これにより、搭乗部移動状態の計測値を取得不可能であっても、搭乗部１４を適切な位置で固定できる。
【０１１３】
なお、本実施の形態においては、搭乗部１４を移動させる目標となる位置を点として与えているが、ある程度の範囲として目標位置を与えてもよい。例えば、搭乗部１４の基準位置から所定の距離だけ前後離れた２点に基準位置検出センサ６４をそれぞれ取り付け、一方の基準位置検出センサ６４から到達信号を受信した時点で、搭乗部１４が許容範囲内に存在すると判断して、以降のブレーキ解除を禁止してもよい。
【０１１４】
そして、基準位置到達判定の結果、搭乗部１４が未だに基準位置に到達しておらず、未到達であると判定された場合、主制御ＥＣＵ２１は、能動重量部ブレーキ６３を解除し（ステップＳ４−１７）、ブレーキ制御処理を終了する。なお、到達していると判定された場合には、能動重量部ブレーキ６３を作動し（ステップＳ４−１８）、ブレーキ制御処理を終了する。
【０１１５】
ブレーキ制御処理では、４つの条件がすべて適切である場合に限り、能動重量部ブレーキ６３を解除する。具体的には、主制御ＥＣＵ２１から能動重量部ブレーキ６３に作動電圧を入力する。
【０１１６】
このように、本実施の形態においては、搭乗部１４の移動状態の計測値を用いずに、ブレーキ制御処理を実行する。具体的には、作用力の値と異常発生直前の搭乗部位置の値との積が負である場合、能動重量部ブレーキ６３を解除する。また、所定の解除時間だけ、能動重量部ブレーキ６３の解除を許可する。さらに、搭乗部１４が基準位置に到達したとき能動重量部ブレーキ６３の解除を禁止する。
【０１１７】
これにより、搭乗部１４の推力付加と移動状態取得の両方が不可能であっても、ブレーキ制御処理の実行が可能となり、より安全で安価な倒立型の車両１０を提供することができる。
【０１１８】
なお、本発明は前記実施の形態に限定されるものではなく、本発明の趣旨に基づいて種々変形させることが可能であり、それらを本発明の範囲から排除するものではない。
【産業上の利用可能性】
【０１１９】
本発明は、倒立振り子の姿勢制御を利用した車両に適用することができる。
【符号の説明】
【０１２０】
１０ 車両
１２ 駆動輪
１４ 搭乗部
１５ 乗員
２０ 車両制御装置
３２ 復帰許可スイッチ
６２ 能動重量部モータ
６３ 能動重量部ブレーキ
【特許請求の範囲】
【請求項１】
回転可能に車体に取り付けられた駆動輪と、
前記車体に対して移動可能に取り付けられた能動重量部と、
該能動重量部を車体に対して固定する能動重量部ブレーキと、
前記駆動輪に与える駆動トルク及び前記能動重量部の位置を制御して前記車体の姿勢を制御する車両制御装置とを有し、
該車両制御装置は、前記能動重量部ブレーキを解除した際の能動重量部の移動方向を予測する移動方向予測手段を備え、前記能動重量部が目標位置に近付く方向へ移動することを前記移動方向予測手段が予測した場合に前記能動重量部ブレーキを解除することを特徴とする車両。
【請求項２】
前記移動方向予測手段は、前記能動重量部の移動速度及び前記能動重量部に作用する作用力の推定値によって前記移動方向を予測する請求項１に記載の車両。
【請求項３】
前記移動方向予測手段は、前記作用力が所定時間だけ作用した後の移動速度を推定して前記移動方向を予測する請求項２に記載の車両。
【請求項４】
前記移動方向予測手段は、車体傾斜角及び車両速度によって前記作用力を推定する請求項２又は３に記載の車両。
【請求項５】
前記車両制御装置は、前記能動重量部の移動速度が所定の閾値より高い場合に前記能動重量部ブレーキを作動する請求項１〜４のいずれか１項に記載の車両。
【請求項６】
所定の周期で断続的に発信する周期信号を取得する周期信号取得手段を更に備え、
前記車両制御装置は、前記周期信号取得手段が前記周期信号を取得できないときに前記能動重量部ブレーキの解除を禁止する請求項１〜４のいずれか１項に記載の車両。
【請求項７】
前記車両制御装置は、移動許可手段を備え、乗員が前記移動許可手段を操作して、能動重量部ブレーキの解除を許可した場合に前記能動重量部ブレーキを解除する請求項１〜６のいずれか１項に記載の車両。
【請求項８】
前記車両制御装置は、前記能動重量部を移動させる能動重量部アクチュエータの推力発生が不可能な場合に前記能動重量部ブレーキの制御を実行する請求項１〜７のいずれか１項に記載の車両。
【請求項１】
回転可能に車体に取り付けられた駆動輪と、
前記車体に対して移動可能に取り付けられた能動重量部と、
該能動重量部を車体に対して固定する能動重量部ブレーキと、
前記駆動輪に与える駆動トルク及び前記能動重量部の位置を制御して前記車体の姿勢を制御する車両制御装置とを有し、
該車両制御装置は、前記能動重量部ブレーキを解除した際の能動重量部の移動方向を予測する移動方向予測手段を備え、前記能動重量部が目標位置に近付く方向へ移動することを前記移動方向予測手段が予測した場合に前記能動重量部ブレーキを解除することを特徴とする車両。
【請求項２】
前記移動方向予測手段は、前記能動重量部の移動速度及び前記能動重量部に作用する作用力の推定値によって前記移動方向を予測する請求項１に記載の車両。
【請求項３】
前記移動方向予測手段は、前記作用力が所定時間だけ作用した後の移動速度を推定して前記移動方向を予測する請求項２に記載の車両。
【請求項４】
前記移動方向予測手段は、車体傾斜角及び車両速度によって前記作用力を推定する請求項２又は３に記載の車両。
【請求項５】
前記車両制御装置は、前記能動重量部の移動速度が所定の閾値より高い場合に前記能動重量部ブレーキを作動する請求項１〜４のいずれか１項に記載の車両。
【請求項６】
所定の周期で断続的に発信する周期信号を取得する周期信号取得手段を更に備え、
前記車両制御装置は、前記周期信号取得手段が前記周期信号を取得できないときに前記能動重量部ブレーキの解除を禁止する請求項１〜４のいずれか１項に記載の車両。
【請求項７】
前記車両制御装置は、移動許可手段を備え、乗員が前記移動許可手段を操作して、能動重量部ブレーキの解除を許可した場合に前記能動重量部ブレーキを解除する請求項１〜６のいずれか１項に記載の車両。
【請求項８】
前記車両制御装置は、前記能動重量部を移動させる能動重量部アクチュエータの推力発生が不可能な場合に前記能動重量部ブレーキの制御を実行する請求項１〜７のいずれか１項に記載の車両。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図２】
【図３】
【図４】
【図５】
【図６】
【公開番号】特開２０１０−２３９６７５（Ｐ２０１０−２３９６７５Ａ）
【公開日】平成２２年１０月２１日（２０１０．１０．２１）
【国際特許分類】
【出願番号】特願２００９−８２０２４（Ｐ２００９−８２０２４）
【出願日】平成２１年３月３０日（２００９．３．３０）
【出願人】（５９１２６１５０９）株式会社エクォス・リサーチ (1,360)
【Ｆターム（参考）】
【公開日】平成２２年１０月２１日（２０１０．１０．２１）
【国際特許分類】
【出願日】平成２１年３月３０日（２００９．３．３０）
【出願人】（５９１２６１５０９）株式会社エクォス・リサーチ (1,360)
【Ｆターム（参考）】
[ Back to top ]