JP3646169B2 - 脚式ロボットの歩行制御装置 - Google Patents
脚式ロボットの歩行制御装置 Download PDFInfo
- Publication number
- JP3646169B2 JP3646169B2 JP2002131120A JP2002131120A JP3646169B2 JP 3646169 B2 JP3646169 B2 JP 3646169B2 JP 2002131120 A JP2002131120 A JP 2002131120A JP 2002131120 A JP2002131120 A JP 2002131120A JP 3646169 B2 JP3646169 B2 JP 3646169B2
- Authority
- JP
- Japan
- Prior art keywords
- coordinate system
- control device
- grounding leg
- walking
- legs
- 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 - Lifetime
Links
- 238000006243 chemical reaction Methods 0.000 claims description 13
- 238000010586 diagram Methods 0.000 description 7
- 239000011159 matrix material Substances 0.000 description 4
- 230000009466 transformation Effects 0.000 description 4
- 238000010276 construction Methods 0.000 description 3
- 210000003108 foot joint Anatomy 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000000034 method Methods 0.000 description 2
- 239000000758 substrate Substances 0.000 description 2
- 230000005283 ground state Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Manipulator (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、脚式ロボットの歩行制御装置に関し、具体的には、脚式ロボットにおける姿勢を安定制御できる制御装置を備えた歩行制御装置に関するものである。
【０００２】
【従来の技術】
従来における脚式移動ロボットの制御装置は、例えば、特開平１１−３００６６０号公報に記載されているように、脚式移動ロボットの進行方向を１軸に持つ直交座標系（進行方向座標系）を基準として、安定制御系が設計されて、例えば、歩行制御装置が作成されている。
【０００３】
従来においては、脚式ロボットの歩行パターンは、進行方向制御系で設計されてきたことから、当然ながら、進行方向制御系を用いて制御系が設計され、安定制御系の制御装置が作られてきた。このような進行方向制御系は、人間の直感に合致することから、進行方向制御系での制御系の構築は、システムの設計手法からは妥当なものであった。
【０００４】
【発明が解決しようとする課題】
しかしながら、進行方向制御系で設計された制御装置では、例えば、脚式移動ロボットにおいて、接地脚の移動に伴って、必然的に安定な歩行制御系を構築することは困難である。すなわち、脚式ロボットが歩行する場合において、例えば、二足歩行する場合においては、その歩行状態により姿勢が変化し、姿勢変化により制御パラメータが変動するばかりか、時々刻々変化する姿勢によって、脚部のリンク構造から、必然的にロボット身体の剛性が変化することになり、制御系が発振してしまうこともある。このため、多種多様な歩行パターンに対して安定した歩行制御系を構築することは困難であった。
【０００５】
このため、安定した歩行制御系を構築するには、頻繁に試行錯誤的に制御系のパラメータ調整が必要であった。例えば、進行方向座標系において歩行パターンの安定した制御系を構築するためには、制御信号の入力に重み付けを行い、制御系の剛性を落として発振を回避しながら制御系を構成することになるが、この場合には、逆に制御系の特性を所望の特性に設定することが困難であるという問題点があった。
【０００６】
本発明は、このような問題点を解決するためになされたものであり、本発明の目的は、脚式ロボットにおける姿勢を安定制御するための制御装置を備えた歩行制御装置を提供することにある。
【０００７】
【課題を解決するための手段】
上記のような目的を達成するため、本発明による脚式ロボットの歩行制御装置は、基本的な構成として、脚式ロボットの歩行制御装置において、検出された接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系（以下、足裏座標系と称す）を歩行制御のための制御座標系として歩行制御を行う制御装置を備える。
【０００８】
本発明の脚式ロボットの歩行制御装置は、具体的には、制御座標系の基準位置となる足裏位置を検出する足裏位置センサを備えている。この足裏位置センサは、例えば、関節の回転角を検出する回転角センサと、リンク形状データから、運動学を用いて、足裏位置を算出する構成でも良い。また、接地脚の状態を検出する接地脚センサもしくは接地脚の状態を生成する動作生成装置を備え、検出した足裏位置および状態に応じて接地脚の位置を基準にした座標系を歩行制御のための制御座標系として歩行制御を行う制御装置と、前記制御装置により制御される脚部アクチュエータとを備える。
【０００９】
また、本発明による脚式ロボットの歩行制御装置において、制御装置は、足裏座標系において制御パラメータの入力を行い、入力した制御パラメータにより制御特性を設定する。この場合に、接地状態センサもしくは動作生成装置により検出された接地脚の状況に対応して制御特性を変更する。また、座標変換手段を備え、足裏座標系での制御特性を、センサ自身が内蔵している座標系であるセンサ座標系、脚式ロボットが進行する方向を基準にした座標系である進行方向座標系、または脚式ロボットのボディーを基準にした座標系であるボディー座標系のいずれかに変換して制御パラメータを得る。これにより、脚式ロボットが進行する方向を基準にした座標系（以下、進行方向座標系と称す）、もしくは脚式ロボットのボディーを基準にした座標系（以下、ボディー座標系と称す）などに換算して制御を行うことができる。このように、接地脚の状況により、座標系が変更された座標系で、その制御特性を動的に変更し、安定制御を行うようにすることで、脚式ロボットの歩行制御安定性が向上する。
【００１０】
すなわち、本発明による脚式ロボットの歩行制御装置においては、制御装置は、歩行状態（例えば、接地脚の状況）により制御装置自体をを切り替えるのではなく、接地状態センサもしくは動作生成装置により検出された接地脚の状況により、制御装置の制御特性を変更する。
【００１１】
また、本発明の脚式ロボットの歩行制御装置において、制御装置は、センサ自身が内蔵している座標系（以下、センサ座標系）において検出したセンサ情報を、接地脚の位置を基準にした座標系（以下、足裏座標系と称す）に変換する座標変換手段、進行方向座標系において記述された動作パターン情報を、接地脚の位置を基準にした座標系（以下、足裏座標系と称す）に変換する座標変換手段を備え、また、足裏座標系において生成された制御信号を、他の座標系（例えば、センサ座標系、進行方向座標系、ボディー座標系）の信号に変換して歩行制御を行う。
【００１２】
脚式ロボットにおいては、歩行姿勢により制御パラメータ変動が起き、また、歩行の姿勢によりロボットの剛性が変化する。例えば、具体的に二足歩行ロボットを例として説明すると、両脚の足裏を結ぶ方向には、両脚により閉リンク構造ができているため剛性が高く、倒れがたいものとなっている。一方、この両脚の足裏を結ぶ方向に直交する方向については、両脚による閉リンク構造を構成しないため、脚式ロボットの歩行姿勢について剛性が低く、倒れやすいものとなっている。
【００１３】
そこで、本発明による脚式ロボットの歩行制御装置においては、歩行姿勢の制御を行う歩行制御系を、脚式ロボットの歩行制御に適した座標系として、足裏位置を基準にした座標系（足裏座標系）を用いる。この足裏座標系を用いて歩行制御を行う制御装置を備え、脚式ロボットの歩行制御装置を構成する。例えば、前述した接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系を用いて、歩行制御系を設計・構築する。これにより、歩行姿勢において安定した制御系を設計・構築することができる。
【００１４】
また、本発明の歩行制御装置においては、足裏座標系を用いて歩行制御を行うので、このため、足裏座標系に座標変換を行う座標変換手段を備えて、例えば、センサ座標系でのセンサ情報や進行方向座標系で記述された歩行パターン等については、足裏座標系に座標変換し、また、足裏座標系において生成された制御信号から逆変換を行い、進行方向座標系で記述された歩行パターンを実現する制御系を設計・構築する。これにより、所望の特性をもった制御系の設計・構築が容易に実現できる。
【００１５】
【発明の実施の形態】
以下、本発明を実施する場合の形態について、図面を参照して説明する。図１は、本発明を一態様で実施する脚式ロボットの脚部の構造を概略的に説明する図であり、また、図２は、脚式ロボットの歩行制御を行う場合についての接地脚の位置の状態を説明する図である。図１および図２において、１は左足、２は右足、２ａは右足の上板基板、２ｂは右足の接地基板、３は足部を構成する低剛性部材、４は足部関節設置部、５は姿勢制御装置、６ａは第１脚部，６ｂは第２脚部、７はロボット本体部、８ａは第１の関節モータ，８ｂは第２の関節モータ、８ｃは第３の関節モータである。なお、図示されないが、左足１および右足２には、それぞれ低剛性部材３の中に接地状態センサとして機能する圧力センサが設けられている。また、左足１および右足２の位置は、図示しない姿勢センサ、ならびに、関節角度センサ等から構成される足裏位置を検出する足裏位置センサにより、初期設定位置から歩行制御を行って動作させたロボットの脚部（６ａ〜６ｂ，８ａ〜８ｃ）の移動位置が算出されて求められる。また、図示されないが、姿勢制御装置５の中には、座標変換を行い、制御データ等を生成し、脚部アクチュエータに対して制御信号を出力するコンピュータ装置が設けられている。
【００１６】
脚式ロボットの歩行制御については、ロボット本体部７に設けられた姿勢制御装置５が、ロボットの脚部（６ａ〜６ｂ，８ａ〜８ｃ）を動作させて、つまり、脚部アクチュエータを制御して、左足１および右足２を動作させて、歩行パターンにしたがって歩行制御を行う。また、機能的には、脚部の状態を生成して制御を行う動作生成装置からの制御信号により、脚部アクチュエータを制御して、左足１および右足２を動作させて、歩行パターンにしたがって歩行制御を行う。
【００１７】
脚式ロボットの歩行制御を行う場合、脚式ロボットにおいては、歩行姿勢によりパラメータ変動が起きる。また、歩行の姿勢によっては、ロボット本体部７のメカニカルな剛性が変化する。すなわち、二足歩行ロボットの歩行姿勢については、図２に示すように、接地脚について、両脚（左足１および右足２）の足裏を結ぶ方向（以下、長手方向と称す）には、両脚により閉リンク構造ができているため剛性が高く、倒れがたい状態となっており、また、この長手方向に直交する方向（以下、短手方向と称す）については、両脚による閉リンク構造を構成しないため、剛性が低く、倒れやすいものとなっている。
【００１８】
このため、脚式ロボットの歩行制御における安定制御では、この長手方向および短手方法のそれぞれについて、異なる制御特性を持たせて制御系を設定する。二足歩行ロボットにおいては、上述したように方向（長手方向および短手方向）に応じてのそれぞれの特性があり、これが変化する。そこで、二足歩行ロボットの歩行制御系としては、図３に示すように、接地脚の位置を基準とした直交座標系である足裏座標系を設定し、歩行制御を行う。この足裏座標系は、脚式ロボットを歩行させた場合、接地脚の位置において足裏座標系の座標軸が動的に変化する。このため、歩行制御を行うについては、制御を行うタイミングに応じて、接地脚（左足１および右足２）の位置を検出し、この検出した接地脚の位置に基づいて、足裏座標系を設定し、その足裏座標系に従って歩行制御を行う。姿勢制御では、図４に示すように、長手方向軸まわりの転倒に対しては、強い踏ん張り力で姿勢を復帰するように制御を行う。一方、短手方向軸まわりの転倒に対しては、両足間隔が広い（長い）ことから、弱い踏ん張り力でも、目標ＺＭＰ回りのモーメントを稼げるため、弱い踏ん張り力で姿勢を復帰させるように制御を行う。
【００１９】
また、歩行制御において片脚支持の状態が介在するが、この場合においても、次に説明するように、制御装置を切り替えることなく、両脚支持状態での制御と全く同じに、足裏座標系を設定し、その足裏座標系に従って歩行制御を行う。つまり、片脚の状態においては、図５に示すように、その剛性については、前述した長手方向および短手方向のいずれの方向についても弱いので、これらの方向とも、強い踏ん張り力で姿勢を復帰するように制御を行う。
【００２０】
より具体的には、足裏座標系に基づく姿勢制御に関して説明を行うと、傾いたロボットの胴体を復帰させるため、接地脚の足裏による踏ん張り力により姿勢を復帰しているが、物理的には、足裏から床面に対する補償モーメントを発生することにより姿勢の復帰を行う。前述のように、接地脚の状況により長手方向と短手方向の剛性が異なるため、異方性を持たせて（方向により異なる制御特性を持たせて）、制御系を設計し構築する。その制御系は、例えば、（式１）に示されるように、足裏座標系の各軸が非干渉化された線形システムの制御系を構成し、補償モーメントを発生させる。
【数１】
ここで、
左上の添え字Ｆ：足裏座標系を意味する
Ｍ：復帰モーメントベクトル
Δθ：胴体の傾きベクトル
Ｋｐ：胴体の傾きの比例ゲイン
Ｋｖ：胴体の傾きの速度ゲイン
Ｂ：踏ん張り力を決定する重み行列（図４）
である。
なお、この重み行列は、２×２行列の場合、具体的には、
【数２】
ただし、ｂは０以上１以下の数値で、長手方向軸まわりの強い踏ん張り力を１とした時の短手方向の踏ん張り力の割合を意味する。
【００２１】
一方、胴体の傾きを検出するセンサ等のフィードバックに使用するセンサは、両脚の位置関係により軸方向が可変となる足裏座標系で検出される訳ではなく、通常、胴体等に固定されたセンサ座標系で検出される。したがって、（式１）における変数の胴体の傾きΔθは、（式３−１）および（式３−２）に示すような「センサ座標系→足裏座標系」間の座標変換を行い算出する。
【数３】
ここで、
左上の添え字S：センサ座標系を意味する
R：座標変換を表す記号で、Rの左下の添え字で表記された座標系データを、Rの左上の添え字で表記された座標系データに変換する座標変換行列
【００２２】
一方、歩行パターンは、通常、足裏座標系とは異なる座標系、例えば、ボディー座標系で記述されている。したがって、安定で所望な制御系を構築するためには、（式１）により算出された足裏座標系での補償信号を、（式４）に示すようにボディー座標系の信号に座標変換を行い、最終的には歩行パターンに補償を加え制御を行う。
【数４】
【００２３】
以上をまとめると、次の（式５）に示される制御系を構成して、ボディー座標系における補償モーメントを発生させるようにする。
【数５】
この（式５）から分かるように、ボディー座標系で考えた場合、歩行姿勢によりゲインが可変となり、多種多様な歩行パターンに対して、（式１）で表現される所望の制御系を、安定に構築することができる。
【００２４】
また、脚式ロボットの歩行制御の場合には、接地脚の状態によりモード切り替える場合が多いが、モード切替は制御システムを複雑にするばかりか、時には、不安定な制御系を構成することになる。そのため、ここでは、（式２）における重み付けを連続的に変えることにより、これに対応して制御系を構成する。具体例として、二足歩行ロボットを例にして説明すると、図５に示すように、片脚支持期については、全ての方向に対して、「強い足裏による踏ん張り力」が必要であるので、（式１）により算出される復帰モーメントを不連続に変化させると、場合によっては、転倒に至る時がある。このため、連続して変化させる必要がある。そこで、接地脚の状態を検出する接地脚センサ、もしくは接地脚の状態を生成する動作生成装置による歩行パターンから、片脚支持期または両脚支持期の判別を行い、この判別に基づき（式２）で与えられる「重みｂ」を連続的に変化させて、片脚支持期においては「ｂ＝１」となるようにする。
【００２５】
以上、説明したように、本発明よる歩行制御装置においては、足裏座標系を用いて歩行制御を行うようにしているので、足裏座標系に座標変換を行うための座標変換手段を備え、例えば、センサ座標系でのセンサ情報や進行方向座標系で記述された歩行パターン等については、足裏座標系に座標変換し、もしくは足裏座標系から逆変換を行い、歩行パターン等を用いた方向制御を行う制御系を設計して構築する。これにより、所望の特性をもった制御系の設計および構築が容易に実現できる。
【図面の簡単な説明】
【図１】本発明を一態様で実施する脚式ロボットの脚部の構造を概略的に説明する図である。
【図２】脚式ロボットの歩行制御を行う場合について接地脚の位置の状態を説明する図である。
【図３】本発明にかかる足裏座標系を説明する図である。
【図４】足裏座標系による異方向性を持つ復帰モーメントを説明する図である。
【図５】片脚支持期における足裏座標系の復帰モーメントを説明する図である。
【符号の説明】
１…左足
２…右足
２ａ…右足の上板基板
２ｂ…右足の接地基板
３…足部を構成する低剛性部材
４…足部関節設置部
５…姿勢制御装置
６ａ…第１脚部
６ｂ…第２脚部
７…ロボット本体部
８ａ…第１の関節モータ
８ｂ…第２の関節モータ
８ｃ…第３の関節モータ
【発明の属する技術分野】
本発明は、脚式ロボットの歩行制御装置に関し、具体的には、脚式ロボットにおける姿勢を安定制御できる制御装置を備えた歩行制御装置に関するものである。
【０００２】
【従来の技術】
従来における脚式移動ロボットの制御装置は、例えば、特開平１１−３００６６０号公報に記載されているように、脚式移動ロボットの進行方向を１軸に持つ直交座標系（進行方向座標系）を基準として、安定制御系が設計されて、例えば、歩行制御装置が作成されている。
【０００３】
従来においては、脚式ロボットの歩行パターンは、進行方向制御系で設計されてきたことから、当然ながら、進行方向制御系を用いて制御系が設計され、安定制御系の制御装置が作られてきた。このような進行方向制御系は、人間の直感に合致することから、進行方向制御系での制御系の構築は、システムの設計手法からは妥当なものであった。
【０００４】
【発明が解決しようとする課題】
しかしながら、進行方向制御系で設計された制御装置では、例えば、脚式移動ロボットにおいて、接地脚の移動に伴って、必然的に安定な歩行制御系を構築することは困難である。すなわち、脚式ロボットが歩行する場合において、例えば、二足歩行する場合においては、その歩行状態により姿勢が変化し、姿勢変化により制御パラメータが変動するばかりか、時々刻々変化する姿勢によって、脚部のリンク構造から、必然的にロボット身体の剛性が変化することになり、制御系が発振してしまうこともある。このため、多種多様な歩行パターンに対して安定した歩行制御系を構築することは困難であった。
【０００５】
このため、安定した歩行制御系を構築するには、頻繁に試行錯誤的に制御系のパラメータ調整が必要であった。例えば、進行方向座標系において歩行パターンの安定した制御系を構築するためには、制御信号の入力に重み付けを行い、制御系の剛性を落として発振を回避しながら制御系を構成することになるが、この場合には、逆に制御系の特性を所望の特性に設定することが困難であるという問題点があった。
【０００６】
本発明は、このような問題点を解決するためになされたものであり、本発明の目的は、脚式ロボットにおける姿勢を安定制御するための制御装置を備えた歩行制御装置を提供することにある。
【０００７】
【課題を解決するための手段】
上記のような目的を達成するため、本発明による脚式ロボットの歩行制御装置は、基本的な構成として、脚式ロボットの歩行制御装置において、検出された接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系（以下、足裏座標系と称す）を歩行制御のための制御座標系として歩行制御を行う制御装置を備える。
【０００８】
本発明の脚式ロボットの歩行制御装置は、具体的には、制御座標系の基準位置となる足裏位置を検出する足裏位置センサを備えている。この足裏位置センサは、例えば、関節の回転角を検出する回転角センサと、リンク形状データから、運動学を用いて、足裏位置を算出する構成でも良い。また、接地脚の状態を検出する接地脚センサもしくは接地脚の状態を生成する動作生成装置を備え、検出した足裏位置および状態に応じて接地脚の位置を基準にした座標系を歩行制御のための制御座標系として歩行制御を行う制御装置と、前記制御装置により制御される脚部アクチュエータとを備える。
【０００９】
また、本発明による脚式ロボットの歩行制御装置において、制御装置は、足裏座標系において制御パラメータの入力を行い、入力した制御パラメータにより制御特性を設定する。この場合に、接地状態センサもしくは動作生成装置により検出された接地脚の状況に対応して制御特性を変更する。また、座標変換手段を備え、足裏座標系での制御特性を、センサ自身が内蔵している座標系であるセンサ座標系、脚式ロボットが進行する方向を基準にした座標系である進行方向座標系、または脚式ロボットのボディーを基準にした座標系であるボディー座標系のいずれかに変換して制御パラメータを得る。これにより、脚式ロボットが進行する方向を基準にした座標系（以下、進行方向座標系と称す）、もしくは脚式ロボットのボディーを基準にした座標系（以下、ボディー座標系と称す）などに換算して制御を行うことができる。このように、接地脚の状況により、座標系が変更された座標系で、その制御特性を動的に変更し、安定制御を行うようにすることで、脚式ロボットの歩行制御安定性が向上する。
【００１０】
すなわち、本発明による脚式ロボットの歩行制御装置においては、制御装置は、歩行状態（例えば、接地脚の状況）により制御装置自体をを切り替えるのではなく、接地状態センサもしくは動作生成装置により検出された接地脚の状況により、制御装置の制御特性を変更する。
【００１１】
また、本発明の脚式ロボットの歩行制御装置において、制御装置は、センサ自身が内蔵している座標系（以下、センサ座標系）において検出したセンサ情報を、接地脚の位置を基準にした座標系（以下、足裏座標系と称す）に変換する座標変換手段、進行方向座標系において記述された動作パターン情報を、接地脚の位置を基準にした座標系（以下、足裏座標系と称す）に変換する座標変換手段を備え、また、足裏座標系において生成された制御信号を、他の座標系（例えば、センサ座標系、進行方向座標系、ボディー座標系）の信号に変換して歩行制御を行う。
【００１２】
脚式ロボットにおいては、歩行姿勢により制御パラメータ変動が起き、また、歩行の姿勢によりロボットの剛性が変化する。例えば、具体的に二足歩行ロボットを例として説明すると、両脚の足裏を結ぶ方向には、両脚により閉リンク構造ができているため剛性が高く、倒れがたいものとなっている。一方、この両脚の足裏を結ぶ方向に直交する方向については、両脚による閉リンク構造を構成しないため、脚式ロボットの歩行姿勢について剛性が低く、倒れやすいものとなっている。
【００１３】
そこで、本発明による脚式ロボットの歩行制御装置においては、歩行姿勢の制御を行う歩行制御系を、脚式ロボットの歩行制御に適した座標系として、足裏位置を基準にした座標系（足裏座標系）を用いる。この足裏座標系を用いて歩行制御を行う制御装置を備え、脚式ロボットの歩行制御装置を構成する。例えば、前述した接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系を用いて、歩行制御系を設計・構築する。これにより、歩行姿勢において安定した制御系を設計・構築することができる。
【００１４】
また、本発明の歩行制御装置においては、足裏座標系を用いて歩行制御を行うので、このため、足裏座標系に座標変換を行う座標変換手段を備えて、例えば、センサ座標系でのセンサ情報や進行方向座標系で記述された歩行パターン等については、足裏座標系に座標変換し、また、足裏座標系において生成された制御信号から逆変換を行い、進行方向座標系で記述された歩行パターンを実現する制御系を設計・構築する。これにより、所望の特性をもった制御系の設計・構築が容易に実現できる。
【００１５】
【発明の実施の形態】
以下、本発明を実施する場合の形態について、図面を参照して説明する。図１は、本発明を一態様で実施する脚式ロボットの脚部の構造を概略的に説明する図であり、また、図２は、脚式ロボットの歩行制御を行う場合についての接地脚の位置の状態を説明する図である。図１および図２において、１は左足、２は右足、２ａは右足の上板基板、２ｂは右足の接地基板、３は足部を構成する低剛性部材、４は足部関節設置部、５は姿勢制御装置、６ａは第１脚部，６ｂは第２脚部、７はロボット本体部、８ａは第１の関節モータ，８ｂは第２の関節モータ、８ｃは第３の関節モータである。なお、図示されないが、左足１および右足２には、それぞれ低剛性部材３の中に接地状態センサとして機能する圧力センサが設けられている。また、左足１および右足２の位置は、図示しない姿勢センサ、ならびに、関節角度センサ等から構成される足裏位置を検出する足裏位置センサにより、初期設定位置から歩行制御を行って動作させたロボットの脚部（６ａ〜６ｂ，８ａ〜８ｃ）の移動位置が算出されて求められる。また、図示されないが、姿勢制御装置５の中には、座標変換を行い、制御データ等を生成し、脚部アクチュエータに対して制御信号を出力するコンピュータ装置が設けられている。
【００１６】
脚式ロボットの歩行制御については、ロボット本体部７に設けられた姿勢制御装置５が、ロボットの脚部（６ａ〜６ｂ，８ａ〜８ｃ）を動作させて、つまり、脚部アクチュエータを制御して、左足１および右足２を動作させて、歩行パターンにしたがって歩行制御を行う。また、機能的には、脚部の状態を生成して制御を行う動作生成装置からの制御信号により、脚部アクチュエータを制御して、左足１および右足２を動作させて、歩行パターンにしたがって歩行制御を行う。
【００１７】
脚式ロボットの歩行制御を行う場合、脚式ロボットにおいては、歩行姿勢によりパラメータ変動が起きる。また、歩行の姿勢によっては、ロボット本体部７のメカニカルな剛性が変化する。すなわち、二足歩行ロボットの歩行姿勢については、図２に示すように、接地脚について、両脚（左足１および右足２）の足裏を結ぶ方向（以下、長手方向と称す）には、両脚により閉リンク構造ができているため剛性が高く、倒れがたい状態となっており、また、この長手方向に直交する方向（以下、短手方向と称す）については、両脚による閉リンク構造を構成しないため、剛性が低く、倒れやすいものとなっている。
【００１８】
このため、脚式ロボットの歩行制御における安定制御では、この長手方向および短手方法のそれぞれについて、異なる制御特性を持たせて制御系を設定する。二足歩行ロボットにおいては、上述したように方向（長手方向および短手方向）に応じてのそれぞれの特性があり、これが変化する。そこで、二足歩行ロボットの歩行制御系としては、図３に示すように、接地脚の位置を基準とした直交座標系である足裏座標系を設定し、歩行制御を行う。この足裏座標系は、脚式ロボットを歩行させた場合、接地脚の位置において足裏座標系の座標軸が動的に変化する。このため、歩行制御を行うについては、制御を行うタイミングに応じて、接地脚（左足１および右足２）の位置を検出し、この検出した接地脚の位置に基づいて、足裏座標系を設定し、その足裏座標系に従って歩行制御を行う。姿勢制御では、図４に示すように、長手方向軸まわりの転倒に対しては、強い踏ん張り力で姿勢を復帰するように制御を行う。一方、短手方向軸まわりの転倒に対しては、両足間隔が広い（長い）ことから、弱い踏ん張り力でも、目標ＺＭＰ回りのモーメントを稼げるため、弱い踏ん張り力で姿勢を復帰させるように制御を行う。
【００１９】
また、歩行制御において片脚支持の状態が介在するが、この場合においても、次に説明するように、制御装置を切り替えることなく、両脚支持状態での制御と全く同じに、足裏座標系を設定し、その足裏座標系に従って歩行制御を行う。つまり、片脚の状態においては、図５に示すように、その剛性については、前述した長手方向および短手方向のいずれの方向についても弱いので、これらの方向とも、強い踏ん張り力で姿勢を復帰するように制御を行う。
【００２０】
より具体的には、足裏座標系に基づく姿勢制御に関して説明を行うと、傾いたロボットの胴体を復帰させるため、接地脚の足裏による踏ん張り力により姿勢を復帰しているが、物理的には、足裏から床面に対する補償モーメントを発生することにより姿勢の復帰を行う。前述のように、接地脚の状況により長手方向と短手方向の剛性が異なるため、異方性を持たせて（方向により異なる制御特性を持たせて）、制御系を設計し構築する。その制御系は、例えば、（式１）に示されるように、足裏座標系の各軸が非干渉化された線形システムの制御系を構成し、補償モーメントを発生させる。
【数１】
左上の添え字Ｆ：足裏座標系を意味する
Ｍ：復帰モーメントベクトル
Δθ：胴体の傾きベクトル
Ｋｐ：胴体の傾きの比例ゲイン
Ｋｖ：胴体の傾きの速度ゲイン
Ｂ：踏ん張り力を決定する重み行列（図４）
である。
なお、この重み行列は、２×２行列の場合、具体的には、
【数２】
【００２１】
一方、胴体の傾きを検出するセンサ等のフィードバックに使用するセンサは、両脚の位置関係により軸方向が可変となる足裏座標系で検出される訳ではなく、通常、胴体等に固定されたセンサ座標系で検出される。したがって、（式１）における変数の胴体の傾きΔθは、（式３−１）および（式３−２）に示すような「センサ座標系→足裏座標系」間の座標変換を行い算出する。
【数３】
左上の添え字S：センサ座標系を意味する
R：座標変換を表す記号で、Rの左下の添え字で表記された座標系データを、Rの左上の添え字で表記された座標系データに変換する座標変換行列
【００２２】
一方、歩行パターンは、通常、足裏座標系とは異なる座標系、例えば、ボディー座標系で記述されている。したがって、安定で所望な制御系を構築するためには、（式１）により算出された足裏座標系での補償信号を、（式４）に示すようにボディー座標系の信号に座標変換を行い、最終的には歩行パターンに補償を加え制御を行う。
【数４】
以上をまとめると、次の（式５）に示される制御系を構成して、ボディー座標系における補償モーメントを発生させるようにする。
【数５】
【００２４】
また、脚式ロボットの歩行制御の場合には、接地脚の状態によりモード切り替える場合が多いが、モード切替は制御システムを複雑にするばかりか、時には、不安定な制御系を構成することになる。そのため、ここでは、（式２）における重み付けを連続的に変えることにより、これに対応して制御系を構成する。具体例として、二足歩行ロボットを例にして説明すると、図５に示すように、片脚支持期については、全ての方向に対して、「強い足裏による踏ん張り力」が必要であるので、（式１）により算出される復帰モーメントを不連続に変化させると、場合によっては、転倒に至る時がある。このため、連続して変化させる必要がある。そこで、接地脚の状態を検出する接地脚センサ、もしくは接地脚の状態を生成する動作生成装置による歩行パターンから、片脚支持期または両脚支持期の判別を行い、この判別に基づき（式２）で与えられる「重みｂ」を連続的に変化させて、片脚支持期においては「ｂ＝１」となるようにする。
【００２５】
以上、説明したように、本発明よる歩行制御装置においては、足裏座標系を用いて歩行制御を行うようにしているので、足裏座標系に座標変換を行うための座標変換手段を備え、例えば、センサ座標系でのセンサ情報や進行方向座標系で記述された歩行パターン等については、足裏座標系に座標変換し、もしくは足裏座標系から逆変換を行い、歩行パターン等を用いた方向制御を行う制御系を設計して構築する。これにより、所望の特性をもった制御系の設計および構築が容易に実現できる。
【図面の簡単な説明】
【図１】本発明を一態様で実施する脚式ロボットの脚部の構造を概略的に説明する図である。
【図２】脚式ロボットの歩行制御を行う場合について接地脚の位置の状態を説明する図である。
【図３】本発明にかかる足裏座標系を説明する図である。
【図４】足裏座標系による異方向性を持つ復帰モーメントを説明する図である。
【図５】片脚支持期における足裏座標系の復帰モーメントを説明する図である。
【符号の説明】
１…左足
２…右足
２ａ…右足の上板基板
２ｂ…右足の接地基板
３…足部を構成する低剛性部材
４…足部関節設置部
５…姿勢制御装置
６ａ…第１脚部
６ｂ…第２脚部
７…ロボット本体部
８ａ…第１の関節モータ
８ｂ…第２の関節モータ
８ｃ…第３の関節モータ
Claims (9)
- 脚式ロボットの歩行制御装置において、検出された接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系を歩行制御のための制御座標系として歩行制御を行う制御装置を備えた
ことを特徴とする脚式ロボットの歩行制御装置。 - 脚式ロボットの歩行制御装置において、
接地脚の足裏位置を検出する足裏位置センサと、
前記足裏位置センサにより検出した接地脚の足裏位置を基準にした接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系を歩行制御のための制御座標系として歩行制御を行う制御装置と、
前記制御装置により制御される脚部アクチュエータと
を備えたことを特徴とする脚式ロボットの歩行制御装置。 - 脚式ロボットの歩行制御装置において、
接地脚の足裏位置を検出する足裏位置センサと、
接地脚の状態を検出する接地状態センサと、
検出した接地脚の足裏位置および状態に応じて接地脚の位置を基準にした接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系に変更して歩行制御を行う制御装置と、
前記制御装置により制御される脚部アクチュエータと
を備えたことを特徴とする脚式ロボットの歩行制御装置。 - 脚式ロボットの歩行制御装置において、
接地脚の足裏位置を検出する足裏位置センサと、
接地脚の状態を生成する動作生成装置と、
検出した接地脚の足裏位置および状態に応じて接地脚の位置を基準にした接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系に変更して歩行制御を行う制御装置と、
前記制御装置により制御される脚部アクチュエータと
を備えたことを特徴とする脚式ロボットの歩行制御装置。 - 請求項２に記載の脚式ロボットの歩行制御装置において、
制御装置は、足裏位置センサにより検出された接地脚の足裏位置を基準にした接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系において制御パラメータの入力を行い、
入力した制御パラメータにより制御特性を設定する
ことを特徴とする脚式ロボットの歩行制御装置。 - 請求項３または請求項４に記載の脚式ロボットの歩行制御装置において、
制御装置は、接地状態センサもしくは動作生成装置により検出された接地脚の状態により制御特性を変更する
ことを特徴とする脚式ロボットの歩行制御装置。 - 請求項３または請求項４に記載の脚式ロボットの歩行制御装置において、
制御装置は、センサ自身が内蔵している座標系において検出したセンサ情報を接地脚の足裏位置を基準にした接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系に変換する座標変換手段を備える
ことを特徴とする脚式ロボットの歩行制御装置。 - 請求項３または請求項４に記載の脚式ロボットの歩行制御装置において、
制御装置は、脚式ロボットの進行方向を１軸に持つ直交座標系において記述された動作パターン情報を、接地脚の足裏位置を基準にした接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系に変換する座標変換手段を備える
ことを特徴とする脚式ロボットの歩行制御装置。 - 請求項７または請求項８に記載の脚式ロボットの歩行制御装置において、
更に、接地脚の足裏位置を基準にした接地脚の両脚の足裏を結ぶ方向、接地脚の両脚の足裏を結ぶ方向と直交する方向、および鉛直方向の各方向からなる座標系において生成された信号を、センサ自身が内蔵している座標系であるセンサ座標系、脚式ロボットの進行方向を１軸に持つ直交座標系である進行方向座標系、または脚式移動ロボットのボディーを基準にした座標系であるボディー座標系のいずれかの座標系に変換する座標変換手段を備える
ことを特徴とする脚式ロボットの歩行制御装置。
Priority Applications (6)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002131120A JP3646169B2 (ja) | 2002-05-07 | 2002-05-07 | 脚式ロボットの歩行制御装置 |
| PCT/JP2003/005692 WO2003095155A1 (fr) | 2002-05-07 | 2003-05-07 | Procede et dispositif pour commander la marche d'un robot muni de jambes |
| DE10392608T DE10392608T5 (de) | 2002-05-07 | 2003-05-07 | Verfahren und Vorrichtung zur Gehsteuerung eines Roboters mit Beinen |
| US10/511,608 US20050240308A1 (en) | 2002-05-07 | 2003-05-07 | Method and device for controlling walking of legged robot |
| KR1020047017803A KR100748463B1 (ko) | 2002-05-07 | 2003-05-07 | 다리식 로봇의 보행제어장치 |
| AU2003235867A AU2003235867A1 (en) | 2002-05-07 | 2003-05-07 | Method and device for controlling walking of legged robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002131120A JP3646169B2 (ja) | 2002-05-07 | 2002-05-07 | 脚式ロボットの歩行制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2003326484A JP2003326484A (ja) | 2003-11-18 |
| JP3646169B2 true JP3646169B2 (ja) | 2005-05-11 |
Family
ID=29416605
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002131120A Expired - Lifetime JP3646169B2 (ja) | 2002-05-07 | 2002-05-07 | 脚式ロボットの歩行制御装置 |
Country Status (6)
| Country | Link |
|---|---|
| US (1) | US20050240308A1 (ja) |
| JP (1) | JP3646169B2 (ja) |
| KR (1) | KR100748463B1 (ja) |
| AU (1) | AU2003235867A1 (ja) |
| DE (1) | DE10392608T5 (ja) |
| WO (1) | WO2003095155A1 (ja) |
Families Citing this family (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR100835354B1 (ko) * | 2006-07-05 | 2008-06-04 | 삼성전자주식회사 | 보행로봇 및 그의 제어방법 |
| JP2008100287A (ja) * | 2006-10-17 | 2008-05-01 | Futaba Corp | ロボットシステム |
| KR100809352B1 (ko) | 2006-11-16 | 2008-03-05 | 삼성전자주식회사 | 파티클 필터 기반의 이동 로봇의 자세 추정 방법 및 장치 |
| KR101460140B1 (ko) * | 2008-04-16 | 2014-11-11 | 삼성전자주식회사 | 휴머노이드 로봇 및 그의 제어 방법 |
| CN102530121B (zh) * | 2011-12-29 | 2013-08-07 | 浙江大学 | 一种多足步行机器人脚 |
| CN103832504B (zh) * | 2014-02-26 | 2017-01-25 | 南京航空航天大学 | 仿生足式机器人综合仿真方法 |
| US9517561B2 (en) * | 2014-08-25 | 2016-12-13 | Google Inc. | Natural pitch and roll |
| US9499219B1 (en) * | 2014-08-25 | 2016-11-22 | Google Inc. | Touch-down sensing for robotic devices |
| CN106915616A (zh) * | 2015-12-27 | 2017-07-04 | 天津市鑫源泓达科技有限公司 | 可报警滑动螺杆传送装置 |
| CN109333534B (zh) * | 2018-10-23 | 2021-12-17 | 广东工业大学 | 预规划的实时步态控制算法 |
| CN109333506B (zh) * | 2018-10-23 | 2021-12-17 | 广东工业大学 | 一种人形智能机器人*** |
| JP2021070101A (ja) * | 2019-10-31 | 2021-05-06 | セイコーエプソン株式会社 | 制御方法および算出装置 |
| CN113619697B (zh) * | 2021-06-18 | 2022-09-13 | 中山小神童创新科技有限公司 | 爬楼机及其平衡控制方法 |
| CN115610554B (zh) * | 2022-09-23 | 2023-07-07 | 哈尔滨工业大学（深圳） | 基于吊臂合页式关节的全电机绳驱多足机器人 |
Family Cites Families (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5337235A (en) * | 1992-03-12 | 1994-08-09 | Honda Giken Kogyo Kabushiki Kaisha | Locomotion control system for legged mobiled robot |
| US5404086A (en) * | 1992-07-20 | 1995-04-04 | Honda Giken Kogyo Kabushiki Kaisha | System for controlling locomotion of legged mobile robot and correcting inclinometer's output thereof |
| JP3662996B2 (ja) * | 1996-01-25 | 2005-06-22 | 本田技研工業株式会社 | 脚式移動ロボットの歩行制御装置 |
| DE69725764T2 (de) * | 1996-07-25 | 2004-08-05 | Honda Giken Kogyo K.K. | Vorrichtung zur nachbildung des ganges für einen zweibeinigen robotor |
| EP1514777B1 (en) * | 1997-01-31 | 2009-03-11 | Honda Giken Kogyo Kabushiki Kaisha | Control system of legged mobile robot |
| JP3672406B2 (ja) | 1997-01-31 | 2005-07-20 | 本田技研工業株式会社 | 脚式移動ロボットの歩容生成装置 |
| JP3667914B2 (ja) * | 1997-01-31 | 2005-07-06 | 本田技研工業株式会社 | 脚式移動ロボットの遠隔制御システム |
| JP4540156B2 (ja) * | 1999-11-02 | 2010-09-08 | ソニー株式会社 | ロボットの重心位置制御方法 |
| JP4279425B2 (ja) * | 1999-11-05 | 2009-06-17 | 本田技研工業株式会社 | 脚式歩行ロボットの足部構造 |
| JP3634238B2 (ja) * | 2000-05-19 | 2005-03-30 | 本田技研工業株式会社 | 脚式移動ロボットの床形状推定装置 |
-
2002
- 2002-05-07 JP JP2002131120A patent/JP3646169B2/ja not_active Expired - Lifetime
-
2003
- 2003-05-07 US US10/511,608 patent/US20050240308A1/en not_active Abandoned
- 2003-05-07 DE DE10392608T patent/DE10392608T5/de not_active Withdrawn
- 2003-05-07 AU AU2003235867A patent/AU2003235867A1/en not_active Abandoned
- 2003-05-07 WO PCT/JP2003/005692 patent/WO2003095155A1/ja active Application Filing
- 2003-05-07 KR KR1020047017803A patent/KR100748463B1/ko not_active IP Right Cessation
Also Published As
| Publication number | Publication date |
|---|---|
| US20050240308A1 (en) | 2005-10-27 |
| DE10392608T5 (de) | 2005-07-14 |
| AU2003235867A1 (en) | 2003-11-11 |
| KR20050007390A (ko) | 2005-01-17 |
| WO2003095155A1 (fr) | 2003-11-20 |
| JP2003326484A (ja) | 2003-11-18 |
| KR100748463B1 (ko) | 2007-08-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3646169B2 (ja) | 脚式ロボットの歩行制御装置 | |
| JP4513320B2 (ja) | ロボット装置、並びにロボット装置の運動制御方法 | |
| JP4126063B2 (ja) | 移動体の制御装置 | |
| KR100515277B1 (ko) | 2각 보행식 이동 장치, 그 보행 제어 장치 및 보행 제어방법 | |
| US8271137B2 (en) | Robot and method of controlling the same | |
| US7774098B2 (en) | Gait generating device for moving robot | |
| JP4812426B2 (ja) | ロボット制御装置 | |
| JPH10277969A (ja) | 脚式移動ロボットの制御装置 | |
| US7765030B2 (en) | Gait generator for mobile robot | |
| WO1998033629A1 (fr) | Appareil de controle de robot mobile du type a jambes | |
| JP3148827B2 (ja) | 脚式移動ロボットの歩行制御装置 | |
| KR20130095973A (ko) | 보행 로봇 및 그 제어 방법 | |
| JP2003326483A (ja) | 移動ロボットの姿勢制御装置 | |
| JP2001322076A (ja) | 脚式移動ロボットの床形状推定装置 | |
| KR20010050355A (ko) | 로보트 및 로보트용 관절 장치 | |
| WO2005000533A1 (ja) | 脚式移動ロボットの歩容生成装置 | |
| JP5181957B2 (ja) | ロボット制御装置、ロボット制御方法およびロボット制御プログラム | |
| WO2003068453A1 (fr) | Dispositif mobile marchant sur deux jambes | |
| US7801643B2 (en) | Legged mobile robot and control program for the robot | |
| Ota et al. | Design and control of 6-DOF mechanism for twin-frame mobile robot | |
| JP5639342B2 (ja) | ロボット及びその歩行制御方法 | |
| JPH11300661A (ja) | 脚式移動ロボットの制御装置 | |
| JP4985776B2 (ja) | ロボット制御装置、ロボット制御方法およびロボット制御プログラム | |
| JP4905041B2 (ja) | ロボット制御装置 | |
| JP3024028B2 (ja) | 脚式移動ロボットの歩行制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20041012 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20041108 |
|
| 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: 20050111 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 3646169 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| 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 |
|
| EXPY | Cancellation because of completion of term |