JP4886201B2 - 移動ロボット - Google Patents

Description

本発明は、人間と共存する環境で作業を行う移動ロボットに関する。

人間と共存する環境で作業を行うロボットの形態を考えた場合、ロボットの身長は、人間に対する手作業や対話作業を有効に実施するために、人間と同等のサイズであるのが理想的である。さらに、人間が混在する限られた空間で有効に移動を伴う作業を行う場合、ロボットのフットプリントを最小限にするのが望ましい。このような形態要求を実現した場合、ロボットの重心位置は必然的にフットプリントに対し高くなり、立ち姿勢の安定性を低下させる。一方、実用的な作業を実施させる場合、ロボットの機敏で安全な移動能力が求められる。この要求は、上記の重心位置の高度化と相反する。このような要求から、例えば特許文献１及び２に記載されるように、倒立振子制御により前方推進方向の推力を制御する同軸二輪機構の提案がなされている。この機構は、フットプリントの狭い同軸二輪機構を用い、静的には不安定な倒立振子の運動特性をもつ同軸二輪機構を、動的姿勢制御により安定に起立させ、重心の移動により、安定かつ俊敏な加減速機動が可能である。

特開２００３−２７１２４３号公報 特許第２５３０６５２号公報

上記特許文献１及び２に開示されている従来技術は、ロボットの水平面での走行安定性を提供する技術であったが、不測の原因による転倒事象の防止に対する配慮がなされていなかった。さらに、段差の存在する環境での歩行の実現性、歩行の安定性確保に対する配慮がなされていなかった。前者の課題は、倒立振子制御に基づく走行に本質的に付きまとう問題であり、電源の遮断、走行制御系の異常動作により、移動機構のバランス操作力を失い容易に転倒に至る。実適用に向けては、転倒発生要因の検出を契機に転倒を防止する手段の提供が必要である。上記の後者の課題である、走行環境に対する適応性に関しては、駆動輪の直径に対して、十分高さの低い凹凸、段差、緩い傾斜面であれば、倒立振子制御に基づく走行が可能であるが、実適用に向けて想定される路肩段差、階段等の踏破に対しては、非常に大きな直径の駆動輪が必要となり、ロボット自体のフットプリントが拡大し、倒立振子制御を適用するという本来のメリットを失うことになる。
本発明の目的は、走行時の転倒防止が可能で、かつ段差、斜面が存在する走行環境での安定な走行が可能で、フットプリントが狭く人間共生作業に好適な移動ロボットを提供することにある。

上記目的は、倒立振子制御により制御される主駆動輪と、この主駆動輪の前後に配置されて昇降する支持脚と、この支持脚の先端に取付けられた従動の副車輪とを備えた移動ロボットにおいて、前記支持脚の先端と走行面との間の相互距離を計測する床面距離センサと、この床面距離センサから得られた前記相互距離の情報に基づき、前記相互距離を所定の値に維持するように、前記支持脚の先端繰り出し量を制御し前記支持脚の昇降動作を行う支持姿勢制御部と、を備え、移動ロボットの転倒の危険性が判断されると転倒防止制御部を起動させて前記支持脚の昇降動作をロックする機構を備えることにより達成される。

本発明によれば、以下に詳細を記載したように、倒立振子制御により走行する同軸二輪機構の走行に対し、倒立振子制御走行が本質的に内在する走行中の転倒発生の防止が可能であり、転倒防止処理の手段となる機構機能を転用することにより、段差、傾斜面の存在する走行環境での安定な走行が可能な、フットプリントが狭く人間共生作業に好適な移動ロボットを提供することができる。

本発明に係る移動ロボットの実施例を、図面を用いて説明する。本実施例の移動ロボットは、倒立振子制御により前方推進方向の推力を制御する同軸二輪型の移動機構を備えており、さらに、移動機構の推進方向の前後に、先端に副車輪を備え垂直方向に昇降させる支持脚と、その制御手段を備えている。支持脚の先端には、床面との距離を計測するセンサを配しており、倒立二輪走行時には、支持脚の先端と床面の間のギャップを一定に維持するよう制御し、倒立二輪走行の機敏性を維持し、制御手段において制御異常を感知した場合、もしくは電源遮断の発生において、支持脚を転倒回復方向に繰り出すか、副車輪位置を機械的に固定することで、転倒を防止する。さらに、支持脚の先端には、支持脚側面と床面突起物との距離を計測するセンサを配しており、この情報に基づき、段差や急傾斜の存在及び相対位置を検出し、支持脚を進行方向の段差などから退避し、反対方向の支持脚を接地し移動ロボットの重心位置を駆動輪と設置した支持脚の副車輪の間の空間で安定に保持することで、段差の昇降、傾斜の走行を可能とする。

以下、図１から図９を用いて本発明の実施例について説明する。
図１は本実施例の移動ロボットの機構構成を説明する正面図及び側面図である。図２は、本実施例の移動ロボットの制御系の構成図である。図１及び図２において、同じ構成要素に対しては同じ構成番号を記してある。

移動ロボット１は、倒立振子制御により制御される主駆動輪２、３と、主駆動輪２、３の前後に配置された支持脚４、５と、重力方向に対する移動ロボット１の姿勢を検出する姿勢センサ６と、姿勢センサ６等の情報に基づき、移動ロボット１の機構を制御する制御装置７とから構成される。

支持脚４の先端には、従動輪からなる副車輪４ａ、４ｂが設けられ、昇降機構４ｃにより副車輪４ａ、４ｂが昇降する。昇降機構４ｃとしては、例えばボールスプライン機構が適用可能である。もちろん、他の機構手段であっても、副車輪４ａ、４ｂを昇降することが可能であれば、同様の効果を得られることは明白である。昇降機構４ｃの駆動手段には、ＯＦＦブレーキ４ｊ（図２参照）が組み込まれており、電源遮断が発生した場合、昇降位置を機械的に固定する。さらに、支持脚４の先端には、副車輪４ａ、４ｂに加わる接触反力を検出する力センサ４ｄ、支持脚４の先端と走行面とのギャップを計測する床面距離センサ４ｅ、床面上の構造物と支持脚４の間の相対距離を計測する側面距離センサ４ｆ、４ｇが設けられている。

主駆動輪２，３の後部に設置された支持脚５の構成は支持脚４と同様であり、副車輪５ａ、５ｂ、昇降機構５ｃ、力センサ５ｄ、床面距離センサ５ｅ及び側面距離センサ５ｆ、５ｇが設けられている。

次に、図２を用いて、移動ロボット１の制御系の構成について説明する。走行速度制御装置１１は、主駆動輪２、３に組み込まれた走行モータ２ａ、３ａ、エンコーダ２ｂ、３ｂに接続し、倒立走行制御部９から発生される主駆動輪２、３の各々の速度指令値に基づき、走行速度のフィードバック制御を行う。倒立走行制御部９は、走行統括制御部８から発生される主駆動輪２、３の各々の速度差目標値、移動ロボット１の走行速度目標値に従い、倒立二輪走行の制御則に基づき、主駆動輪２、３の各々の速度指令値を生成する。倒立二輪走行の制御則は、例えば以下のようになる。

Vrun=Vr-(V1+V2)/2-K1*θ-K2*ω ………………（１）
V1r=ΔVr/2+Vrun ………………（２）
V2r=ΔVr/2-Vrun ………………（３）
ここで、V1r、V2rは、走行速度制御装置１１に対して出力する主駆動輪２、３の速度指令値。さらに、Vr及びΔVrは、走行統括制御部８から発生される、走行速度目標値及び速度差目標値である。さらに、V1及びV2は、エンコーダ２ｂ、３ｂにより検出される主駆動輪２、３の走行速度である。さらに、θ及びωは姿勢センサ６により検出される、重力方向に対する推進方向の移動ロボット１の姿勢角度およびその角速度である。K1及びK2は、倒立二輪走行制御のためのフィードバックゲイン関数である。

式（１）のK1及びK2を適切に設定することにより、主駆動輪２、３の平均速度が、走行速度目標値に追従するように走行し、同時にθ及びωを０に近づけるように制御が実施される。すなわち、二輪で倒立しながら走行を実施できる。これと同時に、式（２）、（３）で、ΔVrに比例した主駆動輪２、３の速度差が設けられ、ΔVrに応じた旋回走行を実施できる。さらに、後述する支持脚４、５を接地した状態での走行では、K1及びK2を０に切替設定することで、倒立二輪走行制御を解除できる。
昇降機構４ｃ、５ｃに設けられた、昇降モータ４ｉ、５ｉは、昇降位置制御装置１３により制御され、エンコーダ４ｈ、５ｈにより検出された位置をフィードバック制御に用いて、支持脚４、５を所定の高さに位置決めする。また、昇降機構４ｃ、５ｃに設けられた、ブレーキ４ｊ、５ｊは、駆動電源遮断時、もしくは転倒防止制御部１４の指令に基づき、支持脚４、５の位置を機械的に固定する。

支持姿勢制御部１２は、昇降位置制御装置１３に対して、支持脚４、５の昇降制御指令値を生成する。支持姿勢制御部１２は、４つの制御機能を有する。第１の制御機能は、支持脚４ないしは５の先端と走行面や段差などの突起形状面との相互距離を所定の値に維持する追従機能である。この制御機能は、床面距離センサ４ｅ、５ｅから得られる支持脚４ないしは５の先端と走行面や段差などの突起形状面との相互距離の情報に基づき、支持脚４ないしは５の先端繰り出し量の上限を設定することで実現する。さらに、この機能は、力センサ４ｄ、５ｄから得られる、副車輪４ａ、４ｂないしは５ａ、５ｂに加わる接触反力の情報により、床面距離センサ４ｅ、５ｅにより把握し切れなかった路面形状との接触に対し、支持脚４ないしは５の先端繰り出し量の上限を設定することで実現する。第２の制御機能は、重心支持姿勢制御の機能である。これは、移動ロボット１が倒立二輪走行制御を解除した状態で、支持脚４もしくは５を繰り出し、主駆動輪２、３と繰り出した支持脚４もしくは５の先端の３点で設置し、その３点で形成される安定領域内に移動ロボット１の重心投影位置を維持することで、移動ロボット１の姿勢の静的な安定を保つものである。この機能は、接地した支持脚４もしくは５の方向に、移動ロボット1を傾斜させて、姿勢センサ６で検出した姿勢角θを所定の目標値に追従させるように、接地させた支持脚４もしくは５の繰り出し量を制御することで実現できる。第２の制御機能を実行している状態では、支持脚４もしくは５の内の1つのみを接地させ、接地しない方の支持脚４もしくは５は、第１の制御機能により、走行面から先端を浮かせて走行する。第３の制御機能は、全脚接地姿勢制御の機能である。これは、移動ロボット１が倒立二輪走行制御を解除した状態で、支持脚４及び５の先端を着地させて移動ロボット１安定の姿勢を制御する機能である。この機能は、移動ロボット１を休止状態にして安定に起立させる場合に用い、また第２の制御機能を実施している場合、重心の移動を行い支持脚４と５との間で接地を移し変える時の遷移動作として用いる。倒立二輪走行制御の状態では、第１の機能で支持脚４と５の先端と走行面との間に所定のギャップを維持しているが、この機能に移行する場合は、ギャップの目標値を０に近づけ、支持脚４と５の反力から接地を検出した時点で支持脚４と５の繰り出しを停止し、倒立二輪走行制御の解除を行う。この状態で、重心の移動を行う場合は、支持脚４と５の繰り出しと引き込みを連動して位置制御し、主駆動輪２、３が走行面より浮かないようにする。第４の制御機能は、支持脚固定の機能である。これは、支持脚４、５の位置決めを現在位置にホールドして、転倒防止制御部１４を介して、ブレーキ４ｊ、５ｊを有効にして支持脚４及び５を機械的に固定するものである。この機能は、移動ロボット１を休止状態にして安全に起立させておく場合に用いる。この機能を働かせた場合、電源遮断型のブレーキ４ｊ、５ｊにより支持脚４、５の位置を固定するので、支持脚４、５及び主駆動輪２、３の駆動電力を全てカットした省エネ状態で待機させることができる。また、この機能は、転倒防止制御部１４により、移動ロボット１の転倒の危険性が判断されたときに転倒防止制御部１４により起動されて、支持脚４及び５を機械的に固定することで、移動ロボット１を支え転倒を防止する。

走行統括制御部８は、倒立走行制御部９、支持姿勢制御部１２に対し指令を与え、走行運動全体の制御を司る。走行統括制御部８は、側面距離センサ４ｆ、４ｇ、５ｆ、５ｇ、床面距離センサ４e、５ｅ、力センサ４ｄ、５ｄにより検出され、支持脚４、５と走行環境との相互位置情報に基づき、倒立二輪走行と、支持脚４、５による接地支持を用いた対環境走行制御を実施する。倒立二輪走行を実施する判断は、平面検出処理部１０の処理結果による。図３は、平面検出処理部１０において実施される、等価走行面の傾斜を算出するための計算モデルである。図３において、主駆動輪２，３の中心の座標を（０，０）とした場合、主駆動輪２，３と走行面１８の接点Ｐ１の座標は、(Rsinφ,-Rcosφ)、また、副車輪４ａと走行面１８の接点Ｐ２の座標は、(-Bcosθ+hsinθ+rsinφ,-Bsinθ+hcosθ-rcosφ)となる。この関係から、走行面１８の傾斜角φは、次のように算出される。
φ＝tan^-1(((R-r)sinφ+Bcosθ-hsinθ)／((r-R)cosφ+Bsinθ-hcosθ))…（４）
ここで、Ｒは主駆動輪２，３の半径、ｒは副車輪４ａの半径、θは移動ロボット１の傾斜角度、ｈは主駆動輪２，３の中心を基準とした接地状態の支持脚４の副車輪４ａの中心の繰り出し距離、Ｂは主駆動輪２，３の中心と副車輪４ａの中心との間の水平方向の軸間距離である。ｈは、床面距離センサ４eにより検出される。平面検出処理部１０により推定された走行面１８の傾斜角φが所定の値以下の場合、走行統括制御部８は、倒立走行制御部９に対し、倒立二輪走行の実施を指示で、支持姿勢制御部１２に対し、第１の制御機能の実施を指示する。側面距離センサ４ｆ、４ｇ、５ｆ、５ｇにより、走行面１８上に突起物を発見した場合、倒立走行制御部９に対し、まず第３の機能の実施を指示し、倒立二輪走行の解除を実施し、後述する走行環境に応じた走行シーケンスを発生する。システム異常監視部１５は、制御装置７を構成する制御ハードの健全性を判断し、姿勢センサ６で検出される移動ロボット１の姿勢角θが許容限界値を越えたか否かを判断し、更に、電源部１７の出力が正常化否かを判断する。これらの判断を総合し、移動ロボット１の転倒が予測された場合は、転倒防止制御部１４に非常停止指令を与え、転倒防止制御部１４は、走行速度制御装置１１、非常停止指示を与える。さらに、転倒防止制御部１４は、非常停止の要求が、姿勢角θの限界越えに起因する場合は、支持姿勢制御部１２に対し、第３の制御機能の実施を指示し、転倒方向にある支持脚４もしくは５を繰り出して、転倒に向けて過度に傾斜した姿勢を回復させる運動を発生する。それ以外の要因による非常停止の要求は、制御システムの問題が生じたとして、支持脚４及び５の繰り出し位置を現在値に維持し、さらに、ブレーキ４ｊ、５ｊの電源を遮断し、支持脚４、５の位置を機械的に固定し、転倒防止を実施する。非常電源部１６は、電源部１７より供給される電力を一時保存しており、電源部１７の異常により制御装置７全体がダウンした場合、転倒防止制御部１４に対、電力を供給し、非常停止処理を完遂させる。

次に、図４〜図９を用いて、本実施例の動作について説明する。
図４は、ｂ）に示す移動ロボット１による倒立二輪走行に対する走行状態の変更の状況を示している。移動ロボット１が停止して休止状態の場合は、ａ）に示すように、第３及び第４の制御機能を実施し、支持脚４、５を走行面１８に接地し機械的に固定状態として、静的に安全な起立姿勢で停止している。ｃ）はｂ）に示す、姿勢傾斜を伴う倒立二輪走行途中で、姿勢角度が限界値を越えた場合の処理として、支持脚４を繰り出して、進行方向への転倒を防止する様子を示す。ｄ）はｂ）に示す倒立二輪走行途中に電源部１７のトラブルで電源が遮断された場合、ブレーキ４ｊ、５ｊにより支持脚４、５の電源遮断時の位置を保ち転倒を防止する状況を示す。

図５、６は、移動ロボット１による段差２０の昇段及び降段の動作シーケンスを示したものである。昇段シーケンスは、図５に示すように、ａ）倒立二輪走行状態で段差２０に接近し、側面距離センサ４ｆにより進行方向の段差２０を検出する。そこで、ｂ）に示すように、支持脚４を上昇し、支持脚４と段差２０の接触を回避し、床面距離センサ４ｅにより、段差２０の端面の通過を検出する。ここで、ｃ）に示すように、倒立二輪走行状態を解除し、第２の制御機能により支持脚５を接地して、静的安定を保つ。この状態で前進して、ｄ）に示すように主駆動輪２、３の駆動トルクにより段差２０に乗り上げる。次に、ｅ）に示すように、側面距離センサ５ｆにより段差２０の端面検出した時点で、主駆動輪２、３が段差２０の上面に位置すると判断し、ｆ）に示すように、第２の制御機能により支持脚５の駆動を用いて移動ロボット１の姿勢を起立させ、第３の制御機能を介して、支持脚４、５による姿勢安定化を図った後に、ｇ）に示すように倒立二輪走行に移行する。降段のシーケンスは、図６に示すように、まず段差２０上で倒立二輪走行で走行し、ａ）に示すように床面距離センサ４ｅで、段差２０の終端を検出し、副車輪４ａが降下できる程度に進行した時点で、ｂ）に示すように支持脚４を走行面１８に着地させる。この一連の動作は、第１の制御機能及び第３の制御機能により実現される。この後、ｃ）からｄ）に示すように第２の制御機能により、支持脚４で移動ロボット１の重心１９を安定に支持して、段差２０を降段する。その後、ｅ）に示すように、走行面１８の平面検出が成立した時点で、第２の制御機能による重心支持走行から倒立二輪走行へ走行形態を変更する。図７はより奥行き幅の短い段差２１の走行に対する昇段及び降段のシーケンスを示したものである。この例は、段差２１の幅が、概略図３に示す寸法Ｂ以下になり、主駆動輪２，３が段差２１に乗り上げた時点で、床面距離センサ４ｅによる段差２１の端部の検出が既に終了しており、狭幅段差上での倒立二輪走行のリスクを避けたいケースである。図７ａ）では、図５ｄ）までと同様のプロセスで段差２１に乗り上げ、ｂ)では、床面距離センサ４ｅにより走行面１８を検出し、側面距離センサ５ｆで段差２１の端面を検出することを契機に、支持脚５による重心支持走行から、第３の制御機能を適用し、ｃ）に示すように支持脚４、５の両者を着地させて、重心１９を後方から前方に移動する。その後ｄ）ｅ）に示すように、支持脚５を第１の制御機能を適用し、走行面１８より離脱させ、支持脚４による重心支持走行に切替て段差２１を通過する。次に、図８及び図９を用いて、傾斜面の走行手順について説明する。図８、９は、移動ロボット１による斜面２２の登り及び下り走行の動作シーケンスを示したものである。登り走行シーケンスは、図８に示すように、ａ）倒立二輪走行状態で段差２０に接近し、床面距離センサ４ｅの情報に基づく走行面の漸近的な接近の検出と側面距離センサ４ｆの斜面２２の漸近的な接近の検出により進行方向の斜面２２を検出する。そこで、ｂ）に示すように、倒立二輪走行状態を解除し、第２の制御機能により支持脚５を接地して、静的安定を保つ。この状態で前進して、ｃ）ｄ）に示すように斜面２２を登りつめて平面が検出された時点で、倒立二輪走行状態に切り替える。下り走行シーケンスは、図９に示すように、まず斜面２２の端まで倒立二輪走行で走行し、ａ）に示すように床面距離センサ４ｅで、斜面２２の開始位置を検出し、ｂ）に示すように支持脚５を斜面２２に着地させる。この一連の動作は、第１の制御機能及び第３の制御機能により実現される。この後、ｃ）に示すように第２の制御機能により、支持脚５で移動ロボット１の重心１９を安定に支持して、斜面２２を下りる。その後、ｄ）ｅ）に示すように、斜面２２の終端の平面検出が成立した時点で、第２の制御機能による重心支持走行から倒立二輪走行へ走行形態を変更する。

以上説明した本実施例によれば、倒立二輪走行時に、主駆動輪の前後に配置された支持脚の先端を走行面の起伏に沿ってわずかなギャップを残して追従昇降させることが出来るので、移動ロボットの転倒が発生しそうになった場合、支持脚の昇降動作をロックすることで、転倒を未然に防ぐことが出来る。また、支持脚先端に設けたセンサにより、段差、斜面を検出し、支持脚と主駆動輪の接地による静的に安定な走行形態に移行することで、段差や斜面を踏破するための安定な走行シーケンスを実行できる。

次に、図１０及び図１１を用いて本発明の他の実施例について説明する。
図１０は本実施例の移動ロボットの機構構成を説明する正面図及び側面図である。移動ロボット２３は、倒立振子制御により制御される主駆動輪２４、２５と、主駆動輪２４、２５の前後に配置された支持脚２６，２７，２８，２９（但し２９は図示されていない）と、重力方向に対する移動ロボット１の姿勢を検出する姿勢センサ３０と、姿勢センサ３０等の情報に基づき、移動ロボット１の機構を制御する制御装置３１とから構成される。

支持脚２６の先端には、モータ２６ｂにより走行駆動される副車輪２６ａが設けられ、副車輪２６ａは昇降旋回機構２６ｃにより昇降し、更に昇降方向軸周りに旋回する。昇降旋回機構２６ｃとしては、例えばボールスプライン機構が適用可能である。もちろん、他の機構手段であっても、副車輪２６ａを昇降かつ旋回することが可能であれば、同様の効果を得られることは明白である。昇降旋回機構２６ｃの駆動手段には、図示されていないがＯＦＦブレーキが組み込まれており、電源遮断が発生した場合、昇降位置を機械的に固定する。さらに、支持脚２６の先端には、副車輪２６ａに加わる接触反力を検出する力センサ２６ｄ、支持脚２６の先端と走行面とのギャップを計測する床面距離センサ２６ｅ、床面上の構造物と支持脚２６の間の相対距離を計測する側面距離センサ２６ｆ、２６ｇが設けられている。主駆動輪２４，２５の前部に設置された支持脚２７及び後部に設置された支持脚２８，２９（２９は図示されていない）の構成は支持脚２６と同様であり、各々に副車輪２７ａ、２８ａ、２９ａ、モータ２７ｂ、２８ｂ、２９ｂ、昇降旋回機構２７ｃ、２８ｃ、２９ｃ、力センサ２７ｄ、２８ｄ、２９ｄ、床面距離センサ２７ｅ、２８ｅ、２９ｅ、側面距離センサ２７ｆ、２７ｇ、２８ｆ、２８ｇ、２９ｆ、２９ｇが設けられている。制御装置３１は、副車輪２６ａ，２７ａ，２８ａ及び２９ａの駆動制御及び昇降旋回機構２６ｃ，２７ｃ，２８ｃ及び２９ｃの旋回駆動制御の機能を備え、基本的に第１の実施例で述べた第１から４の制御機能を備えている。従って、第１の実施例で説明した、移動ロボット１による、転倒防止制御、段差踏破、斜面走行制御は、基本的に、本実施例の構成でも実施可能である。

次に本実施例により新たに可能となる階段走行の動作を説明する。図１１は、移動ロボット２３による階段３３の移動の過程を示したものである。この過程において、階段３３の各段の奥行きは、副車輪２６ａ，２７ａの前端部から主駆動輪２４，２５の中心までの間隔以上の寸法を有することを条件とする。まず、ａ）において、倒立二輪走行で、階段３３に接近し、支持及脚２６び２７の側面距離センサ２６ｆ及び２７ｆにより階段３３に対し所定の距離近づいた事を検出したら停止し、ｂ）に示すように支持脚２６及び２７を上限まで上昇させる。次に、前進し、支持脚２６及び２７の床面距離センサ２６ｅ及び２７ｅにより階段３３の段上に支持脚２６び２７が到達したことを検出した時点で、ｃ）に示すように支持脚２６、２７、２８及び２９を降下し接地させる。支持脚２６、２７、２８及び２９が接地した後、主駆動輪２４，２５の倒立二輪走行制御を解除し停止状態とする。次に、ｄ）に示すように、支持脚２６、２７、２８及び２９の昇降旋回機構２６ｃ、２７ｃ、２８ｃ及び２９ｃの駆動により、主駆動輪２４，２５の下端部が階段３３の段よりも上に位置するまで、移動ロボット２３本体を持ち上げる。次に、この状態で支持脚２６、２７、２８及び２９の副車輪２６ａ、２７ａ、２８ａ及び２９ａの駆動により移動ロボット２３を前進させ、ｅ）に示すように、支持脚２６、２７の側面距離センサ２６ｆもしくは２７ｆ、もしくは支持脚２８、２９の側面距離センサ２６ｇもしくは２７ｇにより、階段３３の段への所定の接近が確認された時点で停止する。この動作が終了した時点で、主駆動輪２４，２５の倒立二輪走行制御を復帰させて、ｆ）に示すように、支持脚２６、２７、２８及び２９を上昇させて、倒立二輪走行制御により主駆動輪２４，２５のみで、階段３３上に起立させる。以上述べたａ）からｆ）の動作を反復することにより、階段３３の昇段を実施する。階段３３の降段は、基本的にｆ）からａ）へと逆動作過程を実施することで実現する。但し、各段での支持脚２６、２７、２８及び２９の昇降制御のタイミングは、床面距離センサ２６ｅ、２７ｅ、２８ｅ及び２９ｅによる段差通過の検出に基づき制御される。本実施例では、第１の実施例で説明した段差踏破の他に、図１１に示す階段３３を１段の階段とみなして、同一の制御過程で実施することが可能である。第１の実施例で説明した段差踏破方法は、主駆動輪２，３のグリップ力で段差を乗り越えるために、踏破可能な段差の高さは、原理的に主駆動輪２，３の半径以下に制限され、実際的には、主駆動輪２，３の半径の３０％程度の高さの党派が限界と考えられる。これに対して、本実施例の上記した段差踏破方式では、踏破可能な段差の高さは、主駆動輪２４，２５の直径に左右されず、昇降旋回機構２６ｃ、２７ｃ、２８ｃ、２９ｃの昇降ストロークにより支配されるため、第１の実施例に比べより高い段差の踏破が可能となる。図１１の走行動作では詳細を省いて説明したが、本実施例では、副車輪２６ａ、２７ａ、２８ａ及び２９ａは、昇降旋回機構２６ｃ、２７ｃ、２８ｃ及び２９ｃにより、独自に旋回させることが可能であり、全方向移動の機能を備えている。この機能を用いて、階段３３に対し移動ロボット２３を正対させたり、段差に対し横移動することが可能である。もちろん、この機能により平地走行においても、任意方向の移動が可能となる。

以上述べた本実施例によれば、第１の実施例で述べた、転倒防止制御、段差、傾斜面の踏破制御が可能なことに加え、階段走行が可能であり、主駆動輪の直径に依存しない高さの高い段差の踏破が可能となる。また、副駆動輪による全方向移動が可能であり、平地面での狭隘な環境での移動が容易であり、階段上での移動位置・方向の微調整が容易に実行できる。

次に、図１２から図１５を用いて本発明の他の実施例について説明する。
図１２は本実施例の移動ロボットの機構構成を説明する正面図及び側面図である。移動ロボット３４は、倒立振子制御により制御される主駆動輪３５、３６と、主駆動輪３５、３６で挟む形で配置された支持脚３７及び多自由度の腕４３及び４４を備える。支持脚３７は、先端に倒立振子制御により制御される副車輪４１、４２、副車輪４１、４２を旋回させる旋回機構４０、支持脚３７を前後に揺動位置決めする支持脚旋回機構３８、支持脚３７の先端を繰り出し引き込み動作させる伸縮機構３９を備える。

本構成における移動ロボット３４の、転倒防止動作を図１３を用いて説明する。図１３ａ）は、主駆動輪３５、３６による倒立二輪走行での停止姿勢、ｂ）は走行姿勢を示す。ｃ）は転倒防止運動の状況を示しており、移動ロボット３４は転倒の予兆を検出した場合、支持脚３７を進行方向に振り出し副車輪４１、４２の接地により姿勢を保持し転倒を防止する。次に、図１４を用いて、階段移動の手順を説明する。ａ）において、主駆動輪３５、３６による倒立二輪走行で階段４７の段上に起立する。次にｂ）に示すように、支持脚３７を伸展させて、副車輪４１、４２を接地させ、副車輪４１、４２の倒立二輪走行制御により移動ロボット３４起立させ、さらに支持脚３７を伸展させて主駆動輪３５、３６を持ち上げる。次にｃ）に示すように、支持脚旋回機構３８の駆動により移動ロボット３４本体を傾斜させて、主駆動輪３５、３６を次の段上に移動する。この間、移動ロボット３４の姿勢は、副車輪４１、４２の倒立二輪走行制御により転倒しないように安定に維持されている。次にｄ）に示すように、主駆動輪３５、３６を接地させる。ここで、主駆動輪３５、３６及び副車輪４１、４２の倒立二輪走行制御を解除し、ｅ）に示すように、支持脚３７を伸展させ、重心４５が主駆動輪３５、３６の中心上にくるまでを前方に移動し、これが終了した後、ｆ）に示すように主駆動輪３５、３６の倒立二輪走行制御を起動し、これにより移動ロボット３４全体を起立させ、支持脚３７を引き込み、ｇ）の初期状態に戻る。これら、ａ）からｇ）の過程を反復することにより、階段４７を踏破することが出来る。階段４７の降段動作は、上記の昇段動作の逆過程を実施すれば良い。第１、２の実施例で示した段差の踏破は、上記の段差を１段の階段とみなして実現できる。斜面走行に関しては、図１４ｅ）に示す主駆動輪３５、３６及び副車輪４１、４２の倒立二輪走行制御を解除し同時に接地させる走行形態をとれば、安定な走行が可能である。本実施例では、新たに、転倒状態からの起立回復が実現できる。その過程を、図１５を用いて説明する。ａ)に示すように、転倒防止制御がうまく働かず移動ロボット３４が横倒しになった場合、腕４３及び４４の操作により、移動ロボット３４をうつ伏せ状態にする。次にｂ）に示すように腕４３及び４４の操作により移動ロボット３４の上体を持ち上げる。ｃ）のように上体を最大限に持ち上げたところで、支持脚３７を繰り出し、次にｄ)ｅ）に示すように、支持脚３７の伸展推力で、移動ロボット３４を起立させる。この後主駆動輪３５、３６の倒立振子制御を再開し支持脚３７を引き込む。この実施例においても、支持脚３７の先端に旋回機構４０を設けており、主駆動輪３５、３６と副車輪４１、４２の接地の入れ替えを行う、図１４のａ）からｂ）の間で、副車輪４１、４２を接地させる前に副車輪４１、４２の方向を旋回させることで、第２の実施例で示した、段上での位置・方向修正を実施できる。この走行動作は、平地面でも実施可能であり、第２の実施例で言及したのと同様に全方向移動が可能である。

以上説明した本実施例によれば、第１、第２の実施例で実施した全ての走行が可能で、更に、転倒状態からの自立復帰が可能となる。

本発明の移動ロボットの実施例の機構の構成図。 本発明の移動ロボットの実施例の制御系の構成図。 本発明の移動ロボットの実施例の平面検出演算の説明図。 本発明の移動ロボットの実施例の転倒防止動作の説明図。 本発明の移動ロボットの実施例の段差走行動作の説明図。 本発明の移動ロボットの実施例の段差走行動作の説明図。 本発明の移動ロボットの実施例の段差走行動作の説明図。 本発明の移動ロボットの実施例の傾斜面走行動作の説明図。 本発明の移動ロボットの実施例の傾斜面走行動作の説明図。 本発明の移動ロボットの他の実施例の機構の構成図。 本発明の移動ロボットの他の実施例の階段走行動作の説明図。 本発明の移動ロボットの他の実施例の機構の構成図。 本発明の移動ロボットの他の実施例の転倒防止動作の説明図。 本発明の移動ロボットの他の実施例の階段走行動作の説明図。 本発明の移動ロボットの他の実施例の転倒復帰動作の説明図。

符号の説明

２３、３４…移動ロボット、２、３、２４、２５、３５、３６…主駆動輪、
４、５、２６、２７、２８、２９、３７…支持脚、６、３０…姿勢センサ、
７、３１…制御装置、４３、４４…腕。

Claims (4)

1. 倒立振子制御により制御される主駆動輪と、この主駆動輪の前後に配置されて昇降する支持脚と、この支持脚の先端に取付けられた従動の副車輪とを備えた移動ロボットにおいて、
   前記支持脚の先端と走行面との間の相互距離を計測する床面距離センサと、この床面距離センサから得られた前記相互距離の情報に基づき、前記相互距離を所定の値に維持するように、前記支持脚の先端繰り出し量を制御し前記支持脚の昇降動作を行う支持姿勢制御部と、を備え、
   移動ロボットの転倒の危険性が判断されると転倒防止制御部を起動させて前記支持脚の昇降動作をロックする機構を備えることを特徴とする移動ロボット。
2. 請求項１記載の移動ロボットにおいて、
   前記移動ロボットはシステム異常監視部を有してなり、
   前記主駆動輪を前記倒立振子制御に基づき駆動している状態で制御系に異常が生じた場合、または電源が遮断された場合に、
   前記システム異常監視部の指示に基づき前記支持脚の昇降動作をロックすることを特徴とする移動ロボット。
3. 請求項１記載の移動ロボットにおいて、
   前記移動ロボットはシステム異常監視部を有してなり、
   前記主駆動輪を前記倒立振子制御に基づき駆動している状態で移動ロボットの姿勢が許容値以上に傾斜した場合に、
   前記移動ロボットは前記システム異常監視部の指示に基づき転倒方向の支持脚を繰り出して転倒した姿勢を回復させる制御手段を備えていることを特徴とする移動ロボット。
4. 請求項１記載の移動ロボットにおいて、
   接地した前記支持脚の繰り出し量から推定される移動ロボット本体を基準とした相対的な走行面の傾斜角と、鉛直方向に対する移動ロボット本体の傾斜角とから、鉛直方向を基準とした走行面の傾斜角を推定し、走行面の傾斜角が所定の値より小さい場合、走行面が水平面と判定し、前記主駆動輪の前記倒立振子制御を起動することを特徴とする移動ロボット。

Images