説明

人間型ロボットの制御装置

【課題】 物体を押しながら安定して歩容することができる人間型ロボットの制御装置を提供する。
【解決手段】 床に置かれた対象物を継続的に押す人間型ロボットの制御装置において、両脚が地面に着いた両脚支持期に対象物を押し、片脚のみが地面についた片脚支持期では対象物を押さない制御を行う制御手段を備える。また、床に置かれた対象物を継続的に押す人間型ロボットの制御装置において、両足が地面に着いた両脚支持期に手先反力を制御することにより対象物を押し、片足のみが地面に着いた片脚支持期では対象物を押すことなく、先に対象物を押した量だけステップする制御を行う。

【発明の詳細な説明】
【技術分野】
【0001】
本発明は、手先で物体を押しながら安定した歩容を行うことができるようにした人間型ロボットの制御装置に関する。
【背景技術】
【0002】
近年は2足歩行を行い、手先を備えた腕によって各種作業を行うことができるようにした人間型ロボットの開発が広く進められている。人間型ロボットが実環境において実際に作業できるためには、マニピュレーション機能が欠かせないが、人間型ロボットによるマニピュレーションの研究は必ずしも充分には研究されていないのが実状である。
【0003】
人間型ロボットによる対象物のマニピュレーションの一形態として、例えば図1に示すように、床に置かれた大きな対象物を押す操作に着目すると、このときにはアームの制御方法の違いに応じて、位置制御をベースにした押し操作と、力制御をベースにした押し操作が考えられる。
【0004】
手先反力の情報を用いない位置制御をベースにした押し操作の場合は、その制御装置は容易に実装することができ、且つ対象物が軽く手先に加わる反力が小さい場合には、安定して押し操作を行うことができる。その反面、対象物が重くなると、ロボットの歩行速度が対象物の移動速度を上回ることで、ロボットが最終的に転倒する。
【0005】
それに対して、手先反力の情報を用いた力制御ベースの押し操作では、手先反力の情報を元に適応的に歩容を変化させることによって、様々な重量の対象物に対して安定に押し操作できることが期待される。
【0006】
一方、上記のような人間型ロボットによって安定した作業を行うために、例えば特開平10−230485号公報で示されているように、目標手先力と実際の手先力が異なっている場合に、目標床反力中心点(目標ZMP)まわりのモーメント偏差を算出し、それを補償するように胴体の位置を変更する手法が提案されている(図7)。
【0007】
また、日本ロボット学会誌18 巻1号75〜86頁に示されているように、手先に加わった外力に応じて脚式移動ロボットが一歩を踏み出すタイミングを決定する手法も提案されている。
【特許文献1】特開平10−230485号公報
【非特許文献1】日本ロボット学会誌18 巻1号75〜86 頁
【発明の開示】
【発明が解決しようとする課題】
【0008】
例えば、上記のような人間型ロボットの手先が、前記のように床に置かれた対象物と接した状態で、この対象物を押す作業を考える。このとき、対象物の重量や対象物と床面との摩擦係数は未知であると仮定する。この状態でロボットが大きな力を加えつつ、対象物を床面上で継続的に動かしながら、転倒せずに動的な平衡状態を保つためには、ロボットの歩行パラメータが適切に設定されなくてはならない。
【0009】
しかしながら、従来から提案されている各種手法では、どのように歩行パラメータを決定すれば、安定な歩行動作が実現されるかについては、何ら指針が与えられていなかった。したがって本発明は、2足歩行の人間型ロボットにおいて物体を押しながら安定して歩容することができる人間型ロボットの制御装置を提供することを目的とする。
【課題を解決するための手段】
【0010】
人間型ロボットが床に置かれた対象物を継続的に押す場合、両脚が地面に着いた状態(両脚支持期)に対象物を押し、片脚のみが地面についた状態(片脚支持期)では対象物を押さない方が、ロボットが安定を保ちやすいと考えられる。また、両脚支持期に手先反力を制御することにより対象物を押し、片脚支持期では対象物を押した量だけステップすることにより、継続的な押し操作が実現される。
【0011】
上記のような考え方に基づき本発明による人間型ロボットの制御装置においては、床に置かれた対象物を継続的に押す人間型ロボットの制御装置において、両脚が地面に着いた両脚支持期に対象物を押し、片脚のみが地面についた片脚支持期では対象物を押さない制御を行う制御手段を備えたことを特徴とする。
【0012】
また、上記人間型ロボットの制御装置は、より具体的には、両足が地面に着いていることを検出する両足接地状態検出手段と、床に置かれた対象物を押す操作を行う対象物押圧手段とを備え、前記両足接地状態検出手段により両足が地面に着いていることを検出したとき、前記対象物押圧手段で対象物を押し、前記両足接地状態検出手段でいずれかの足が地面に着いていないことを検出したとき、前記対象物押圧手段で対象物を押さないように制御する制御手段を備えることにより実現することができる。
【0013】
また、本発明による他の人間型ロボットの制御装置は、床に置かれた対象物を継続的に押す人間型ロボットの制御装置において、両足が地面に着いた両脚支持期に手先反力を制御することにより対象物を押し、片足のみが地面に着いた片脚支持期では対象物を押した量だけステップする制御を行う制御手段を備えたことを特徴とする。
【0014】
また、上記人間型ロボットの制御装置は、より具体的には、両足が地面に着いていることを検出する両足接地状態検出手段と、床に置かれた対象物を押すための手先反力を制御する手先反力制御手段と、前記対象物を押した距離を検出する対象物移動量検出手段と、片足をステップするステップ制御手段とを備え、前記両足接地状態検出手段により両足が地面に着いていることを検出したときにのみ、前記手先反力制御手段により対象物を押し、前記両足接地状態検出手段でいずれかの足が接地していないことを検出したとき、前記対象物移動量検出手段で検出した先の対象物移動量の分だけ、前記ステップ制御手段により接地していない片足をステップすること制御手段を備えることにより実現することができる。
【発明の効果】
【0015】
本発明は上記のように構成することにより、人間型ロボットが実環境で作業を行う場合、手先で対象物に力を加えながら安定して歩行を継続することができる。また、人間型ロボットが実環境で作業を行う場合、対象物の物理パラメータが未知の場合でも安定して作業を継続することができる。
【発明を実施するための最良の形態】
【0016】
本発明は、人間型ロボットが実環境で作業を行う場合、手先で対象物に力を加える状態でロボットが安定して歩行を継続し、また、対象物の物理パラメータが未知の場合でも安定して作業を継続することを、床に置かれた対象物を継続的に押す人間型ロボットの制御装置において、両脚が地面に着いた両脚支持期に対象物を押し、片脚のみが地面についた片脚支持期では対象物を押さない制御を行う制御手段を備え、また、床に置かれた対象物を継続的に押す人間型ロボットの制御装置において、両足が地面に着いた両脚支持期に手先反力を制御することにより対象物を押し、片足のみが地面に着いた片脚支持期では対象物を押した量だけステップする制御を行う制御手段を備えることにより実現する。
【実施例1】
【0017】
床反力中心点は一般にZMP(Zero Moment Point)と呼ばれるが、足裏と床面との接触に存在するZMPに着目すると、手先に加わる反力に応じてこのZMPも変位する。ZMPが足裏支持領域内に含まれていればロボットは動的平衡を維持することが可能であるが、マニピュレーションにおいては予期せぬ手先反力によりZMPが変位し、足裏支持領域の端にくることで、ロボットが転倒する危険性が存在する。
【0018】
そこで、歩行動作中における両脚支持期に足裏支持領域の凸包が広くなる特徴を利用して、両脚支持期に対象物を押しすプッシングフェーズ(Pushing Phase)と、対象物を押さずにステップするステッピングフェーズ(Stepping Phase)とに分けたマニピュレーションの形態を検討する。
【0019】
図3には本発明による実施例のタイムチャートを示す。プッシングフェーズ では、手先に加わる力を制御することで対象物の押し操作を実現する。さらにプッシングフェーズの後半では手先を位置制御することで、手先の絶対座標系から見た速度を0に戻す。ステッピングフェーズ では対象物の操作を停止させる。
【0020】
ステッピングフェーズ では、ロボットがステップする距離はプッシングフェーズ において対象物を押した距離と等しくする。さらに、対象物を押した距離を用いてZMPの軌道を計算し直し、現在のZMP軌道に接続する。また、ZMP軌道より胴体重心の軌道が導出される。
【0021】
図4にはプッシングフェーズ におけるアームの制御手法の概要を示す。ここで、μを対象物と床面との摩擦係数、mを対象物の質量とする。プッシングフェーズ においては、対象物から受ける反力をインピーダンス制御により制御する。ロボット進行方向に対する目標インピーダンスは次のような形で与えられる。
【0022】
【数1】

ここで、mは目標質量、cは目標粘性を表し、fxdはfの目標値を表す。fxd<μmgのとき、fがfxdとバランスすることにより対象物は動かない。それに対してfxd>μmgのとき対象物が動き、対象物の加速度はfxdとfの差に依存する。目標インピーダンスが実現されているという条件の下で、軽い対象物を押し操作すると対象物は大きな加速度で動き、対象物が重くなるに従って対象物の加速度も小さくなる。そして、対象物の質量が極めて大きくなると、対象物は動かなくなる。つまり、この手法を用いることで、ロボットは対象物の質量や対象物と床面との摩擦係数を考慮することなしに適応的に押し操作できる。
【0023】
次に、対象物の押し操作に関する情報をもとに実時間で歩容を計画する方法について検討する。図5に示すように、目標ZMP軌道が以下のような区分多項式で与えられていると仮定する。
【数2】

ここで、
【数3】







は第j区間のZMP軌道を表す。ロボットを高さが変化しない倒立振り子で近似することにより、ロボット重心の軌道は次のように導出することができる。
【0024】
【数4】

【数5】

【数6】

ここで、
【数7】






は未知定数であり、以下においてロボット重心の軌道を境界条件を満足しつつ滑らかに接続するように決定される。
【0025】
実時間での歩容の変更を実現するため、新たに計算されたロボット重心の軌道を現在の重心の軌道に接続させることを検討する。図5に示すように、片脚支持期の終わりで歩幅がプッシングフェーズ における押し量と等しくなるようなZMP軌道を計算する。このZMP軌道をもとに、ロボット重心の軌道を計算し、現在の重心軌道に滑らかに接続する。
【0026】
ここで、重心の軌道には斉次解にsinh やcosh が含まれる。つまり、解が時間の経過と共に発散するのを防ぐため、係数
【数8】

を2点境界値問題を解くことにより検定する。
【0027】
ここで注意すべきことは、2点境界値問題では、初期位置と終端位置が与えられるが、条件式の数が未知数の数を超えるため初期速度を境界条件に含めることが不可能な点である。
【0028】
つまり、現在あるロボット重心軌道に新たに計算された重心軌道を接続する場合、速度の不連続性が生じることになる。ZMP軌道とロボット重心の位置・速度の全てを連続にするため、第一区間の目標ZMPの関数形状も未知とし、境界条件を満足するように関数形状を決定する。
【0029】
本手法を用いた人間型ロボットの制御装置における制御ブロック構成とそれらの関連及び作動フローを図6に示す。まず、インピーダンス制御手法により手先位置を計算する。プッシングフェーズ が終わると、歩容計画を行い、ロボット重心と足先の位置を計算する。そして、それらの情報より、各関節の目標位置を導出する。この目標関節位置指令をロボットに与える。ここで、パラメータ誤差や外乱の影響により、ZMPの位置に誤差が生じる可能性があるため、ZMP位置と同時に胴体の姿勢を制御する安定化制御系を導入する。
【0030】
このような制御装置を用いた実験、及びシミュレーション結果によると、ロボットは対象物の質量が変化しているにもかかわらず動的平衡を維持し、安定的に対象物を押すことが確認された。
【図面の簡単な説明】
【0031】
【図1】床に置かれた対象物を押す作業の例を示す図である。
【図2】手先のインピーダンス制御の説明図である。
【図3】本発明の実施例のタイムチャートである。
【図4】ZMP軌道を示す図である。
【図5】軌道の接続による実時間歩容計画を示す図である。
【図6】提案する手法をロボットに適用する場合のブロック線図
【図7】従来のモーメント偏差に基づいて胴体の位置を変更する手法を示す図である。

【特許請求の範囲】
【請求項1】
床に置かれた対象物を継続的に押す人間型ロボットの制御装置において、両脚が地面に着いた両脚支持期に対象物を押し、片脚のみが地面についた片脚支持期では対象物を押さない制御を行う制御手段を備えたことを特徴とする人間型ロボットの制御装置。
【請求項2】
両足が地面に着いていることを検出する両足接地状態検出手段と、床に置かれた対象物を押す操作を行う対象物押圧手段とを備え、
前記両足接地状態検出手段により両足が地面に着いていることを検出したとき、前記対象物押圧手段で対象物を押し、前記両足接地状態検出手段でいずれかの足が地面に着いていないことを検出したとき、前記対象物押圧手段で対象物を押さないように制御する制御手段を備えたことを特徴とする人間型ロボットの制御装置。
【請求項3】
床に置かれた対象物を継続的に押す人間型ロボットの制御装置において、両足が地面に着いた両脚支持期に手先反力を制御することにより対象物を押し、片足のみが地面に着いた片脚支持期では対象物を押した量だけステップする制御を行う制御手段を備えたことを特徴とする人間型ロボットの制御装置。
【請求項4】
両足が地面に着いていることを検出する両足接地状態検出手段と、床に置かれた対象物を押すための手先反力を制御する手先反力制御手段と、前記対象物を押した距離を検出する対象物移動量検出手段と、片足をステップするステップ制御手段とを備え、
前記両足接地状態検出手段により両足が地面に着いていることを検出したときにのみ、前記手先反力制御手段により対象物を押し、前記両足接地状態検出手段でいずれかの足が接地していないことを検出したとき、前記対象物移動量検出手段で検出した先の対象物移動量の分だけ、前記ステップ制御手段により接地していない片足をステップする制御手段を備えたことを特徴とする人間型ロボットの制御装置。

【図1】
image rotate

【図2】
image rotate

【図3】
image rotate

【図4】
image rotate

【図5】
image rotate

【図6】
image rotate

【図7】
image rotate


【公開番号】特開2006−7376(P2006−7376A)
【公開日】平成18年1月12日(2006.1.12)
【国際特許分類】
【出願番号】特願2004−189371(P2004−189371)
【出願日】平成16年6月28日(2004.6.28)
【新規性喪失の例外の表示】特許法第30条第1項適用申請有り 2004年3月8日 ロボティクスシンポジア運営委員会、第9回ロボティクスシンポジア実行委員会発行の「第9回 ロボティクスシンポジア予稿集」に発表
【出願人】(301021533)独立行政法人産業技術総合研究所 (6,529)
【Fターム(参考)】