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