JP3760186B2 - 二脚歩行式移動装置及びその歩行制御装置並びに歩行制御方法 - Google Patents
二脚歩行式移動装置及びその歩行制御装置並びに歩行制御方法 Download PDFInfo
- Publication number
- JP3760186B2 JP3760186B2 JP2001173262A JP2001173262A JP3760186B2 JP 3760186 B2 JP3760186 B2 JP 3760186B2 JP 2001173262 A JP2001173262 A JP 2001173262A JP 2001173262 A JP2001173262 A JP 2001173262A JP 3760186 B2 JP3760186 B2 JP 3760186B2
- Authority
- JP
- Japan
- Prior art keywords
- zmp
- target value
- walking
- target
- compensation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Robotics (AREA)
- Manipulator (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、二脚歩行式移動装置に関し、特に歩行安定化を実現するようにした歩行制御に関するものである。
【０００２】
【従来の技術】
従来、所謂二脚歩行式ロボットは、前もって設定された歩行パターン（以下、歩容という）データを生成して、この歩容データに従って歩行制御を行なって、所定の歩行パターンで脚部を動作させることにより二足歩行を実現するようにしている。
ところで、このような二脚歩行式ロボットは、例えば路面状況，ロボット自体の物理パラメータの誤差等によって歩行の際の姿勢が不安定になりやすく、場合によっては転倒してしまう。
【０００３】
これに対して、歩容データを前もって設定せずに、リアルタイムにロボットの歩行状態を認識しながら、歩行制御を行なうようにすれば、歩行の際の姿勢を安定させて歩行を行なわせることも可能であるが、このような場合でも、予期しない路面状況等が発生した場合には、歩行姿勢が崩れてロボットが転倒してしまうことになる。
【０００４】
このため、歩行制御によって、ロボットの足裏における床反力と重力の合成モーメントがゼロとなる点（以下、ＺＭＰ：Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔという）を目標値に収束させる、所謂ＺＭＰ補償を行なう必要がある。
このようなＺＭＰ補償のための制御方法としては、例えば特開平５−３０５５８３号公報に示すように、コンプライアンス制御を利用して、ＺＭＰを目標値に収束させ、ロボットの上体を加速させて修正する方法や、ロボットの足の接地場所を修正する制御方法が知られている。
【０００５】
【発明が解決しようとする課題】
ところで、これらの制御方法においては、何れの場合も、ロボットの関節部分の角速度を変化させて動作軌跡を変更することにより、ロボットの安定化を図るようにしている。このため、ロボットの遊脚先端，上***置等のロボットの各部の運動軌道が歩容データによる歩容からずれて、ロボットの足の歩幅や遊脚の高さが変わったり上体が傾斜してしまう。従って、上体の傾斜を傾斜センサにより検出して上体の傾斜を補償するようにしている。
【０００６】
しかしながら、このような構成の二脚歩行式ロボットにおいては、上体の傾斜の補償が必要であると共に、例えば飛び石上を歩行する等の遊脚着地位置を変更できない場合や、上方に在る障害物をくぐり抜けたり、路面にある障害物を跨ぐような場合には、歩容が変化することにより歩幅が変わったり、あるいは遊脚及び上体の姿勢が変わってしまうので、飛び石上に遊脚を着地させることができなかったり、あるいは上方の障害物に当たってしまったり、路面にある障害物に躓いたりして、歩行できなくなってしまうことがある。
【０００７】
この発明は、以上の点にかんがみて、歩容すなわち各関節部分の動作軌跡を変更せずに歩行安定性を実現できるようにした、二脚歩行式移動装置と、その歩行制御装置及び歩行制御方法を提供することを目的としている。
【０００８】
【課題を解決するための手段】
上記目的は、この発明の第一の構成によれば、本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部分を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部分及び足部を揺動させる駆動手段と、要求動作に対応して、目標角度軌道，目標角速度，目標角加速度を含む歩容データを生成する歩容生成部と、この歩容データに基づいて上記駆動手段を駆動制御する歩行制御装置と、を備えた二脚歩行式移動装置において、上記歩行制御装置がＺＭＰ補償装置を備えており、このＺＭＰ補償装置が、各足部におけるＺＭＰを検出するＺＭＰ検出センサと、歩容生成部からの歩容データに基づいてＺＭＰ目標値を算出するＺＭＰ変換部と、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して歩容生成部からの歩容データの目標角速度及び角加速度を修正することによりＺＭＰ目標値を補償するＺＭＰ補償部と、を含んでいることを特徴とする二脚歩行式移動装置により達成される。
【０００９】
本発明による二脚歩行式移動装置は、好ましくは、上記本体が人型ロボットの上体であって頭部及び両手部を備えている。
【００１０】
本発明による二脚歩行式移動装置は、好ましくは、上記ＺＭＰ補償部が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較してＺＭＰ仮想目標値を生成するＺＭＰ仮想目標値生成部と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成するパラメータ生成部と、パラメータ生成部からの慣性力操作パラメータに基づいて保容データの目標角速度及び角加速度を修正する安定化フィルタと、から構成されている。
【００１１】
本発明による二脚歩行式移動装置は、好ましくは、上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界内であるか否かを判別する。
【００１２】
本発明による二脚歩行式移動装置は、好ましくは、上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界を超えていると判別したときには再度ＺＭＰ仮想目標値を生成する。
【００１３】
また、上記目的は、この発明の第二の構成によれば、本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部分を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部分及び足部を揺動させる駆動手段と、から成る二脚歩行式移動装置に関して、要求動作に対応して歩容生成部により生成される、目標角度軌道，目標角速度，目標角加速度を含む歩容データに基づいて上記駆動手段を駆動制御する二脚歩行式移動装置の歩行制御装置において、上記歩行制御装置がＺＭＰ補償装置を備えており、このＺＭＰ補償装置が、各足部におけるＺＭＰを検出するＺＭＰ検出センサと、歩容生成部からの歩容データに基づいてＺＭＰ目標値を算出するＺＭＰ変換部と、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して歩容生成部からの歩容データの目標角速度及び角加速度を修正することによりＺＭＰ目標値を補償するＺＭＰ補償部と、を含んでいることを特徴とする二脚歩行式移動装置の歩行制御装置により達成される。
【００１４】
本発明による二脚歩行式移動装置の歩行制御装置は、好ましくは、上記ＺＭＰ補償部が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較してＺＭＰ仮想目標値を生成するＺＭＰ仮想目標値生成部と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成するパラメータ生成部と、パラメータ生成部からのパラメータに基づいて保容データの目標角速度及び角加速度を修正する安定化フィルタと、から構成されている。
【００１５】
本発明による二脚歩行式移動装置の歩行制御装置は、好ましくは、上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界内であるか否かを判別する。
【００１６】
本発明による二脚歩行式移動装置の歩行制御装置は、好ましくは、上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界を超えていると判別したときには、再度ＺＭＰ仮想目標値を生成する。
【００１７】
さらに、上記目的は、この発明の第三の構成によれば、本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部分を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部分及び足部を揺動させる駆動手段と、から成る二脚歩行式移動装置に関して、要求動作に対応して歩容生成部により生成される目標角度軌道，目標角速度，目標角加速度を含む歩容データに基づいて上記駆動手段を駆動制御する二脚歩行式移動装置の歩行制御方法において、上記歩行制御方法がＺＭＰ補償を行なう際に、ＺＭＰ検出センサにより各足部におけるＺＭＰを検出する第一の段階と、歩容生成部からの歩容データに基づいてＺＭＰ変換部によりＺＭＰ目標値を算出する第二の段階と、ＺＭＰ検出センサにより検出されたＺＭＰ実測値とＺＭＰ目標値を比較してＺＭＰ補償部により歩容生成部からの歩容データの目標角速度及び角加速度を修正することによりＺＭＰ目標値を補償する第三の段階と、を含んでいることを特徴とする二脚歩行式移動装置の歩行制御方法により達成される。
【００１８】
本発明による二脚歩行式移動装置の歩行制御方法は、好ましくは、上記第三の段階が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較してＺＭＰ仮想目標値を生成する段階と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成する段階と、慣性力操作パラメータに基づいて保容データの目標角速度及び角加速度を安定化フィルタにより修正する段階と、を含んでいる。
【００１９】
本発明による二脚歩行式移動装置の歩行制御方法は、好ましくは、上記ＺＭＰ仮想目標値を生成する段階が、生成したＺＭＰ仮想目標値が補償可能限界内であるか否かを判別する。
【００２０】
本発明による二脚歩行式移動装置の歩行制御方法は、好ましくは、上記ＺＭＰ仮想目標値を生成する段階が、生成したＺＭＰ仮想目標値が補償可能限界を超えていると判別したときには、再度ＺＭＰ目標値を生成する。
【００２１】
上記構成によれば、ＺＭＰ検出センサにより検出したＺＭＰ実測値と、歩容データからＺＭＰ変換部により算出したＺＭＰ目標値とを比較してＺＭＰ補償部により歩容生成部からの歩容データの目標角速度及び目標角加速度を修正して、移動装置に発生する慣性力を制御することによりＺＭＰ目標値を補償する。
これにより、脚部及び足部の動作軌跡を変更することなく、ＺＭＰの実測誤差をゼロに収束させて、本体、好ましくはロボットの上体の安定化を図るようになっている。
従って、ＺＭＰ目標値の補償の際に、歩容データの目標角度軌道を変更することがないので、ロボット等の移動装置の本体，脚部の各部分の運動軌道が歩容データにより決められた運動軌道から外れることがない。
【００２２】
これにより、例えば移動装置が飛び石等の遊脚着地位置が決まっている場合であっても、また障害物を跨いだり潜り抜けるような場合であっても、確実に歩行制御を行なうことが可能である。
また、ＺＭＰの補償は、歩容生成部により生成された歩容データを利用することにより行なうようになっているので、歩容データの生成手法には依存しない。従って、ＺＭＰの補償が簡略化され得ることになる。
さらに、ＺＭＰの補償に際して歩容データの目標角度軌道を変更しないので、従来のような補償の際に用いた上体の傾斜を検出して上体を補償する必要がなく、簡単な構成によりＺＭＰの補償を行なうことができる。
【００２３】
上記ＺＭＰ補償部が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較してＺＭＰ仮想目標値を生成するＺＭＰ仮想目標値生成部と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成するパラメータ生成部と、パラメータ生成部からの慣性力操作パラメータに基づいてＺＭＰ目標値を補償する安定化フィルタとから構成されている場合には、ＺＭＰ仮想目標値生成部によりＺＭＰ仮想目標値を設定することによりＺＭＰを段階的に補償することができる。
これにより、ＺＭＰ実測値がＺＭＰ目標値から大きくずれた場合であっても、ＺＭＰの補償を段階的に行なうことにより、過大なトルクが各関節部で発生することを防止して移動装置の歩行安定性を確保することができるので、移動装置全体の転倒を防止することができる。
【００２４】
上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界内であるか否かを判別するときには、判別の結果、生成したＺＭＰ仮想目標値が補償可能限界内である場合には、このＺＭＰ仮想目標値に対してＺＭＰの補償を行なったとしても移動装置が転倒するようなことはない。従って、このＺＭＰ仮想目標値に対してＺＭＰの補償を行なうことができる。
【００２５】
上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界を超えていると判別したとき、再度ＺＭＰ仮想目標値を生成する場合には、補償可能限界内のＺＭＰ仮想目標値を生成することにより、二脚歩行式移動装置の歩行安定性を確保しつつ、ＺＭＰ実測値をＺＭＰ目標値に近づけるようにすることで移動装置の転倒を防止することができる。
【００２６】
【発明の実施の形態】
以下、図面に示した実施形態に基づいて、この発明を詳細に説明する。
図１乃至図２は、この発明による二脚歩行式移動装置を適用した二脚歩行式ロボットの一実施形態の構成を示している。
図１において、二脚歩行式ロボット１０は、本体である上体１１と、上体１１の下部両側に取り付けられた中間に膝部１２Ｌ，１２Ｒを備えた二本の脚部１３Ｌ，１３Ｒと、各脚部１３Ｌ，１３Ｒの下端に取り付けられた足部１４Ｌ，１４Ｒと、を含んでいる。
【００２７】
ここで、上記脚部１３Ｌ，１３Ｒは、それぞれ六個の関節部、即ち上方から順に、上体１１に対する腰の脚部回旋用の関節部１５Ｌ，１５Ｒ、腰のロール方向（ｘ軸周り）の関節部１６Ｌ，１６Ｒ、腰のピッチ方向（ｙ軸周り）の関節部１７Ｌ，１７Ｒ、膝部１２Ｌ，１２Ｒのピッチ方向の関節部１８Ｌ，１８Ｒ、足部１４Ｌ，１４Ｒに対する足首部のピッチ方向の関節部１９Ｌ，１９Ｒ、足首部のロール方向の関節部２０Ｌ，２０Ｒを備えている。
なお、各関節部１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒはそれぞれ関節駆動用モータにより構成されている。
【００２８】
このようにして、腰関節は、上記関節部１５Ｌ，１５Ｒ，１６Ｌ，１６Ｒ，１７ＫＬ，１７Ｒから構成され、また足関節は、関節部１９Ｌ，１９Ｒ，２０Ｌ，２０Ｒから構成されることになる。
さらに、腰関節と膝関節との間は大腿リンク２１Ｌ，２１Ｒにより連結されており、また膝関節と足関節との間は下腿リンク２２Ｌ，２２Ｒにより連結されている。
これにより、二脚歩行式ロボット１０の左右両側の脚部１３Ｌ，１３Ｒ及び足部１４Ｌ，１４Ｒは、それぞれ６自由度を与えられることになり、歩行中にこれらの１２個の関節部をそれぞれ駆動モータにより適宜の角度に駆動制御することにより、脚部１３Ｌ，１３Ｒ，足部１４Ｌ，１４Ｒ全体に所望の動作を与えて、任意に三次元空間を歩行することができるように構成されている。
【００２９】
さらに、上記足部１４Ｌ，１４Ｒは、ＺＭＰ検出センサ２３Ｌ，２３Ｒを備えている。このＺＭＰ検出センサ２３Ｌ，２３Ｒは、それぞれ各足部１４Ｌ，１４Ｒにおける足裏床反力の中心点であるＺＭＰを検出して、ＺＭＰ実測値を出力するようになっている。
【００３０】
なお、上記上体１１は、図示の場合、単に箱状に示されているが、実際には、頭部や両手を備えていてもよい。
【００３１】
図２は、図１に示した二脚歩行式ロボット１０の電気的構成を示している。図２において、二脚歩行式ロボット１０は、要求動作に対応して歩容データを生成する歩容生成部２４と、この歩容データに基づいて駆動手段、即ち上述した各関節部即ち関節駆動用モータ１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒを駆動制御する歩行制御装置３０と、を備えている。なお、二脚歩行式ロボット１０の座標系として、前後方向をｘ方向（前方＋），横方向をｙ方向（内方＋）そして上下方向をｚ方向（上方＋）とするｘｙｚ座標系を使用する。
【００３２】
上記歩容生成部２４は、外部から入力される要求動作に対応して、二脚歩行式ロボット１０の歩行に必要な各関節部１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒの目標角度軌道θref ，目標角速度（ｄθref ／ｄｔ），目標角加速度（ｄ2 θref ／ｄｔ2 ）を含む歩容データを生成するようになっている。
【００３３】
上記歩行制御装置３０は、角度計測ユニット３１と、ＺＭＰ補償装置３２と、制御部３３と、モータ制御ユニット３４と、から構成されている。
上記角度計測ユニット３１は、各関節部１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒの関節駆動用モータに備えられた例えばロータリエンコーダ等により各関節駆動用モータの角度情報が入力されることにより、各関節駆動用モータの角度位置を計測して、制御部３３に出力するようになっている。
【００３４】
上記ＺＭＰ補償装置３２は、以下に詳細に説明するように、上記ＺＭＰ検出センサ２３Ｌ，２３ＲからのＺＭＰ実測値に基づいて、歩容生成部２４からの歩容データのＺＭＰ目標値補償を行うようになっている。
【００３５】
上記制御部３３は、ＺＭＰ補償装置３２で補償された歩容データのＺＭＰ目標値と、角度計測ユニット３１からの各関節駆動用モータの角度位置に基づいて、各関節駆動用モータの制御信号を生成するようになっている。
上記モータ制御ユニット３４は、制御部３３からの制御信号に従って各関節駆動用モータを駆動制御するようになっている。
【００３６】
ここで、上記ＺＭＰ補償装置３２は、図３に示すように構成されている。
図３において、ＺＭＰ補償装置３２は、ＺＭＰ変換部３５とＺＭＰ補償部３６とから構成されている。上記ＺＭＰ変換部３５は、歩容生成部２４からの歩容データの目標角度軌道θref ，目標角速度（ｄθref ／ｄｔ）及び目標角加速度（ｄ2 θref ／ｄｔ2 ）に基づいて、ＺＭＰ目標値ＺＭＰref を算出する。
ＺＭＰ目標値ＺＭＰref の算出は、以下のようにして行なわれる。
【００３７】
図４に示すように、二脚歩行式ロボット１０の支持脚をｘｚ平面の原点として、支持脚の下腿部２２Ｌまたは２２Ｒの質量をｍ１，角度をθ１とし、大腿部２１Ｌまたは２１Ｒの質量をｍ２，角度をθ２とし、上体１１の質量をｍ３，角度をθ３とし、遊脚の大腿部２１Ｒまたは２１Ｌの質量をｍ４，角度をθ４とし、大腿部２２Ｒまたは２２Ｌの質量をｍ５，角度をθ５とすると、ピッチ軸周りのＺＭＰ（ＸZMP ）は、次式
【数１】
により算出される。
同様にして、ロール軸周りのＺＭＰ（ＹZMP ）も算出することができる。
【００３８】
上記ＺＭＰ補償部３６は、図３に示すように、ＺＭＰ仮想目標値生成部３７とパラメータ生成部３８と安定化フィルタ３９とから構成されている。
上記ＺＭＰ仮想目標値生成部３７は、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部３５からのＺＭＰ目標値ＺＭＰref とを比較して、ＺＭＰ仮想目標値ＺＭＰvrefを生成する。
具体的には、ＺＭＰ仮想目標値生成部３７は、減算器３７ａによるＺＭＰ誤差ＺＭＰerr （＝ＺＭＰref −ＺＭＰ実測値）と、ＺＭＰ目標値ＺＭＰref から、次式
【数２】
によりＺＭＰ仮想目標値ＺＭＰvrefを生成する。ここで、αはゲインである。
さらに、上記ＺＭＰ仮想目標値生成部３７は、このＺＭＰ仮想目標値ＺＭＰvrefが補償可能限界以内であるか否かの判別を行ない、補償可能限界を超えている場合には、再度ＺＭＰ仮想目標値ＺＭＰvrefを生成する。
【００３９】
上記パラメータ生成部３８は、ＺＭＰ仮想目標値生成部３７からのＺＭＰ仮想目標値ＺＭＰvrefと、歩行生成部２４からの目標角度軌道θref ，目標角速度（ｄθref ／ｄｔ）及び目標角加速度（ｄ2 θref ／ｄｔ2 ）に基づいて、ＺＭＰ補償関数を利用して、ＺＭＰ実測値をＺＭＰ仮想目標値ＺＭＰvrefまで修正するために必要な慣性力を計算し、この慣性力に応じた慣性力操作パラメータＴｃを算出する。
この慣性力操作パラメータＴｃは、ピッチ軸周りに関して、前述したＺＭＰの計算式から、次式
【数３】
により導出され、この式をＺＭＰ補償関数という。
ここで、κ，λ，μは、ロボットの物理量及びθｒｅｆにより決定されるパラメータである。
同様にして、ロール軸周りのＺＭＰ補償関数も導出することができる。
これにより、パラメータ生成部３８は、慣性力操作パラメータＴｃにより、ＺＭＰサンプリング間隔を仮想的に伸縮させて、ＺＭＰ目標値を実現するために必要な慣性力を生じさせるようになっている。
【００４０】
上記安定化フィルタ３９は、パラメータ生成部３８からの慣性力操作パラメータＴｃに基づいて、歩容生成部２４からの歩容データである目標角度軌道θref ，目標角速度（ｄθref ／ｄｔ）及び目標角加速度（ｄ2 θref ／ｄｔ2 ）から、各関節部の修正した目標角度軌道θｃ，目標角速度（ｄθｃ／ｄｔ）及び目標角加速度（ｄ2 θｃ／ｄｔ2 ）を算出する。
【００４１】
本発明実施形態による二脚歩行式ロボット１０は以上のように構成されており、歩行動作は、図５に示すフローチャートにより以下のように行なわれる。
図５において、先ずステップＳＴ１にて、歩容生成部２４が、入力された要求動作（Ｊ＝Ｊ）に基づいて歩容データを生成し、歩行制御装置３０のＺＭＰ補償装置３２に出力する。
次に、ステップＳＴ２にて、ＺＭＰ補償装置３２のＺＭＰ変換部３５が、この歩容データに基づいて各関節部１６Ｌ，１６Ｒ乃至２０Ｌ，２０Ｒの目標角度θref ，目標角速度（ｄθref ／ｄｔ），目標角加速度（ｄ2 θref ／ｄｔ2 ）からＺＭＰ目標値を算出する。
【００４２】
他方、ステップＳＴ３にて、双方の足部１４Ｌ，１４Ｒに備えられたＺＭＰ検出センサ２３Ｌ，２３ＲがＺＭＰ実測値を検出する。
これにより、ステップＳＴ４にて、ＺＭＰ仮想目標値生成部３７が、減算器３７ａからのＺＭＰ誤差ＺＭＰerr と、ＺＭＰ変換部３５からのＺＭＰ目標値ＺＭＰref から、ＺＭＰ仮想目標値ＺＭＰvrefを生成する。
続いて、ステップＳＴ５にて、ＺＭＰ仮想目標値生成部３７が、ＺＭＰ仮想目標値ＺＭＰvrefが補償可能限界内であるか否かを判別する。
【００４３】
そして、ステップＳＴ５にて、ＺＭＰ仮想目標値ＺＭＰvrefが補償可能限界を超えている場合には、前述したステップＳＴ４に戻って、ＺＭＰ仮想目標値生成部３７が、再びＺＭＰ仮想目標値ＺＭＰvrefを生成する。
また、ステップＳＴ５にて、ＺＭＰ仮想目標値ＺＭＰvrefが補償可能限界内である場合には、ＺＭＰ仮想目標値生成部３７が、ＺＭＰ仮想目標値ＺＭＰvrefをパラメータ生成部３８に出力する。
【００４４】
そして、ステップＳＴ６にて、パラメータ生成部３８が、このＺＭＰ仮想目標値ＺＭＰvrefと、歩容生成部２４からの歩容データによる各関節部１６Ｌ，１６Ｒ乃至２０Ｌ，２０Ｒの目標角度θref ，目標角速度（ｄθref ／ｄｔ），目標角加速度（ｄ2 θref ／ｄｔ2 ）とから、ＺＭＰ補償関数により慣性力操作パラメータＴｃを算出して、安定化フィルタ３９に出力する。
【００４５】
続いて、ステップＳＴ７にて、安定化フィルタ３９が、上記慣性力操作パラメータＴｃに基づいて、歩容生成部２４からの歩容データによる各関節部１６Ｌ，１６Ｒ乃至２０Ｌ，２０Ｒの目標角度θref ，目標角速度（ｄθref ／ｄｔ），目標角加速度（ｄ2 θref ／ｄｔ2 ）に修正を加えて、各関節部の修正した目標角度軌道θｃ，目標角速度（ｄθｃ／ｄｔ）及び目標角加速度（ｄ2 θｃ／ｄｔ2 ）を算出する。
【００４６】
次に、ステップＳＴ８にて、ＺＭＰ補償装置３２は、上述した補償した歩容データ、すなわち各関節部の修正した目標角度軌道θｃ，目標角速度（ｄθｃ／ｄｔ）及び目標角加速度（ｄ2 θｃ／ｄｔ2 ）を制御部３３に出力し、モータ制御ユニット３４が各関節部の関節駆動用モータを駆動制御する。これにより、二脚歩行式ロボット１０は要求動作に対応して歩行動作を行なうことになる。
【００４７】
その後、ステップＳＴ９にて、制御部３３が、動作カウンタインクリメントによりＪ＝Ｊ＋１として、所定のサンプリング時間になるまで待機した後、ステップＳＴ１０にて、上記Ｊが前以て決められた動作終了カウント以下の場合には再びステップ２に戻って上記動作を繰り返す。
そして、ステップＳＴ１０にて、上記Ｊが動作終了カウントを超えた場合には動作を終了する。
【００４８】
この場合、二脚歩行式ロボット１０において、各関節駆動用モータの駆動制御の際に、目標角加速度（ｄ2 θref ／ｄｔ2 ）が、修正した目標角加速度（ｄ2 θｃ／ｄｔ2 ）に変更されることにより、ロボット１０に作用する加速度が変化することになり、これに伴って、加速度の反作用としての慣性力が変化する。従って、ロボット１０に作用する慣性力が目標角加速度（ｄ2 θref ／ｄｔ2 ）の変化により適宜に制御される。これによりロボット１０は、図６に示すようにその歩行の際の動作軌跡Ａを変更することなく、動作軌跡Ｂを時間的に伸縮させることによって要求動作に対する歩行動作を行なう。
【００４９】
さらに、ＺＭＰ仮想目標値生成部３７が、ＺＭＰ目標値ＺＭＰref とＺＭＰ実測値から、一旦ＺＭＰ仮想目標値ＺＭＰvrefを生成することにより、ＺＭＰ実測値がＺＭＰ目標値から大きくずれている場合には、段階的にＺＭＰ実測値をＺＭＰ目標値に近づけるように、ＺＭＰの補償を行なうようになっている。
これにより、ＺＭＰ実測値がＺＭＰ目標値から大きくずれている場合でも、ロボット１０の各関節部に過大な角加速度が作用することがないので、ロボット１０が安定した状態で歩行を行なうことが可能である。
【００５０】
このようにして、本発明実施形態による二脚歩行式ロボット１０によれば、ＺＭＰ目標値とＺＭＰ実測値の差であるＺＭＰ誤差に基づいて、歩容データの目標角速度及び目標角加速度を修正することにより、ロボット１０に発生する慣性力を制御してＺＭＰ目標値を補償する。
従って、歩行の際の動作軌跡を変更することなく、ＺＭＰ誤差をゼロに収束させることによりロボット１０の歩行安定化を実現することができる。
【００５１】
次に、本発明による二脚歩行式ロボット１０に関するシミュレーション実験及び実機実験について説明する。
先ず、シミュレーション実験について説明する。
上述した二脚歩行式ロボット１０により、ｙｚ面内での動的足踏み動作を行なわせて、一方の支持脚による片足立ち状態から０．４２秒後に外乱を与えて、ＺＭＰに関して目標値からのずれを生じさせた。
この結果、ＺＭＰ仮想目標値生成部３７により生成されたＺＭＰ仮想目標値ＺＭＰvrefは、図７（Ａ）に示すように、０．４３秒までにはＺＭＰ目標値にほぼ完全に収束すると共に、さらに図７（Ｂ）に示すように、ＺＭＰ実測値もＺＭＰ目標値に正しく修正されていることが確認された。なお、図８において、上述したＺＭＰ補償がない場合には、ＺＭＰ目標値はＺＭＰ目標値から大きくずれたままであった。
【００５２】
実機実験では、二脚歩行式ロボット１０として、全体質量１３７０ｇ，全高３０．０ｃｍ，足部底面形状がロール方向（ｙ方向）６．０ｃｍ，ピッチ方向（ｘ方向）８．０ｃｍのロボットを使用して足踏み動作を行なわせたところ、図９に示すように、本発明によるＺＭＰ補償の場合には、ＺＭＰ補償のない場合と比較してＺＭＰ実測値がＺＭＰ目標値により近づいており、ロボットの歩行安定性が向上していることが分かった。
さらに、実機実験により、上述したシミュレーション実験の場合と同様に足踏み動作中の外乱について実験したところ、図１０に示すように、本発明によるＺＭＰ補償の場合には、ＺＭＰ実測値がＺＭＰ目標値に確実に近づいて、ＺＭＰ誤差がゼロに近づいており（図１１参照）、ロボットの歩行安定性が向上していることが分かる。
これに対して、従来のＺＭＰ補償による場合には、図１０に示すように、その後約０．５秒経過後にロボットが転倒してしまった。
【００５３】
上述した実施形態においては、実験において、ｙｚ面内における足踏み動作の場合について説明したが、これに限らず、ｘｚ面内においても同様に二脚歩行式ロボット１０の歩行安定性が向上することは明らかである。
また、上述した実施形態においては、本発明を二脚歩行式ロボットに適用した場合について説明したが、これに限らず、他の各種機器を二本足で支持すると共に、この二本足で歩行するようにした二脚歩行式移動装置に対して本発明を適用し得ることは明らかである。
【００５４】
【発明の効果】
以上述べたように、この発明によれば、ＺＭＰ検出センサにより検出したＺＭＰ実測値と、歩容データからＺＭＰ変換部により算出したＺＭＰ目標値とを比較して、ＺＭＰ補償部により歩容生成部からの歩容データの目標角速度及び目標角加速度を修正して移動装置に発生する慣性力を制御することにより、ＺＭＰ目標値を補償する。これにより、脚部及び足部の動作軌跡を変更することなく、ＺＭＰの実測誤差をゼロに収束させて、本体、好ましくはロボットの上体の安定化を図るようになっている。
従って、ＺＭＰ目標値の補償の際に、歩容データの目標角度軌道を変更することがないので、ロボット等の移動装置の本体，脚部の各部分の運動軌道が歩容データにより決められた運動軌道から外れることがない。
【００５５】
これにより、例えば移動装置が飛び石等の遊脚着地位置が決まっている場合であっても、また障害物を跨いだり、潜り抜けるような場合であっても、確実に歩行制御を行なうことが可能である。
また、ＺＭＰの補償は、歩容生成部により生成された歩容データを利用することにより行なうようになっているので、歩容データの生成手法には依存しない。従って、ＺＭＰの補償が簡略化され得る。
さらに、ＺＭＰの補償に際して、歩容データの目標角度軌道を変更することがないので、従来のような補償の際に用いた上体の傾斜を検出して上体を補償する必要がなく、簡単な構成によりＺＭＰの補償を行なうことができる。
このようにして、本発明によれば、歩容すなわち各関節部分の動作軌跡を変更せずに歩行安定性を実現できるようにした、極めて優れた二脚歩行式移動装置とその歩行制御装置及び歩行制御方法を提供することができる。
【図面の簡単な説明】
【図１】この発明による二脚歩行式ロボットの一実施形態の機械的構成を示す概略図である。
【図２】図１の二脚歩行式ロボットの電気的構成を示すブロック図である。
【図３】図１の二脚歩行式ロボットのＺＭＰ補償装置の構成を示すブロック図である。
【図４】図１に示す二脚歩行式ロボットの歩行時のｘｚ平面分離モデルを示す概略図である。
【図５】図１の二脚歩行式ロボットの歩行制御動作を示すフローチャートである。
【図６】図１の二脚歩行式ロボットにおけるＺＭＰ補償の角速度操作を示す概略図である。
【図７】図１の二脚歩行式ロボットにおけるシミュレーション実験によるＺＭＰ仮想目標値とＺＭＰ実測値を示すグラフである。
【図８】図１の二脚歩行式ロボットにおけるシミュレーション実験によるＺＭＰ目標値，ＺＭＰ実測値及びＺＭＰ補償のない場合のＺＭＰ実測値を示すグラフである。
【図９】図１の二脚歩行式ロボットにおける実機実験によるＺＭＰ目標値，ＺＭＰ実測値及びＺＭＰ補償のない場合のＺＭＰ実測値を示すグラフである。
【図１０】図１の二脚歩行式ロボットにおける他の実機実験によるＺＭＰ実測値及び従来のＺＭＰ補償による場合のＺＭＰ実測値を示すグラフである。
【図１１】図１０の実機実験の外乱作用直後の（Ａ）ＺＭＰ目標値，ＺＭＰ実測値及び、（Ｂ）ＺＭＰ誤差を示す拡大グラフである。
【符号の説明】
１０ 二脚歩行式ロボット
１１ 本体
１２Ｌ，１２Ｒ 膝部
１３Ｌ，１３Ｒ 脚部
１４Ｌ，１４Ｒ 足部
１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒ 関節部（関節駆動用モータ）
２１Ｌ，２１Ｒ 大腿部
２２Ｌ，２２Ｒ 下腿部
２３Ｌ，２３Ｒ ＺＭＰ検出センサ
２４ 歩容生成部
３０ 歩行制御装置
３１ 角度計測ユニット
３２ ＺＭＰ補償装置
３３ 制御部
３４ モータ制御ユニット
３５ ＺＭＰ変換部
３６ ＺＭＰ補償部
３７ ＺＭＰ仮想目標値生成部
３８ パラメータ生成部
３９ 安定化フィルタ
【発明の属する技術分野】
本発明は、二脚歩行式移動装置に関し、特に歩行安定化を実現するようにした歩行制御に関するものである。
【０００２】
【従来の技術】
従来、所謂二脚歩行式ロボットは、前もって設定された歩行パターン（以下、歩容という）データを生成して、この歩容データに従って歩行制御を行なって、所定の歩行パターンで脚部を動作させることにより二足歩行を実現するようにしている。
ところで、このような二脚歩行式ロボットは、例えば路面状況，ロボット自体の物理パラメータの誤差等によって歩行の際の姿勢が不安定になりやすく、場合によっては転倒してしまう。
【０００３】
これに対して、歩容データを前もって設定せずに、リアルタイムにロボットの歩行状態を認識しながら、歩行制御を行なうようにすれば、歩行の際の姿勢を安定させて歩行を行なわせることも可能であるが、このような場合でも、予期しない路面状況等が発生した場合には、歩行姿勢が崩れてロボットが転倒してしまうことになる。
【０００４】
このため、歩行制御によって、ロボットの足裏における床反力と重力の合成モーメントがゼロとなる点（以下、ＺＭＰ：Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔという）を目標値に収束させる、所謂ＺＭＰ補償を行なう必要がある。
このようなＺＭＰ補償のための制御方法としては、例えば特開平５−３０５５８３号公報に示すように、コンプライアンス制御を利用して、ＺＭＰを目標値に収束させ、ロボットの上体を加速させて修正する方法や、ロボットの足の接地場所を修正する制御方法が知られている。
【０００５】
【発明が解決しようとする課題】
ところで、これらの制御方法においては、何れの場合も、ロボットの関節部分の角速度を変化させて動作軌跡を変更することにより、ロボットの安定化を図るようにしている。このため、ロボットの遊脚先端，上***置等のロボットの各部の運動軌道が歩容データによる歩容からずれて、ロボットの足の歩幅や遊脚の高さが変わったり上体が傾斜してしまう。従って、上体の傾斜を傾斜センサにより検出して上体の傾斜を補償するようにしている。
【０００６】
しかしながら、このような構成の二脚歩行式ロボットにおいては、上体の傾斜の補償が必要であると共に、例えば飛び石上を歩行する等の遊脚着地位置を変更できない場合や、上方に在る障害物をくぐり抜けたり、路面にある障害物を跨ぐような場合には、歩容が変化することにより歩幅が変わったり、あるいは遊脚及び上体の姿勢が変わってしまうので、飛び石上に遊脚を着地させることができなかったり、あるいは上方の障害物に当たってしまったり、路面にある障害物に躓いたりして、歩行できなくなってしまうことがある。
【０００７】
この発明は、以上の点にかんがみて、歩容すなわち各関節部分の動作軌跡を変更せずに歩行安定性を実現できるようにした、二脚歩行式移動装置と、その歩行制御装置及び歩行制御方法を提供することを目的としている。
【０００８】
【課題を解決するための手段】
上記目的は、この発明の第一の構成によれば、本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部分を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部分及び足部を揺動させる駆動手段と、要求動作に対応して、目標角度軌道，目標角速度，目標角加速度を含む歩容データを生成する歩容生成部と、この歩容データに基づいて上記駆動手段を駆動制御する歩行制御装置と、を備えた二脚歩行式移動装置において、上記歩行制御装置がＺＭＰ補償装置を備えており、このＺＭＰ補償装置が、各足部におけるＺＭＰを検出するＺＭＰ検出センサと、歩容生成部からの歩容データに基づいてＺＭＰ目標値を算出するＺＭＰ変換部と、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して歩容生成部からの歩容データの目標角速度及び角加速度を修正することによりＺＭＰ目標値を補償するＺＭＰ補償部と、を含んでいることを特徴とする二脚歩行式移動装置により達成される。
【０００９】
本発明による二脚歩行式移動装置は、好ましくは、上記本体が人型ロボットの上体であって頭部及び両手部を備えている。
【００１０】
本発明による二脚歩行式移動装置は、好ましくは、上記ＺＭＰ補償部が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較してＺＭＰ仮想目標値を生成するＺＭＰ仮想目標値生成部と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成するパラメータ生成部と、パラメータ生成部からの慣性力操作パラメータに基づいて保容データの目標角速度及び角加速度を修正する安定化フィルタと、から構成されている。
【００１１】
本発明による二脚歩行式移動装置は、好ましくは、上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界内であるか否かを判別する。
【００１２】
本発明による二脚歩行式移動装置は、好ましくは、上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界を超えていると判別したときには再度ＺＭＰ仮想目標値を生成する。
【００１３】
また、上記目的は、この発明の第二の構成によれば、本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部分を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部分及び足部を揺動させる駆動手段と、から成る二脚歩行式移動装置に関して、要求動作に対応して歩容生成部により生成される、目標角度軌道，目標角速度，目標角加速度を含む歩容データに基づいて上記駆動手段を駆動制御する二脚歩行式移動装置の歩行制御装置において、上記歩行制御装置がＺＭＰ補償装置を備えており、このＺＭＰ補償装置が、各足部におけるＺＭＰを検出するＺＭＰ検出センサと、歩容生成部からの歩容データに基づいてＺＭＰ目標値を算出するＺＭＰ変換部と、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して歩容生成部からの歩容データの目標角速度及び角加速度を修正することによりＺＭＰ目標値を補償するＺＭＰ補償部と、を含んでいることを特徴とする二脚歩行式移動装置の歩行制御装置により達成される。
【００１４】
本発明による二脚歩行式移動装置の歩行制御装置は、好ましくは、上記ＺＭＰ補償部が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較してＺＭＰ仮想目標値を生成するＺＭＰ仮想目標値生成部と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成するパラメータ生成部と、パラメータ生成部からのパラメータに基づいて保容データの目標角速度及び角加速度を修正する安定化フィルタと、から構成されている。
【００１５】
本発明による二脚歩行式移動装置の歩行制御装置は、好ましくは、上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界内であるか否かを判別する。
【００１６】
本発明による二脚歩行式移動装置の歩行制御装置は、好ましくは、上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界を超えていると判別したときには、再度ＺＭＰ仮想目標値を生成する。
【００１７】
さらに、上記目的は、この発明の第三の構成によれば、本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部分を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部分及び足部を揺動させる駆動手段と、から成る二脚歩行式移動装置に関して、要求動作に対応して歩容生成部により生成される目標角度軌道，目標角速度，目標角加速度を含む歩容データに基づいて上記駆動手段を駆動制御する二脚歩行式移動装置の歩行制御方法において、上記歩行制御方法がＺＭＰ補償を行なう際に、ＺＭＰ検出センサにより各足部におけるＺＭＰを検出する第一の段階と、歩容生成部からの歩容データに基づいてＺＭＰ変換部によりＺＭＰ目標値を算出する第二の段階と、ＺＭＰ検出センサにより検出されたＺＭＰ実測値とＺＭＰ目標値を比較してＺＭＰ補償部により歩容生成部からの歩容データの目標角速度及び角加速度を修正することによりＺＭＰ目標値を補償する第三の段階と、を含んでいることを特徴とする二脚歩行式移動装置の歩行制御方法により達成される。
【００１８】
本発明による二脚歩行式移動装置の歩行制御方法は、好ましくは、上記第三の段階が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較してＺＭＰ仮想目標値を生成する段階と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成する段階と、慣性力操作パラメータに基づいて保容データの目標角速度及び角加速度を安定化フィルタにより修正する段階と、を含んでいる。
【００１９】
本発明による二脚歩行式移動装置の歩行制御方法は、好ましくは、上記ＺＭＰ仮想目標値を生成する段階が、生成したＺＭＰ仮想目標値が補償可能限界内であるか否かを判別する。
【００２０】
本発明による二脚歩行式移動装置の歩行制御方法は、好ましくは、上記ＺＭＰ仮想目標値を生成する段階が、生成したＺＭＰ仮想目標値が補償可能限界を超えていると判別したときには、再度ＺＭＰ目標値を生成する。
【００２１】
上記構成によれば、ＺＭＰ検出センサにより検出したＺＭＰ実測値と、歩容データからＺＭＰ変換部により算出したＺＭＰ目標値とを比較してＺＭＰ補償部により歩容生成部からの歩容データの目標角速度及び目標角加速度を修正して、移動装置に発生する慣性力を制御することによりＺＭＰ目標値を補償する。
これにより、脚部及び足部の動作軌跡を変更することなく、ＺＭＰの実測誤差をゼロに収束させて、本体、好ましくはロボットの上体の安定化を図るようになっている。
従って、ＺＭＰ目標値の補償の際に、歩容データの目標角度軌道を変更することがないので、ロボット等の移動装置の本体，脚部の各部分の運動軌道が歩容データにより決められた運動軌道から外れることがない。
【００２２】
これにより、例えば移動装置が飛び石等の遊脚着地位置が決まっている場合であっても、また障害物を跨いだり潜り抜けるような場合であっても、確実に歩行制御を行なうことが可能である。
また、ＺＭＰの補償は、歩容生成部により生成された歩容データを利用することにより行なうようになっているので、歩容データの生成手法には依存しない。従って、ＺＭＰの補償が簡略化され得ることになる。
さらに、ＺＭＰの補償に際して歩容データの目標角度軌道を変更しないので、従来のような補償の際に用いた上体の傾斜を検出して上体を補償する必要がなく、簡単な構成によりＺＭＰの補償を行なうことができる。
【００２３】
上記ＺＭＰ補償部が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較してＺＭＰ仮想目標値を生成するＺＭＰ仮想目標値生成部と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成するパラメータ生成部と、パラメータ生成部からの慣性力操作パラメータに基づいてＺＭＰ目標値を補償する安定化フィルタとから構成されている場合には、ＺＭＰ仮想目標値生成部によりＺＭＰ仮想目標値を設定することによりＺＭＰを段階的に補償することができる。
これにより、ＺＭＰ実測値がＺＭＰ目標値から大きくずれた場合であっても、ＺＭＰの補償を段階的に行なうことにより、過大なトルクが各関節部で発生することを防止して移動装置の歩行安定性を確保することができるので、移動装置全体の転倒を防止することができる。
【００２４】
上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界内であるか否かを判別するときには、判別の結果、生成したＺＭＰ仮想目標値が補償可能限界内である場合には、このＺＭＰ仮想目標値に対してＺＭＰの補償を行なったとしても移動装置が転倒するようなことはない。従って、このＺＭＰ仮想目標値に対してＺＭＰの補償を行なうことができる。
【００２５】
上記ＺＭＰ仮想目標値生成部が、生成したＺＭＰ仮想目標値が補償可能限界を超えていると判別したとき、再度ＺＭＰ仮想目標値を生成する場合には、補償可能限界内のＺＭＰ仮想目標値を生成することにより、二脚歩行式移動装置の歩行安定性を確保しつつ、ＺＭＰ実測値をＺＭＰ目標値に近づけるようにすることで移動装置の転倒を防止することができる。
【００２６】
【発明の実施の形態】
以下、図面に示した実施形態に基づいて、この発明を詳細に説明する。
図１乃至図２は、この発明による二脚歩行式移動装置を適用した二脚歩行式ロボットの一実施形態の構成を示している。
図１において、二脚歩行式ロボット１０は、本体である上体１１と、上体１１の下部両側に取り付けられた中間に膝部１２Ｌ，１２Ｒを備えた二本の脚部１３Ｌ，１３Ｒと、各脚部１３Ｌ，１３Ｒの下端に取り付けられた足部１４Ｌ，１４Ｒと、を含んでいる。
【００２７】
ここで、上記脚部１３Ｌ，１３Ｒは、それぞれ六個の関節部、即ち上方から順に、上体１１に対する腰の脚部回旋用の関節部１５Ｌ，１５Ｒ、腰のロール方向（ｘ軸周り）の関節部１６Ｌ，１６Ｒ、腰のピッチ方向（ｙ軸周り）の関節部１７Ｌ，１７Ｒ、膝部１２Ｌ，１２Ｒのピッチ方向の関節部１８Ｌ，１８Ｒ、足部１４Ｌ，１４Ｒに対する足首部のピッチ方向の関節部１９Ｌ，１９Ｒ、足首部のロール方向の関節部２０Ｌ，２０Ｒを備えている。
なお、各関節部１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒはそれぞれ関節駆動用モータにより構成されている。
【００２８】
このようにして、腰関節は、上記関節部１５Ｌ，１５Ｒ，１６Ｌ，１６Ｒ，１７ＫＬ，１７Ｒから構成され、また足関節は、関節部１９Ｌ，１９Ｒ，２０Ｌ，２０Ｒから構成されることになる。
さらに、腰関節と膝関節との間は大腿リンク２１Ｌ，２１Ｒにより連結されており、また膝関節と足関節との間は下腿リンク２２Ｌ，２２Ｒにより連結されている。
これにより、二脚歩行式ロボット１０の左右両側の脚部１３Ｌ，１３Ｒ及び足部１４Ｌ，１４Ｒは、それぞれ６自由度を与えられることになり、歩行中にこれらの１２個の関節部をそれぞれ駆動モータにより適宜の角度に駆動制御することにより、脚部１３Ｌ，１３Ｒ，足部１４Ｌ，１４Ｒ全体に所望の動作を与えて、任意に三次元空間を歩行することができるように構成されている。
【００２９】
さらに、上記足部１４Ｌ，１４Ｒは、ＺＭＰ検出センサ２３Ｌ，２３Ｒを備えている。このＺＭＰ検出センサ２３Ｌ，２３Ｒは、それぞれ各足部１４Ｌ，１４Ｒにおける足裏床反力の中心点であるＺＭＰを検出して、ＺＭＰ実測値を出力するようになっている。
【００３０】
なお、上記上体１１は、図示の場合、単に箱状に示されているが、実際には、頭部や両手を備えていてもよい。
【００３１】
図２は、図１に示した二脚歩行式ロボット１０の電気的構成を示している。図２において、二脚歩行式ロボット１０は、要求動作に対応して歩容データを生成する歩容生成部２４と、この歩容データに基づいて駆動手段、即ち上述した各関節部即ち関節駆動用モータ１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒを駆動制御する歩行制御装置３０と、を備えている。なお、二脚歩行式ロボット１０の座標系として、前後方向をｘ方向（前方＋），横方向をｙ方向（内方＋）そして上下方向をｚ方向（上方＋）とするｘｙｚ座標系を使用する。
【００３２】
上記歩容生成部２４は、外部から入力される要求動作に対応して、二脚歩行式ロボット１０の歩行に必要な各関節部１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒの目標角度軌道θref ，目標角速度（ｄθref ／ｄｔ），目標角加速度（ｄ2 θref ／ｄｔ2 ）を含む歩容データを生成するようになっている。
【００３３】
上記歩行制御装置３０は、角度計測ユニット３１と、ＺＭＰ補償装置３２と、制御部３３と、モータ制御ユニット３４と、から構成されている。
上記角度計測ユニット３１は、各関節部１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒの関節駆動用モータに備えられた例えばロータリエンコーダ等により各関節駆動用モータの角度情報が入力されることにより、各関節駆動用モータの角度位置を計測して、制御部３３に出力するようになっている。
【００３４】
上記ＺＭＰ補償装置３２は、以下に詳細に説明するように、上記ＺＭＰ検出センサ２３Ｌ，２３ＲからのＺＭＰ実測値に基づいて、歩容生成部２４からの歩容データのＺＭＰ目標値補償を行うようになっている。
【００３５】
上記制御部３３は、ＺＭＰ補償装置３２で補償された歩容データのＺＭＰ目標値と、角度計測ユニット３１からの各関節駆動用モータの角度位置に基づいて、各関節駆動用モータの制御信号を生成するようになっている。
上記モータ制御ユニット３４は、制御部３３からの制御信号に従って各関節駆動用モータを駆動制御するようになっている。
【００３６】
ここで、上記ＺＭＰ補償装置３２は、図３に示すように構成されている。
図３において、ＺＭＰ補償装置３２は、ＺＭＰ変換部３５とＺＭＰ補償部３６とから構成されている。上記ＺＭＰ変換部３５は、歩容生成部２４からの歩容データの目標角度軌道θref ，目標角速度（ｄθref ／ｄｔ）及び目標角加速度（ｄ2 θref ／ｄｔ2 ）に基づいて、ＺＭＰ目標値ＺＭＰref を算出する。
ＺＭＰ目標値ＺＭＰref の算出は、以下のようにして行なわれる。
【００３７】
図４に示すように、二脚歩行式ロボット１０の支持脚をｘｚ平面の原点として、支持脚の下腿部２２Ｌまたは２２Ｒの質量をｍ１，角度をθ１とし、大腿部２１Ｌまたは２１Ｒの質量をｍ２，角度をθ２とし、上体１１の質量をｍ３，角度をθ３とし、遊脚の大腿部２１Ｒまたは２１Ｌの質量をｍ４，角度をθ４とし、大腿部２２Ｒまたは２２Ｌの質量をｍ５，角度をθ５とすると、ピッチ軸周りのＺＭＰ（ＸZMP ）は、次式
【数１】
同様にして、ロール軸周りのＺＭＰ（ＹZMP ）も算出することができる。
【００３８】
上記ＺＭＰ補償部３６は、図３に示すように、ＺＭＰ仮想目標値生成部３７とパラメータ生成部３８と安定化フィルタ３９とから構成されている。
上記ＺＭＰ仮想目標値生成部３７は、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部３５からのＺＭＰ目標値ＺＭＰref とを比較して、ＺＭＰ仮想目標値ＺＭＰvrefを生成する。
具体的には、ＺＭＰ仮想目標値生成部３７は、減算器３７ａによるＺＭＰ誤差ＺＭＰerr （＝ＺＭＰref −ＺＭＰ実測値）と、ＺＭＰ目標値ＺＭＰref から、次式
【数２】
さらに、上記ＺＭＰ仮想目標値生成部３７は、このＺＭＰ仮想目標値ＺＭＰvrefが補償可能限界以内であるか否かの判別を行ない、補償可能限界を超えている場合には、再度ＺＭＰ仮想目標値ＺＭＰvrefを生成する。
【００３９】
上記パラメータ生成部３８は、ＺＭＰ仮想目標値生成部３７からのＺＭＰ仮想目標値ＺＭＰvrefと、歩行生成部２４からの目標角度軌道θref ，目標角速度（ｄθref ／ｄｔ）及び目標角加速度（ｄ2 θref ／ｄｔ2 ）に基づいて、ＺＭＰ補償関数を利用して、ＺＭＰ実測値をＺＭＰ仮想目標値ＺＭＰvrefまで修正するために必要な慣性力を計算し、この慣性力に応じた慣性力操作パラメータＴｃを算出する。
この慣性力操作パラメータＴｃは、ピッチ軸周りに関して、前述したＺＭＰの計算式から、次式
【数３】
ここで、κ，λ，μは、ロボットの物理量及びθｒｅｆにより決定されるパラメータである。
同様にして、ロール軸周りのＺＭＰ補償関数も導出することができる。
これにより、パラメータ生成部３８は、慣性力操作パラメータＴｃにより、ＺＭＰサンプリング間隔を仮想的に伸縮させて、ＺＭＰ目標値を実現するために必要な慣性力を生じさせるようになっている。
【００４０】
上記安定化フィルタ３９は、パラメータ生成部３８からの慣性力操作パラメータＴｃに基づいて、歩容生成部２４からの歩容データである目標角度軌道θref ，目標角速度（ｄθref ／ｄｔ）及び目標角加速度（ｄ2 θref ／ｄｔ2 ）から、各関節部の修正した目標角度軌道θｃ，目標角速度（ｄθｃ／ｄｔ）及び目標角加速度（ｄ2 θｃ／ｄｔ2 ）を算出する。
【００４１】
本発明実施形態による二脚歩行式ロボット１０は以上のように構成されており、歩行動作は、図５に示すフローチャートにより以下のように行なわれる。
図５において、先ずステップＳＴ１にて、歩容生成部２４が、入力された要求動作（Ｊ＝Ｊ）に基づいて歩容データを生成し、歩行制御装置３０のＺＭＰ補償装置３２に出力する。
次に、ステップＳＴ２にて、ＺＭＰ補償装置３２のＺＭＰ変換部３５が、この歩容データに基づいて各関節部１６Ｌ，１６Ｒ乃至２０Ｌ，２０Ｒの目標角度θref ，目標角速度（ｄθref ／ｄｔ），目標角加速度（ｄ2 θref ／ｄｔ2 ）からＺＭＰ目標値を算出する。
【００４２】
他方、ステップＳＴ３にて、双方の足部１４Ｌ，１４Ｒに備えられたＺＭＰ検出センサ２３Ｌ，２３ＲがＺＭＰ実測値を検出する。
これにより、ステップＳＴ４にて、ＺＭＰ仮想目標値生成部３７が、減算器３７ａからのＺＭＰ誤差ＺＭＰerr と、ＺＭＰ変換部３５からのＺＭＰ目標値ＺＭＰref から、ＺＭＰ仮想目標値ＺＭＰvrefを生成する。
続いて、ステップＳＴ５にて、ＺＭＰ仮想目標値生成部３７が、ＺＭＰ仮想目標値ＺＭＰvrefが補償可能限界内であるか否かを判別する。
【００４３】
そして、ステップＳＴ５にて、ＺＭＰ仮想目標値ＺＭＰvrefが補償可能限界を超えている場合には、前述したステップＳＴ４に戻って、ＺＭＰ仮想目標値生成部３７が、再びＺＭＰ仮想目標値ＺＭＰvrefを生成する。
また、ステップＳＴ５にて、ＺＭＰ仮想目標値ＺＭＰvrefが補償可能限界内である場合には、ＺＭＰ仮想目標値生成部３７が、ＺＭＰ仮想目標値ＺＭＰvrefをパラメータ生成部３８に出力する。
【００４４】
そして、ステップＳＴ６にて、パラメータ生成部３８が、このＺＭＰ仮想目標値ＺＭＰvrefと、歩容生成部２４からの歩容データによる各関節部１６Ｌ，１６Ｒ乃至２０Ｌ，２０Ｒの目標角度θref ，目標角速度（ｄθref ／ｄｔ），目標角加速度（ｄ2 θref ／ｄｔ2 ）とから、ＺＭＰ補償関数により慣性力操作パラメータＴｃを算出して、安定化フィルタ３９に出力する。
【００４５】
続いて、ステップＳＴ７にて、安定化フィルタ３９が、上記慣性力操作パラメータＴｃに基づいて、歩容生成部２４からの歩容データによる各関節部１６Ｌ，１６Ｒ乃至２０Ｌ，２０Ｒの目標角度θref ，目標角速度（ｄθref ／ｄｔ），目標角加速度（ｄ2 θref ／ｄｔ2 ）に修正を加えて、各関節部の修正した目標角度軌道θｃ，目標角速度（ｄθｃ／ｄｔ）及び目標角加速度（ｄ2 θｃ／ｄｔ2 ）を算出する。
【００４６】
次に、ステップＳＴ８にて、ＺＭＰ補償装置３２は、上述した補償した歩容データ、すなわち各関節部の修正した目標角度軌道θｃ，目標角速度（ｄθｃ／ｄｔ）及び目標角加速度（ｄ2 θｃ／ｄｔ2 ）を制御部３３に出力し、モータ制御ユニット３４が各関節部の関節駆動用モータを駆動制御する。これにより、二脚歩行式ロボット１０は要求動作に対応して歩行動作を行なうことになる。
【００４７】
その後、ステップＳＴ９にて、制御部３３が、動作カウンタインクリメントによりＪ＝Ｊ＋１として、所定のサンプリング時間になるまで待機した後、ステップＳＴ１０にて、上記Ｊが前以て決められた動作終了カウント以下の場合には再びステップ２に戻って上記動作を繰り返す。
そして、ステップＳＴ１０にて、上記Ｊが動作終了カウントを超えた場合には動作を終了する。
【００４８】
この場合、二脚歩行式ロボット１０において、各関節駆動用モータの駆動制御の際に、目標角加速度（ｄ2 θref ／ｄｔ2 ）が、修正した目標角加速度（ｄ2 θｃ／ｄｔ2 ）に変更されることにより、ロボット１０に作用する加速度が変化することになり、これに伴って、加速度の反作用としての慣性力が変化する。従って、ロボット１０に作用する慣性力が目標角加速度（ｄ2 θref ／ｄｔ2 ）の変化により適宜に制御される。これによりロボット１０は、図６に示すようにその歩行の際の動作軌跡Ａを変更することなく、動作軌跡Ｂを時間的に伸縮させることによって要求動作に対する歩行動作を行なう。
【００４９】
さらに、ＺＭＰ仮想目標値生成部３７が、ＺＭＰ目標値ＺＭＰref とＺＭＰ実測値から、一旦ＺＭＰ仮想目標値ＺＭＰvrefを生成することにより、ＺＭＰ実測値がＺＭＰ目標値から大きくずれている場合には、段階的にＺＭＰ実測値をＺＭＰ目標値に近づけるように、ＺＭＰの補償を行なうようになっている。
これにより、ＺＭＰ実測値がＺＭＰ目標値から大きくずれている場合でも、ロボット１０の各関節部に過大な角加速度が作用することがないので、ロボット１０が安定した状態で歩行を行なうことが可能である。
【００５０】
このようにして、本発明実施形態による二脚歩行式ロボット１０によれば、ＺＭＰ目標値とＺＭＰ実測値の差であるＺＭＰ誤差に基づいて、歩容データの目標角速度及び目標角加速度を修正することにより、ロボット１０に発生する慣性力を制御してＺＭＰ目標値を補償する。
従って、歩行の際の動作軌跡を変更することなく、ＺＭＰ誤差をゼロに収束させることによりロボット１０の歩行安定化を実現することができる。
【００５１】
次に、本発明による二脚歩行式ロボット１０に関するシミュレーション実験及び実機実験について説明する。
先ず、シミュレーション実験について説明する。
上述した二脚歩行式ロボット１０により、ｙｚ面内での動的足踏み動作を行なわせて、一方の支持脚による片足立ち状態から０．４２秒後に外乱を与えて、ＺＭＰに関して目標値からのずれを生じさせた。
この結果、ＺＭＰ仮想目標値生成部３７により生成されたＺＭＰ仮想目標値ＺＭＰvrefは、図７（Ａ）に示すように、０．４３秒までにはＺＭＰ目標値にほぼ完全に収束すると共に、さらに図７（Ｂ）に示すように、ＺＭＰ実測値もＺＭＰ目標値に正しく修正されていることが確認された。なお、図８において、上述したＺＭＰ補償がない場合には、ＺＭＰ目標値はＺＭＰ目標値から大きくずれたままであった。
【００５２】
実機実験では、二脚歩行式ロボット１０として、全体質量１３７０ｇ，全高３０．０ｃｍ，足部底面形状がロール方向（ｙ方向）６．０ｃｍ，ピッチ方向（ｘ方向）８．０ｃｍのロボットを使用して足踏み動作を行なわせたところ、図９に示すように、本発明によるＺＭＰ補償の場合には、ＺＭＰ補償のない場合と比較してＺＭＰ実測値がＺＭＰ目標値により近づいており、ロボットの歩行安定性が向上していることが分かった。
さらに、実機実験により、上述したシミュレーション実験の場合と同様に足踏み動作中の外乱について実験したところ、図１０に示すように、本発明によるＺＭＰ補償の場合には、ＺＭＰ実測値がＺＭＰ目標値に確実に近づいて、ＺＭＰ誤差がゼロに近づいており（図１１参照）、ロボットの歩行安定性が向上していることが分かる。
これに対して、従来のＺＭＰ補償による場合には、図１０に示すように、その後約０．５秒経過後にロボットが転倒してしまった。
【００５３】
上述した実施形態においては、実験において、ｙｚ面内における足踏み動作の場合について説明したが、これに限らず、ｘｚ面内においても同様に二脚歩行式ロボット１０の歩行安定性が向上することは明らかである。
また、上述した実施形態においては、本発明を二脚歩行式ロボットに適用した場合について説明したが、これに限らず、他の各種機器を二本足で支持すると共に、この二本足で歩行するようにした二脚歩行式移動装置に対して本発明を適用し得ることは明らかである。
【００５４】
【発明の効果】
以上述べたように、この発明によれば、ＺＭＰ検出センサにより検出したＺＭＰ実測値と、歩容データからＺＭＰ変換部により算出したＺＭＰ目標値とを比較して、ＺＭＰ補償部により歩容生成部からの歩容データの目標角速度及び目標角加速度を修正して移動装置に発生する慣性力を制御することにより、ＺＭＰ目標値を補償する。これにより、脚部及び足部の動作軌跡を変更することなく、ＺＭＰの実測誤差をゼロに収束させて、本体、好ましくはロボットの上体の安定化を図るようになっている。
従って、ＺＭＰ目標値の補償の際に、歩容データの目標角度軌道を変更することがないので、ロボット等の移動装置の本体，脚部の各部分の運動軌道が歩容データにより決められた運動軌道から外れることがない。
【００５５】
これにより、例えば移動装置が飛び石等の遊脚着地位置が決まっている場合であっても、また障害物を跨いだり、潜り抜けるような場合であっても、確実に歩行制御を行なうことが可能である。
また、ＺＭＰの補償は、歩容生成部により生成された歩容データを利用することにより行なうようになっているので、歩容データの生成手法には依存しない。従って、ＺＭＰの補償が簡略化され得る。
さらに、ＺＭＰの補償に際して、歩容データの目標角度軌道を変更することがないので、従来のような補償の際に用いた上体の傾斜を検出して上体を補償する必要がなく、簡単な構成によりＺＭＰの補償を行なうことができる。
このようにして、本発明によれば、歩容すなわち各関節部分の動作軌跡を変更せずに歩行安定性を実現できるようにした、極めて優れた二脚歩行式移動装置とその歩行制御装置及び歩行制御方法を提供することができる。
【図面の簡単な説明】
【図１】この発明による二脚歩行式ロボットの一実施形態の機械的構成を示す概略図である。
【図２】図１の二脚歩行式ロボットの電気的構成を示すブロック図である。
【図３】図１の二脚歩行式ロボットのＺＭＰ補償装置の構成を示すブロック図である。
【図４】図１に示す二脚歩行式ロボットの歩行時のｘｚ平面分離モデルを示す概略図である。
【図５】図１の二脚歩行式ロボットの歩行制御動作を示すフローチャートである。
【図６】図１の二脚歩行式ロボットにおけるＺＭＰ補償の角速度操作を示す概略図である。
【図７】図１の二脚歩行式ロボットにおけるシミュレーション実験によるＺＭＰ仮想目標値とＺＭＰ実測値を示すグラフである。
【図８】図１の二脚歩行式ロボットにおけるシミュレーション実験によるＺＭＰ目標値，ＺＭＰ実測値及びＺＭＰ補償のない場合のＺＭＰ実測値を示すグラフである。
【図９】図１の二脚歩行式ロボットにおける実機実験によるＺＭＰ目標値，ＺＭＰ実測値及びＺＭＰ補償のない場合のＺＭＰ実測値を示すグラフである。
【図１０】図１の二脚歩行式ロボットにおける他の実機実験によるＺＭＰ実測値及び従来のＺＭＰ補償による場合のＺＭＰ実測値を示すグラフである。
【図１１】図１０の実機実験の外乱作用直後の（Ａ）ＺＭＰ目標値，ＺＭＰ実測値及び、（Ｂ）ＺＭＰ誤差を示す拡大グラフである。
【符号の説明】
１０ 二脚歩行式ロボット
１１ 本体
１２Ｌ，１２Ｒ 膝部
１３Ｌ，１３Ｒ 脚部
１４Ｌ，１４Ｒ 足部
１５Ｌ，１５Ｒ乃至２０Ｌ，２０Ｒ 関節部（関節駆動用モータ）
２１Ｌ，２１Ｒ 大腿部
２２Ｌ，２２Ｒ 下腿部
２３Ｌ，２３Ｒ ＺＭＰ検出センサ
２４ 歩容生成部
３０ 歩行制御装置
３１ 角度計測ユニット
３２ ＺＭＰ補償装置
３３ 制御部
３４ モータ制御ユニット
３５ ＺＭＰ変換部
３６ ＺＭＰ補償部
３７ ＺＭＰ仮想目標値生成部
３８ パラメータ生成部
３９ 安定化フィルタ
Claims (7)
- 本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部及び足部を揺動させる駆動手段と、要求動作に対応して、目標角度軌道，目標角速度，目標角加速度を含む歩容データを生成する歩容生成部と、この歩容データに基づいて上記駆動手段を駆動制御する歩行制御装置と、を備えた二脚歩行式移動装置において、
上記歩行制御装置が、ＺＭＰ補償装置を備えており、
このＺＭＰ補償装置が、
各足部におけるＺＭＰを検出するＺＭＰ検出センサと、
歩容生成部からの歩容データに基づいて、ＺＭＰ目標値を算出するＺＭＰ変換部と、
ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して歩容生成部からの歩容データの目標角速度及び角加速度を修正することによりＺＭＰ目標値を補償するＺＭＰ補償部と、
を含んでいることを特徴とする、二脚歩行式移動装置。 - 前記本体が、人型ロボットの上体であって、頭部及び両手部を備えていることを特徴とする、請求項１に記載の二脚歩行式移動装置。
- 前記ＺＭＰ補償部が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して、ＺＭＰ仮想目標値を生成するＺＭＰ仮想目標値生成部と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成するパラメータ生成部と、パラメータ生成部からの慣性力操作パラメータに基づいて、保容データの目標角速度及び角加速度を修正する安定化フィルタと、から構成されていることを特徴とする、請求項１または２に記載の二脚歩行式移動装置。
- 本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部分を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部分及び足部を揺動させる駆動手段と、から成る二脚歩行式移動装置に関して、要求動作に対応して歩容生成部により生成される、目標角度軌道，目標角速度，目標角加速度を含む歩容データに基づいて上記駆動手段を駆動制御する、二脚歩行式移動装置の歩行制御装置において、
上記歩行制御装置が、ＺＭＰ補償装置を備えており、
このＺＭＰ補償装置が、
各足部におけるＺＭＰを検出するＺＭＰ検出センサと、
歩容生成部からの歩容データに基づいて、ＺＭＰ目標値を算出するＺＭＰ変換部と、
ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して、歩容生成部からの歩容データの目標角速度及び角加速度を修正することにより、ＺＭＰ目標値を補償するＺＭＰ補償部と、
を含んでいることを特徴とする、二脚歩行式移動装置の歩行制御装置。 - 前記ＺＭＰ補償部が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して、ＺＭＰ仮想目標値を生成するＺＭＰ仮想目標値生成部と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成するパラメータ生成部と、パラメータ生成部からのパラメータに基づいて、保容データの目標角速度及び角加速度を修正する安定化フィルタと、から構成されていることを特徴とする、請求項４に記載の二脚歩行式移動装置の歩行制御装置。
- 本体と、本体の下部両側にて二軸方向に揺動可能に取り付けられた中間に膝部分を有する二本の脚部と、各脚部の下端に二軸方向に揺動可能に取り付けられた足部と、各脚部，膝部分及び足部を揺動させる駆動手段と、から成る二脚歩行式移動装置に関して、要求動作に対応して歩容生成部により生成される、目標角度軌道，目標角速度，目標角加速度を含む歩容データに基づいて上記駆動手段を駆動制御する二脚歩行式移動装置の歩行制御方法において、
上記歩行制御方法がＺＭＰ補償を行なう際に、
ＺＭＰ検出センサにより各足部におけるＺＭＰを検出する第一の段階と、
歩容生成部からの歩容データに基づいて、ＺＭＰ変換部によりＺＭＰ目標値を算出する第二の段階と、
ＺＭＰ検出センサにより検出されたＺＭＰ実測値とＺＭＰ目標値を比較して、ＺＭＰ補償部により歩容生成部からの歩容データの目標角速度及び角加速度を修正することにより、ＺＭＰ目標値を補償する第三の段階と、
を含んでいることを特徴とする、二脚歩行式移動装置の歩行制御方法。 - 前記第三の段階が、ＺＭＰ検出センサにより検出されたＺＭＰ実測値と、ＺＭＰ変換部からのＺＭＰ目標値を比較して、ＺＭＰ仮想目標値を生成する段階と、ＺＭＰ目標値からＺＭＰ仮想目標値への補償のための慣性力操作パラメータを生成する段階と、慣性力操作パラメータに基づいて、保容データの目標角速度及び角加速度を安定化フィルタにより修正する段階と、を含んでいることを特徴とする、請求項６に記載の二脚歩行式移動装置の歩行制御方法。
Priority Applications (7)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001173262A JP3760186B2 (ja) | 2001-06-07 | 2001-06-07 | 二脚歩行式移動装置及びその歩行制御装置並びに歩行制御方法 |
| TW091111817A TW544385B (en) | 2001-06-07 | 2002-06-03 | Two-legged walking-type moving apparatus and controlling device and method thereof |
| EP02730871A EP1393866B1 (en) | 2001-06-07 | 2002-06-03 | Apparatus walking with two legs; walking control apparatus; and walking control method thereof |
| PCT/JP2002/005422 WO2002100606A1 (fr) | 2001-06-07 | 2002-06-03 | Appareil marchant sur deux jambes, et appareil et procede de commande de marche |
| DE60233566T DE60233566D1 (de) | 2001-06-07 | 2002-06-03 | Mit zwei beinen gehende vorrichtung; gehsteuervorrichtung und gehsteuerverfahren dafür |
| KR10-2003-7000964A KR100476644B1 (ko) | 2001-06-07 | 2002-06-03 | 2각 보행식 이동 장치 및 그 보행 제어 장치 및 보행 제어방법 |
| US10/450,704 US6943520B2 (en) | 2001-06-07 | 2002-06-03 | Two-legs walking type moving device, method and device for controlling its walking |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001173262A JP3760186B2 (ja) | 2001-06-07 | 2001-06-07 | 二脚歩行式移動装置及びその歩行制御装置並びに歩行制御方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2002361574A JP2002361574A (ja) | 2002-12-18 |
| JP3760186B2 true JP3760186B2 (ja) | 2006-03-29 |
Family
ID=19014753
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2001173262A Expired - Fee Related JP3760186B2 (ja) | 2001-06-07 | 2001-06-07 | 二脚歩行式移動装置及びその歩行制御装置並びに歩行制御方法 |
Country Status (7)
| Country | Link |
|---|---|
| US (1) | US6943520B2 (ja) |
| EP (1) | EP1393866B1 (ja) |
| JP (1) | JP3760186B2 (ja) |
| KR (1) | KR100476644B1 (ja) |
| DE (1) | DE60233566D1 (ja) |
| TW (1) | TW544385B (ja) |
| WO (1) | WO2002100606A1 (ja) |
Families Citing this family (97)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7390309B2 (en) * | 2002-09-23 | 2008-06-24 | Honda Motor Co., Ltd. | Human assist system using gravity compensation control system and method using multiple feasibility parameters |
| US7469166B2 (en) * | 2001-06-29 | 2008-12-23 | Honda Motor Co., Ltd. | System and method of predicting novel motion in a serial chain system |
| US7684896B2 (en) * | 2001-06-29 | 2010-03-23 | Honda Motor Co., Ltd. | System and method of estimating joint loads using an approach of closed form dynamics |
| US7650204B2 (en) * | 2001-06-29 | 2010-01-19 | Honda Motor Co., Ltd. | Active control of an ankle-foot orthosis |
| US7135003B2 (en) * | 2001-06-29 | 2006-11-14 | Honda Giken Kogyo Kabushiki Kaisha | Feedback estimation of joint forces and joint moments |
| US7623944B2 (en) * | 2001-06-29 | 2009-11-24 | Honda Motor Co., Ltd. | System and method of estimating joint loads in a three-dimensional system |
| US7217247B2 (en) * | 2002-09-23 | 2007-05-15 | Honda Giken Kogyo Kabushiki Kaisha | Gravity compensation method in a human assist system and a human assist system with gravity compensation control |
| US7774177B2 (en) * | 2001-06-29 | 2010-08-10 | Honda Motor Co., Ltd. | Exoskeleton controller for a human-exoskeleton system |
| JP4133216B2 (ja) * | 2001-10-29 | 2008-08-13 | 本田技研工業株式会社 | 人間補助装置のシミュレーション・システム、方法、およびコンピュータ・プログラム |
| JP3731118B2 (ja) * | 2002-02-18 | 2006-01-05 | 独立行政法人科学技術振興機構 | 二脚歩行式人型ロボット |
| JP3574952B2 (ja) | 2002-02-18 | 2004-10-06 | 独立行政法人 科学技術振興機構 | 二脚歩行式移動装置及びその歩行制御装置 |
| US20040064195A1 (en) | 2002-07-15 | 2004-04-01 | Hugh Herr | Variable-mechanical-impedance artificial legs |
| US7402142B2 (en) | 2002-09-23 | 2008-07-22 | Honda Giken Kogyo Kabushiki Kaisha | Method and processor for obtaining moments and torques in a biped walking system |
| JP3972854B2 (ja) * | 2003-04-10 | 2007-09-05 | ソニー株式会社 | ロボットの運動制御装置 |
| EP1649985B1 (en) * | 2003-07-11 | 2011-01-19 | Honda Motor Co., Ltd. | Method of estimating joint moment of two-legged walking mobile body |
| US8075633B2 (en) | 2003-09-25 | 2011-12-13 | Massachusetts Institute Of Technology | Active ankle foot orthosis |
| JP4485279B2 (ja) * | 2004-08-02 | 2010-06-16 | 本田技研工業株式会社 | 脚式移動ロボットの歩容生成装置および制御装置 |
| US20070162152A1 (en) | 2005-03-31 | 2007-07-12 | Massachusetts Institute Of Technology | Artificial joints using agonist-antagonist actuators |
| US20070123997A1 (en) | 2005-03-31 | 2007-05-31 | Massachusetts Institute Of Technology | Exoskeletons for running and walking |
| US10080672B2 (en) | 2005-03-31 | 2018-09-25 | Bionx Medical Technologies, Inc. | Hybrid terrain-adaptive lower-extremity systems |
| US20060249315A1 (en) | 2005-03-31 | 2006-11-09 | Massachusetts Institute Of Technology | Artificial human limbs and joints employing actuators, springs, and variable-damper elements |
| US8512415B2 (en) | 2005-03-31 | 2013-08-20 | Massachusetts Institute Of Technology | Powered ankle-foot prothesis |
| US8500823B2 (en) | 2005-03-31 | 2013-08-06 | Massachusetts Institute Of Technology | Powered artificial knee with agonist-antagonist actuation |
| US10307272B2 (en) | 2005-03-31 | 2019-06-04 | Massachusetts Institute Of Technology | Method for using a model-based controller for a robotic leg |
| US8864846B2 (en) | 2005-03-31 | 2014-10-21 | Massachusetts Institute Of Technology | Model-based neuromechanical controller for a robotic leg |
| US20070043449A1 (en) | 2005-03-31 | 2007-02-22 | Massachusetts Institute Of Technology | Artificial ankle-foot system with spring, variable-damping, and series-elastic actuator components |
| US11278433B2 (en) | 2005-03-31 | 2022-03-22 | Massachusetts Institute Of Technology | Powered ankle-foot prosthesis |
| US8082062B2 (en) * | 2005-06-10 | 2011-12-20 | Honda Motor Co., Ltd. | Regenerative actuation in motion control |
| KR100709556B1 (ko) * | 2005-10-19 | 2007-04-20 | 한국과학기술연구원 | 인간형 로봇의 보행 제어 방법 |
| KR100835354B1 (ko) * | 2006-07-05 | 2008-06-04 | 삼성전자주식회사 | 보행로봇 및 그의 제어방법 |
| JP5109573B2 (ja) | 2007-10-19 | 2012-12-26 | ソニー株式会社 | 制御システム及び制御方法、並びにロボット装置 |
| KR100958114B1 (ko) * | 2007-12-17 | 2010-05-18 | 한국과학기술연구원 | 인간형 로봇의 보행 안정화 및 자세 제어 방법 |
| KR101460140B1 (ko) | 2008-04-16 | 2014-11-11 | 삼성전자주식회사 | 휴머노이드 로봇 및 그의 제어 방법 |
| US20110082566A1 (en) | 2008-09-04 | 2011-04-07 | Herr Hugh M | Implementing a stand-up sequence using a lower-extremity prosthesis or orthosis |
| EP3219295B1 (en) | 2008-09-04 | 2023-11-15 | Otto Bock HealthCare LP | Hybrid terrain-adaptive lower-extremity systems |
| EP2448540B1 (en) | 2009-07-01 | 2019-04-24 | Rex Bionics Limited | Control system for a mobility aid |
| KR101687629B1 (ko) | 2010-01-18 | 2016-12-20 | 삼성전자주식회사 | 인간형 로봇 및 그 보행 제어방법 |
| US20110295384A1 (en) | 2010-04-05 | 2011-12-01 | Herr Hugh M | Controlling power in a prosthesis or orthosis based on predicted walking speed or surrogate for same |
| TWI478798B (zh) | 2010-06-18 | 2015-04-01 | Compal Electronics Inc | 自動機械裝置及其控制方法 |
| US8775341B1 (en) | 2010-10-26 | 2014-07-08 | Michael Lamport Commons | Intelligent control with hierarchical stacked neural networks |
| US9015093B1 (en) | 2010-10-26 | 2015-04-21 | Michael Lamport Commons | Intelligent control with hierarchical stacked neural networks |
| EP3549558B1 (en) | 2011-01-10 | 2022-03-02 | Otto Bock HealthCare LP | Powered joint orthosis |
| WO2012097156A2 (en) | 2011-01-12 | 2012-07-19 | Iwalk, Inc. | Controlling powered human augmentation devices |
| WO2012100250A1 (en) | 2011-01-21 | 2012-07-26 | Iwalk, Inc. | Terrain adaptive powered joint orthosis |
| WO2012125562A1 (en) | 2011-03-11 | 2012-09-20 | Iwalk, Inc. | Biomimetic joint actuators |
| US9566710B2 (en) | 2011-06-02 | 2017-02-14 | Brain Corporation | Apparatus and methods for operating robotic devices using selective state space training |
| WO2013067407A1 (en) | 2011-11-02 | 2013-05-10 | Iwalk, Inc. | Biomimetic transfemoral prosthesis |
| US9032635B2 (en) | 2011-12-15 | 2015-05-19 | Massachusetts Institute Of Technology | Physiological measurement device or wearable device interface simulator and method of use |
| KR20130078886A (ko) * | 2012-01-02 | 2013-07-10 | 현대자동차주식회사 | 보행로봇의 균형제어방법 |
| KR20140126783A (ko) | 2012-01-31 | 2014-11-03 | 가부시키가이샤 다까라토미 | 로봇 완구 |
| US9221177B2 (en) | 2012-04-18 | 2015-12-29 | Massachusetts Institute Of Technology | Neuromuscular model-based sensing and control paradigm for a robotic leg |
| WO2013188510A2 (en) | 2012-06-12 | 2013-12-19 | Iwalk, Inc. | Prosthetic, orthotic or exoskeleton device |
| US9764468B2 (en) | 2013-03-15 | 2017-09-19 | Brain Corporation | Adaptive predictor apparatus and methods |
| US9242372B2 (en) * | 2013-05-31 | 2016-01-26 | Brain Corporation | Adaptive robotic interface apparatus and methods |
| US9384443B2 (en) | 2013-06-14 | 2016-07-05 | Brain Corporation | Robotic training apparatus and methods |
| US9314924B1 (en) | 2013-06-14 | 2016-04-19 | Brain Corporation | Predictive robotic controller apparatus and methods |
| US9792546B2 (en) | 2013-06-14 | 2017-10-17 | Brain Corporation | Hierarchical robotic controller apparatus and methods |
| US9436909B2 (en) | 2013-06-19 | 2016-09-06 | Brain Corporation | Increased dynamic range artificial neuron network apparatus and methods |
| US9579789B2 (en) | 2013-09-27 | 2017-02-28 | Brain Corporation | Apparatus and methods for training of robotic control arbitration |
| US9296101B2 (en) | 2013-09-27 | 2016-03-29 | Brain Corporation | Robotic control arbitration apparatus and methods |
| US9463571B2 (en) | 2013-11-01 | 2016-10-11 | Brian Corporation | Apparatus and methods for online training of robots |
| US9597797B2 (en) | 2013-11-01 | 2017-03-21 | Brain Corporation | Apparatus and methods for haptic training of robots |
| US9248569B2 (en) | 2013-11-22 | 2016-02-02 | Brain Corporation | Discrepancy detection apparatus and methods for machine learning |
| US9358685B2 (en) | 2014-02-03 | 2016-06-07 | Brain Corporation | Apparatus and methods for control of robot actions based on corrective user inputs |
| US9346167B2 (en) | 2014-04-29 | 2016-05-24 | Brain Corporation | Trainable convolutional network apparatus and methods for operating a robotic vehicle |
| US10081098B1 (en) | 2014-08-25 | 2018-09-25 | Boston Dynamics, Inc. | Generalized coordinate surrogates for integrated estimation and control |
| US9618937B1 (en) | 2014-08-25 | 2017-04-11 | Google Inc. | Slip detection using robotic limbs |
| US9387588B1 (en) | 2014-08-25 | 2016-07-12 | Google Inc. | Handling gait disturbances with asynchronous timing |
| CN105437236A (zh) * | 2014-08-30 | 2016-03-30 | 赵德朝 | 一种仿人工程机器人 |
| US9630318B2 (en) | 2014-10-02 | 2017-04-25 | Brain Corporation | Feature detection apparatus and methods for training of robotic navigation |
| JP6228097B2 (ja) * | 2014-10-06 | 2017-11-08 | 本田技研工業株式会社 | 移動ロボット |
| US9446518B1 (en) * | 2014-11-11 | 2016-09-20 | Google Inc. | Leg collision avoidance in a robotic device |
| US9499218B1 (en) | 2014-12-30 | 2016-11-22 | Google Inc. | Mechanically-timed footsteps for a robotic device |
| US9717387B1 (en) | 2015-02-26 | 2017-08-01 | Brain Corporation | Apparatus and methods for programming and training of robotic household appliances |
| US9594377B1 (en) | 2015-05-12 | 2017-03-14 | Google Inc. | Auto-height swing adjustment |
| US9586316B1 (en) | 2015-09-15 | 2017-03-07 | Google Inc. | Determination of robotic step path |
| JP2017144512A (ja) * | 2016-02-17 | 2017-08-24 | 国立大学法人 東京大学 | Ｚｍｐの算出方法及び装置 |
| US9789919B1 (en) | 2016-03-22 | 2017-10-17 | Google Inc. | Mitigating sensor noise in legged robots |
| US10179619B1 (en) * | 2016-03-30 | 2019-01-15 | Schaft Inc. | Robotic foot sensor |
| US10241514B2 (en) | 2016-05-11 | 2019-03-26 | Brain Corporation | Systems and methods for initializing a robot to autonomously travel a trained route |
| US9987752B2 (en) | 2016-06-10 | 2018-06-05 | Brain Corporation | Systems and methods for automatic detection of spills |
| US10282849B2 (en) | 2016-06-17 | 2019-05-07 | Brain Corporation | Systems and methods for predictive/reconstructive visual object tracker |
| US10016896B2 (en) | 2016-06-30 | 2018-07-10 | Brain Corporation | Systems and methods for robotic behavior around moving bodies |
| US10274325B2 (en) | 2016-11-01 | 2019-04-30 | Brain Corporation | Systems and methods for robotic mapping |
| US10001780B2 (en) | 2016-11-02 | 2018-06-19 | Brain Corporation | Systems and methods for dynamic route planning in autonomous navigation |
| US10723018B2 (en) | 2016-11-28 | 2020-07-28 | Brain Corporation | Systems and methods for remote operating and/or monitoring of a robot |
| US10377040B2 (en) | 2017-02-02 | 2019-08-13 | Brain Corporation | Systems and methods for assisting a robotic apparatus |
| US10852730B2 (en) | 2017-02-08 | 2020-12-01 | Brain Corporation | Systems and methods for robotic mobile platforms |
| US10293485B2 (en) | 2017-03-30 | 2019-05-21 | Brain Corporation | Systems and methods for robotic path planning |
| CN108549237B (zh) * | 2018-05-16 | 2020-04-28 | 华南理工大学 | 基于深度增强学习的预观控制仿人机器人步态规划方法 |
| CN109634100B (zh) * | 2018-12-30 | 2021-11-02 | 深圳市优必选科技有限公司 | 仿人机器人行走加速度补偿方法、装置及仿人机器人 |
| CN110743176B (zh) * | 2019-10-12 | 2021-11-12 | 湖北工业大学 | 户外避障式节拍双轮领跑机器人 |
| CN112975941B (zh) * | 2019-12-13 | 2022-06-24 | 深圳市优必选科技股份有限公司 | 机器人控制方法、装置、计算机可读存储介质及机器人 |
| CN112034847B (zh) * | 2020-08-13 | 2021-04-13 | 广州仿真机器人有限公司 | 具有双行走模式的分体式仿真机器人的避障方法和装置 |
| CN112643679B (zh) * | 2020-12-30 | 2022-07-08 | 乐聚(深圳)机器人技术有限公司 | 机器人运动控制方法、装置、控制器及存储介质 |
| CN113618740B (zh) * | 2021-08-24 | 2022-07-29 | 深圳市优必选科技股份有限公司 | 双足机器人舞蹈平衡控制方法、装置和双足机器人 |
| DE102022107587A1 (de) | 2022-03-30 | 2023-10-05 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Verfahren zur Gangsteuerung eines Roboters, Regler, Computerprogramm und Robotersystem |
Family Cites Families (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5355064A (en) * | 1992-03-04 | 1994-10-11 | Honda Giken Kogyo Kabushiki Kaisha | Control system for legged mobile robot |
| JP3167420B2 (ja) | 1992-04-30 | 2001-05-21 | 本田技研工業株式会社 | 脚式移動ロボットの歩行制御装置 |
| US5432417A (en) | 1992-04-30 | 1995-07-11 | Honda Giken Kogyo Kabushiki Kaisha | Locomotion control system for legged mobile robot |
| JP3269852B2 (ja) * | 1992-05-29 | 2002-04-02 | 本田技研工業株式会社 | 脚式移動ロボットの姿勢安定化制御装置 |
| US5808433A (en) * | 1995-09-29 | 1998-09-15 | Honda Giken Kogyo Kabushiki Kaisha | Method of generating gait of legged walking robot and system for controlling its locomotion |
| JP4279416B2 (ja) * | 1999-08-30 | 2009-06-17 | 本田技研工業株式会社 | ２足歩行ロボット |
| JP4660870B2 (ja) | 1999-11-08 | 2011-03-30 | ソニー株式会社 | 脚式移動ロボット及びその制御方法 |
| JP3634238B2 (ja) * | 2000-05-19 | 2005-03-30 | 本田技研工業株式会社 | 脚式移動ロボットの床形状推定装置 |
| EP1361027B1 (en) * | 2000-11-17 | 2007-01-17 | Honda Giken Kogyo Kabushiki Kaisha | Gait pattern generating device for legged mobile robot |
| TW499349B (en) * | 2000-11-17 | 2002-08-21 | Sony Corp | Legged mobile robot, leg structure of legged mobile robot, and mobile leg unit for legged mobile robot |
| US6961640B2 (en) * | 2000-11-17 | 2005-11-01 | Sony Corporation | Motion control for a legged robot |
| JP3726032B2 (ja) * | 2001-04-27 | 2005-12-14 | 本田技研工業株式会社 | 脚式移動ロボットの目標運動生成装置 |
| KR100937268B1 (ko) * | 2001-08-01 | 2010-01-18 | 소니 주식회사 | 다리식 이동 로봇 및 그 동작 제어 방법 |
| JP3603279B2 (ja) * | 2001-09-26 | 2004-12-22 | 独立行政法人科学技術振興機構 | 二脚歩行式人型ロボット |
| JP3888294B2 (ja) * | 2002-11-26 | 2007-02-28 | トヨタ自動車株式会社 | Ｚｍｐ補償制御のゲインを変化させながら歩行するロボット |
| JP3972854B2 (ja) * | 2003-04-10 | 2007-09-05 | ソニー株式会社 | ロボットの運動制御装置 |
-
2001
- 2001-06-07 JP JP2001173262A patent/JP3760186B2/ja not_active Expired - Fee Related
-
2002
- 2002-06-03 DE DE60233566T patent/DE60233566D1/de not_active Expired - Lifetime
- 2002-06-03 US US10/450,704 patent/US6943520B2/en not_active Expired - Fee Related
- 2002-06-03 TW TW091111817A patent/TW544385B/zh active
- 2002-06-03 EP EP02730871A patent/EP1393866B1/en not_active Expired - Lifetime
- 2002-06-03 WO PCT/JP2002/005422 patent/WO2002100606A1/ja active IP Right Grant
- 2002-06-03 KR KR10-2003-7000964A patent/KR100476644B1/ko not_active IP Right Cessation
Also Published As
| Publication number | Publication date |
|---|---|
| TW544385B (en) | 2003-08-01 |
| EP1393866B1 (en) | 2009-09-02 |
| KR20030029788A (ko) | 2003-04-16 |
| EP1393866A1 (en) | 2004-03-03 |
| KR100476644B1 (ko) | 2005-03-17 |
| WO2002100606A1 (fr) | 2002-12-19 |
| US6943520B2 (en) | 2005-09-13 |
| EP1393866A4 (en) | 2006-05-10 |
| DE60233566D1 (de) | 2009-10-15 |
| US20040051493A1 (en) | 2004-03-18 |
| JP2002361574A (ja) | 2002-12-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3760186B2 (ja) | 二脚歩行式移動装置及びその歩行制御装置並びに歩行制御方法 | |
| JP3629133B2 (ja) | 脚式移動ロボットの制御装置 | |
| EP1053835B1 (en) | Leg type mobile robot control apparatus | |
| US7715944B2 (en) | Gait generating device of mobile robot | |
| JP4912891B2 (ja) | 脚式移動ロボットおよびその制御プログラム | |
| JP3278467B2 (ja) | 移動ロボットの制御装置 | |
| JP5053644B2 (ja) | 脚式移動ロボットおよびその制御プログラム | |
| JPH05337849A (ja) | 脚式移動ロボットの姿勢安定化制御装置 | |
| JP5071140B2 (ja) | 脚式ロボット、及びその制御方法 | |
| JP2003236783A (ja) | 二脚歩行式移動装置 | |
| US7801643B2 (en) | Legged mobile robot and control program for the robot | |
| JPH05305579A (ja) | 脚式移動ロボットの歩行制御装置 | |
| JP3598507B2 (ja) | 歩行式移動装置及びその歩行制御装置及び歩行制御方法 | |
| JPH05305586A (ja) | 脚式移動ロボットの歩行制御装置 | |
| JP3024028B2 (ja) | 脚式移動ロボットの歩行制御装置 | |
| JP2009107033A (ja) | 脚式移動ロボット及びその制御方法 | |
| JP3627057B2 (ja) | 二脚歩行式人型ロボット | |
| JP3726097B2 (ja) | 脚式移動ロボットの姿勢制御装置 | |
| JP3760198B2 (ja) | 歩行式移動装置及びその歩行制御装置及び歩行制御方法 | |
| JP2009255231A (ja) | 歩行制御装置および歩行制御方法 | |
| JP3569767B2 (ja) | 歩行式ロボット | |
| JP4237130B2 (ja) | 脚式移動ロボットの制御装置 | |
| JP4946566B2 (ja) | 歩行ロボット及び歩行制御方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A712 Effective date: 20031031 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20031210 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050308 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050506 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20051129 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20051130 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 3760186 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100120 Year of fee payment: 4 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100120 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110120 Year of fee payment: 5 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120120 Year of fee payment: 6 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120120 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130120 Year of fee payment: 7 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140120 Year of fee payment: 8 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |