JPH05337849A - 脚式移動ロボットの姿勢安定化制御装置 - Google Patents

Abstract

(57)【要約】 【構成】 ２足歩行の脚式移動ロボットの姿勢安定化制
御装置であって、力学モデルを追従する様にロボットを
関節変位すると共に、モデルと実ロボットの上体の傾き
に偏差が生じたとき、モデルの床反力をずらして姿勢安
定化を図る。 【効果】 足裏を接地させたまま大きな復元力を得るこ
とができる。

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】この発明は脚式移動ロボットの姿
勢安定化制御装置に関し、より具体的には力学モデルを
追従する様にロボットが関節変位されると共に、モデル
と実ロボットに傾き偏差が生じたとき、実ロボットの床
反力をずらす代わりに、モデルの床反力をずらして姿勢
の安定を回復する様にしたものに関する。

【０００２】

【従来の技術】脚式移動ロボット、特に２足歩行の脚式
移動ロボットとしては、特開昭６２−９７００５号、特
開昭６３−１５０１７６号公報記載のものなどが知られ
ている。また脚式移動ロボットを含むロボットの制御に
ついては、「ロボット工学ハンドブック」（日本ロボッ
ト学会編、１９９０年１０月２０日）に詳しい。

【０００３】

【発明が解決しようとする課題】ところで、脚式移動ロ
ボット、特に２足歩行の脚式移動ロボットは本来的に安
定性が低いことから、外乱などを受けると姿勢が不安定
となる。そこでロボットの上体の傾き角度と傾き角速度
を検出して姿勢制御する必要がある。その意図から本出
願人は先に特願平２−３３６，４２０号（平成２年１１
月３０日出願）において、着地候補位置を何点か予め用
意しておき、一歩ごとの制御周期でいずれかを選択して
目標歩容を切り換える制御を提案している。しかし、こ
の制御によるときは、姿勢が崩れた結果、ＺＭＰ（垂直
床反力の作用重心点。Zero MomentPoint)が存在可能範
囲の限界付近に偏って接地性が失われても、次の一歩で
歩容が修正されて姿勢が復元するまではＺＭＰが限界付
近に偏ったままなので、それまで接地性を回復できない
と言う不都合がある。

【０００４】そこで本出願人は近時別の出願（平成４年
４月３０日、整理番号Ａ９２−０１１６）において、ロ
ボットの力学モデルを基に力学的平衡状態が保証される
様に床反力を設定した目標歩容を生成し、モデル化誤差
や外乱によって傾き角度と傾き角速度に目標値と実際値
との間で偏差が生じたときは、実ロボットの接地部の変
位あるいはモーメントを基準歩容から故意にずらすこと
によって実ロボットの床反力をモデルから計算される目
標歩容のそれから故意にずらし、実ロボットの傾きをモ
デルの傾きに近づける復元力を得る技術を提案している
（ここで言う「床反力」は、各脚に作用する床反力を全
て合成した、ある作用点に働く合力と合モーメントとを
意味する）。

【０００５】しかし提案したこの技術によるときは、例
えば２足歩行ロボットの片脚支持期では、実ロボットの
床反力を故意に大きくずらそうとして足首角度を大きく
ずらしても、ＺＭＰが足平接地面を超える全床反力を発
生することができず、足平の一部が浮いてしまうことが
ある。従って、実ロボットがモデルに対して大きく傾い
てしまった場合には、実ロボットの傾斜を正常に戻すた
めに必要な十分な復元力を得ることができないことがあ
り、そのときは実ロボットが転倒する。即ち、この技術
では目標値と実際値との偏差を縮める復元作用がＺＭＰ
の存在範囲に制約される。

【０００６】図で説明すると、実ロボットの関節変位を
モデルの通りに追従する制御においては、実ロボットの
傾き角度と傾き角速度とがそれぞれモデルのそれらと一
致していれば、図１に実線で示す実ロボットのＺＭＰは
モデルから決定される目標ＺＭＰに一致し、ロボットは
所期の姿勢で歩行する。しかし、実際には先に述べた様
にモデル化誤差や外乱によって破線で示す様に傾き角度
と傾き角速度とに偏差が生じ、しかもそのずれは重力の
作用によって偏差が大きくなるほど益々大きくなろうと
する発散傾向を持つ。ところで実ＺＭＰが目標ＺＭＰか
らずれると、図２に示す様に、その間の距離ｘに力Ｆを
乗じたモーメントＭが目標ＺＭＰのまわりに生じる。換
言すれば、実ＺＭＰが故意に目標ＺＭＰからずれる様に
関節変位を制御することにより、所望のモーメントを生
じさせることができる。先に提案した技術ではその思想
に基づき、傾き（角度と角速度）偏差が生じたときは図
２に示す様に、故意に実ＺＭＰをずらして姿勢復元方向
にモーメントを生じさせる様にした。しかし、この技術
によるときは同図に示す如く、実ＺＭＰをずらすことが
できる範囲は、足平領域ｘsole内に限られる。

【０００７】従って、この発明の目的は近時提案した技
術を改良し、更に効果的な脚式移動ロボットの姿勢安定
化制御装置を提案することにある。

【０００８】

【課題を解決するための手段】上記した課題を解決する
ためにこの発明は例えば請求項１項に示す如く、制御対
象のモデルを少なくとも１つ備えるモデル追従型の脚式
移動ロボットの姿勢安定化制御装置であって、前記モデ
ルと実ロボットの傾斜などの状態の偏差に応じた操作量
を少なくとも前記モデルにフィードバックしてモデルの
挙動を修正する様に構成した。

【０００９】

【作用】

【００１０】重力作用によって発散しようとする傾き偏
差を零に収束させようとする作用は、実ロボットとモデ
ルの床反力の差によって生じるものである。従って、偏
差を収束させるためには、実ロボットの床反力をずらす
代わりに、モデルの床反力を反対側にずらすことによっ
ても等価な効果を得ることができる筈である。本発明は
この効果を利用する。そして、それによって図３に示す
様に、ずらすＺＭＰがモデルのそれであることから、Ｚ
ＭＰをずらす範囲はもはや足平直下の領域内に限られる
ことがなく、足平接地面を遠く超えた位置までずらすこ
とができる。言い換えれば、前記した距離ｘを大きくす
ることができ、結果的にモーメントを大きくすることが
できて大きな姿勢復元力を得ることができる。

【００１１】以下、更に説明する。分かり易くするため
に図４に示す様に、足平と１リンクの脚と上体から構成
される単純なロボットを考える。脚の質量をｍ、足首ま
わりの脚の慣性モーメントをＩ、脚重心の足首との距離
をｈとする。上体の質量および慣性モーメントは０とす
る。また足首の床からの高さも０とする（こうすると、
床反力と足首モーメントとが一致して議論が簡単にな
る）。鉛直方向に対する脚の傾き（即ち、足首と重心と
を結ぶ線分の傾き角度）をθlink、鉛直方向に対する上
体の傾きをθtrunk 、腰関節の曲げ角をθhip とする。
尚、図でθlinkとθtrunk は負、θhip は正とする。更
に、足首に作用するモーメントをＭact とする( 足首の
床からの高さが０であるから、床反力もＭact であ
る）。重力加速度はｇとする。足首には公知のトルク制
御が施されるものとし、腰の曲げ角は変位制御されるも
のとする。

【００１２】上記において、幾何学的関係から数１の式
が成立する。

【００１３】

【数１】

【００１４】このロボットの脚の運動方程式は数２の様
になる。

【００１５】

【数２】

【００１６】これをラプラス変換して数３の式を得る。

【００１７】

【数３】

【００１８】さて、ここで、この実ロボットと全く同じ
構造と全く同じパラメータ値を持つ数式モデルを用意す
る。その鉛直方向に対する脚の傾き（即ち、前記と同様
な足首と重心とを結ぶ線分の傾き）をθmdllink 、鉛直
方向に対する上体の傾きをθmdltrunk、腰関節の曲げ角
をθmdlhipとし、モデルの足首に作用するモーメント(
即ち、モデルの床反力) をＭmdl とすると、幾何学的な
数式モデルと動力学的な数式モデルは、数４、数５に示
す様になる。

【００１９】

【数４】

【００２０】

【数５】

【００２１】次に、モデルを基に目標歩容を作成する。
目標歩容は、一般的にはモデルの初期状態、モデルに加
えられる操作量、および拘束条件によって表現される。
具体的には、脚の初期傾き角度θreflink0と脚の初期傾
き角速度ωreflink0、足首モーメントの時間関数Ｍref
(t)、および上体の傾き角度の時間関数θreftrunk(t)に
よって表現される。上体の傾き角度の時間関数θreftru
nk(t) は、議論を単純化するために、ここでは常に０で
あるものとする。

【００２２】次に、以下の制御を実施する。

【００２３】モデルの上体の傾き角度θmdltrunkを常に
θreftrunk(t) に一致させる( θreftrunk(t) は０とし
ているので、θmdltrunkも常に０に維持される）。モデ
ルの足首には、Ｍref(t)と後述する上体の傾き角偏差に
応じた操作量Ｍactfb の和に、実際値Mactに一致する様
にトルク制御が実施される。実ロボットの腰の曲げ角度
θacthipはモデルの腰の曲げ角θmdlhipを目標変位とし
て変位制御が施される。即ち、θacthipは、θmdlhipに
一致する様に制御される。実ロボットの上体には、傾斜
センサが備えられており、上体の傾き角θacttrunkが検
出される。

【００２４】モデルに対する実ロボットの上体傾き角偏
差θerr は数６の式で求められる。この例では、実ロボ
ットの上体傾き角偏差θerr は、θmdltrunkが常に０に
維持されているから、θacttrunkそのものである。

【００２５】

【数６】

【００２６】制御の目的は、歩行中においてモデルに対
する実ロボットの上体傾き角偏差θerr を０に収束させ
ることである。先に述べた近時提案した技術では、上体
の傾き角偏差に応じた操作量Ｍactfb を算出し、実ロボ
ットの足首モーメントＭactに加えることによりフィー
ドバックループを構成していた。これに対し、この発明
による制御装置では、上体の傾き角偏差に応じた操作量
Ｍmdlfb をモデルの足首モーメントＭmdl に加えること
によりフィードバックループを構成する。

【００２７】この発明による制御と近時提案した制御の
効果を比較するために、Ｍactfb とＭmdlfb から上体の
傾き角偏差θerr までのブロック図を図５に示す。但
し、この図ではθerr からＭactfb へのフィードバック
とθerr からＭmdlfb へのフィードバックを省略した。

【００２８】さて、トルク制御部と変位制御部の伝達関
数は、θactlink の挙動に比べて制御の応答性が十分高
ければ１とみなすことができる。このとき、図５を、Ｍ
actfb,Ｍmdlfb およびθerr の関係のみに着目して変形
すると、図６が得られる。この図から明らかな様に、例
えばＨ（Ｓ）をフィードバック則とすると、Ｍact に数
７の式で求められるＭactfb をフィードバックすること
と、Ｍmdl に数８の式で求められるＭmdlfb をフィード
バックすることは、θerr の挙動に対して同一の効果を
持つ。

【００２９】

【数７】

【００３０】

【数８】

【００３１】更に、θerr の挙動を決定するものは、Ｍ
actfb とＭmdlfb との差であるから、数９の式となる様
に、Ｈ（Ｓ）をＭactfb とＭmdlfb に分配すれば、この
手法もやはり同一の効果を持つ。

【００３２】

【数９】

【００３３】以上が、この発明の根本原理である。実ロ
ボットが複雑なものであっても、そのダイナミクスを忠
実に模擬するモデルを用意すれば、実ロボットの床反力
とモデルの床反力の差を制御することにより、上記例と
全く同一原理で同一の効果を得ることができる。後で実
施例で示す様に、動力学モデルを基準歩容からの摂動分
で表現しても、θerr とその微分値ωerr が微小であれ
ば、同一の効果が得られる。

【００３４】この構成により、近時提案した制御と異な
り、実ロボットの床反力ＺＭＰ位置を本来あるべき位置
から故意にずらす必要がないので、何らかの外乱などに
よって前記傾き角（角速度）偏差が非常に大きくなって
も、接地性を確保したまま（即ち、足裏が浮かない様に
しながら）、近時提案した制御では不可能であった大き
な姿勢復元作用を得ることが可能となり、短時間で偏差
を０に収束させることができる。また、モデルは床と干
渉しないから（但し、実ロボットの全床反力をずらすた
めに故意に干渉させる分は除く）、モデルに追従してい
る実ロボットも床と干渉せず、着地衝撃を小さい値に抑
制することも可能となる。

【００３５】尚、上記において、足平が浮かないために
は、Ｍact(上記例ではＭref ＋Ｍactfb)は、ある範囲内
に制限されなければならない( 例えば、平地歩行では実
ロボットのＺＭＰが足平の接地面を超えない範囲に限定
される）。従って、Ｍact がこの制限を超えない様な値
をとり、かつ数１０の式を満足する様に、Ｍactfb とＭ
mdlfb は決定されるべきである。

【００３６】

【数１０】

【００３７】尚、Ｍactfb からθmdllink までのオープ
ンの伝達関数とＭmdlfb からθmdllink でのオープンの
伝達関数は一致しないので、近時提案した制御とこの発
明による制御とでは、θmdllink の挙動に関して特性が
異なる。

【００３８】

【実施例】以下、脚式移動ロボットとして２足歩行の脚
式移動ロボットを例にとって、この発明の実施例を説明
する。図７はそのロボット１を全体的に示す説明スケル
トン図であり、左右それぞれの脚部リンク２に６個の関
節を備える（理解の便宜のために各関節をそれを駆動す
る電動モータで示す）。該６個の関節は上から順に、腰
の脚部回旋用（ｚ軸まわり）の関節１０Ｒ，１０Ｌ（右
側をＲ、左側をＬとする。以下同じ）、腰のロール方向
（ｘ軸まわり）の関節１２Ｒ，１２Ｌ、同ピッチ方向
（ｙ軸まわり）の関節１４Ｒ，１４Ｌ、膝部のピッチ方
向の関節１６Ｒ，１６Ｌ、足首部のピッチ方向の関節１
８Ｒ，１８Ｌ、同ロール方向の関節２０Ｒ，２０Ｌとな
っており、その下部には足平２２Ｒ，２２Ｌが取着され
ると共に、最上位には上体（筐体２４）が設けられ、そ
の内部には制御ユニット２６が格納される。

【００３９】上記において腰関節は関節１０Ｒ（Ｌ），
１２Ｒ（Ｌ），１４Ｒ（Ｌ）から構成され、また足関節
は、関節１８Ｒ（Ｌ），２０Ｒ（Ｌ）から構成される。
また、腰関節と膝関節との間は大腿リンク３２Ｒ，３２
Ｌで、膝関節と足関節との間は下腿リンク３４Ｒ，３４
Ｌで連結される。ここで、脚部リンク２は左右の足につ
いてそれぞれ６つの自由度を与えられ、歩行中にこれら
の６×２＝１２個の関節（軸）をそれぞれ適宜な角度に
駆動することで、足全体に所望の動きを与えることがで
き、任意に３次元空間を歩行することができる様に構成
される。先に述べた様に、上記した関節は電動モータか
らなり、更にはその出力を倍力する減速機などを備える
が、その詳細は先に本出願人が提案した出願（特願平１
−３２４２１８号、特開平３−１８４７８２号）などに
述べられており、それ自体はこの発明の要旨とするとこ
ろではないので、これ以上の説明は省略する。

【００４０】図７に示すロボット１において、足首部に
は公知の６軸力センサ３６が設けられ、足平を介してロ
ボットに伝達されるｘ，ｙ，ｚ方向の力成分Ｆｘ，Ｆ
ｙ，Ｆｚとその方向まわりのモーメント成分Ｍｘ，Ｍ
ｙ，Ｍｚとを測定し、足部の着地の有無と支持脚に加わ
る力の大きさと方向とを検出する。また足平２２Ｒ
（Ｌ）の四隅には静電容量型の接地スイッチ３８（図７
で図示省略）が設けられて、足平の接地の有無を検出す
る。更に、上体２４には傾斜センサ４０が設置され、ｘ
−ｚ平面内とｙ−ｚ平面内のｚ軸に対する、即ち、重力
方向に対する傾斜角度と傾斜角速度を検出する。また各
関節の電動モータには、その回転量を検出するロータリ
エンコーダが設けられる。更に、図７では省略するが、
ロボット１の適宜な位置には傾斜センサ４０の出力を補
正するための原点スイッチ４２と、フェール対策用のリ
ミットスイッチ４４が設けられる。これらの出力は前記
した上体２４内の制御ユニット２６に送られる。

【００４１】図８は制御ユニット２６の詳細を示すブロ
ック図であり、マイクロ・コンピュータから構成され
る。そこにおいて傾斜センサ４０などの出力はＡ／Ｄ変
換器５０でデジタル値に変換され、その出力はバス５２
を介してＲＡＭ５４に送られる。また各電動モータに隣
接して配置されるエンコーダの出力はカウンタ５６を介
してＲＡＭ５４内に入力されると共に、接地スイッチ３
８などの出力は波形整形回路５８を経て同様にＲＡＭ５
４内に格納される。制御ユニット内にはＣＰＵからなる
第１、第２の演算装置６０，６２が設けられており、第
１の演算装置６０は後で述べる様に目標関節角度を算出
してＲＡＭ５４に送出する。また第２の演算装置６２は
ＲＡＭ５４からその目標値と検出された実測値とを読み
出し、各関節の駆動に必要な制御値を算出し、Ｄ／Ａ変
換器６６とサーボアンプを介して各関節を駆動する電動
モータに出力する。

【００４２】続いて、この制御装置の動作を説明する。

【００４３】図９はその動作を示すブロック図であり、
図１０ないし図１２はその動作を示すフロー・チャート
である。図１０以降のフロー・チャートを参照して具体
的に説明する前に、図９ブロック図を参照してこの制御
を概説する。尚、以下ではｘ方向（進行方向）の制御だ
けを例にとって説明しているが、ｙ方向（横方向）も同
様である。

【００４４】図９に示す様に、この実施例においてロボ
ットの幾何学モデルとしては剛体モデルを備え、ロボッ
トの動力学モデルとしては、基準歩容からの上***置摂
動分の挙動を倒立振子で近似したものを備える。倒立振
子の質量をｍ、支点まわりの慣性モーメントをＩ、支点
と重心の距離をｈとする。基準歩容は、上体２４の位置
・姿勢、および両足平２２Ｒ（Ｌ）の位置・姿勢で表現
される。両足平２２Ｒ（Ｌ）の位置・姿勢については、
一歩ごとの足平軌道パラメータ（例えば、遊脚着地位置
や着地時刻など）が、大局的姿勢制御部から目標足平軌
道生成部に与えられ、目標足平軌道生成部においてリア
ルタイムに各瞬間のそれらの位置や姿勢が生成される。
尚、この制御においてはロボットの姿勢が崩れたとき、
先ずモデルの姿勢をそれに合わせて崩し、次いで安定方
向に回復させると共に、実ロボットをそれに追従制御し
て姿勢安定を回復する様にしていることから、ここで
「大局的」なる語は、瞬間々々ではなく、比較的長い時
間をかけて滑らかに姿勢回復を最終的に実現する如く、
この制御の特質を示す意味で使用する。

【００４５】またＺＭＰ目標軌道については、一歩ごと
のＺＭＰ目標軌道パラメータ（例えば、折れ線表現され
ているときは折れ点の座標や時刻）が、大局的姿勢制御
部からＺＭＰ目標軌道生成部に与えられ、ＺＭＰ目標軌
道生成部においてリアルタイムに各瞬間のその位置が算
出される。上体２４の位置・姿勢については、ＺＭＰ目
標軌道を満足する様に、予めオフラインで作成されて時
系列データとして大局的姿勢制御部に記憶され、歩行時
に吐き出される。尚、以降、足平軌道パラメータとＺＭ
Ｐ目標軌道パラメータなど歩容の特徴を表現するものを
総称して「歩容パラメータ」と呼ぶ。

【００４６】次いで、幾何学モデルに対する実ロボット
の姿勢の傾き角偏差θerr と角速度偏差ωerr を検出す
る（実ロボット１の関節変位が忠実にモデルに追従する
と考えられるならば、姿勢の傾き角（角速度）偏差は、
上体２４の傾き角（角速度）偏差で代表して差し支えな
い。あるいは重心位置のずれを用いても良い。）。

【００４７】これらを状態量として、これらを０に収束
させようと働く安定化制御則から求められる制御操作量
（状態フィードバック量）は、モーメントの次元で検出
されて倒立振子型動力学モデルの支点に与えられる。こ
こで、この操作量を先に述べたと同様に、モデル操作モ
ーメントＭmdl と呼ぶ。Ｍmdl は、倒立振子型動力学モ
デルが受ける床反力モーメントであるとも言える。倒立
振子型動力学モデルは、Ｍmdl と重心に作用する重力の
影響を受けて運動する。倒立振子の状態量、即ち、傾き
角θmdl とその角速度ωmdl の挙動は、過去の状態と支
点に加えられるモーメントＭmdl を基に逐次計算され
る。

【００４８】数１１の式により、上体２４のｘ方向のず
れΔｘが求められる。但し、ｈtrunk は上体２４の高さ
（より正確に表現すれば、床から腰関節１（Ｌ）までの
高さ）とする。

【００４９】

【数１１】

【００５０】ロボット幾何学モデルの上***置は、歩容
パラメータの上***置ｘにΔｘが加えられた位置に指定
される。

【００５１】また、先に述べた近時提案した技術で用い
られるコンプライアンス制御によって、ＺＭＰ目標位置
まわりの実床反力モーメントＭact に応じて、基準歩容
の足平位置・姿勢が修正され、それが幾何学モデルに与
えられる。図９で用いられている制御では、Ｍact から
床反力モーメントフィードバック則によって仮想床傾斜
角指令θctrlが求められ、モデルの足平位置は、モーメ
ント足平軌道生成部で生成される基準歩容の足平位置を
ＺＭＰ目標位置を中心として仮想床傾斜角指令の分だ
け、座標回転させられる。これにより、実ロボット１の
姿勢傾きの挙動は、基準点（例えば、ＺＭＰ目標位置）
を支点とし、支点に床から傾きに比例した床反力モーメ
ントが発生する倒立振子に近似される。

【００５２】以上によって求められ、修正された上***
置・姿勢から、逆キネマティクス計算によって、幾何学
モデルの各関節の変位が求められる。尚、このロボット
では可動部はすべて回転自由度しかないから、関節の変
位はすべて角度で表現される。実ロボット１には、その
関節変位をロボット幾何学モデルの関節変位に追従させ
る制御システムが備えられる。

【００５３】以上のシステムにおいて、状態量θerr と
ωerr に応じたモデル操作モーメントＭmdl をロボット
動力学モデルに与えるフィードバック制御は、先に作用
欄で説明した原理によって、θerr とωerr を０に収束
させる様に作用する。即ち、実ロボットとモデルの傾き
が一致する様に作用する。

【００５４】ここで、図９において、倒立振子型動力学
モデルにモデル操作モーメントＭmdl が加わって、モデ
ルの傾きθmdl とその角速度ωmdl が中立点（直立状
態）から一旦ずれると、このモデルは不安定系であるの
で、θmdl ，ωmdl は発散する。そこで、状態量θmdl
，ωmdl に応じて、次の遊脚着地位置または着地タイ
ミングを変更することによってθmdl ，ωmdl の発散を
抑制する。

【００５５】ところで、基準歩容におけるある一歩（こ
れを「第１歩容」と呼ぶ）において着地位置を変更する
と、次の一歩（これを「第２歩容」と呼ぶ）の初めで
は、支持脚足平の位置だけが、基準の第２歩容の位置か
らずれる。このことを、第２歩容の基準座標から見る
と、支持脚足平は基準歩容のままで、遊脚足平と上体の
位置が変更量だけずれたことに相当する。そのまま放置
すると、第１歩容と第２歩容の境界が不連続になる。そ
こで、ロボット幾何学モデルの歩容が連続となる様に、
歩容の変わり目において次の操作を行う。

【００５６】遊脚軌道は初期位置や次期着地位置などの
足平軌道パラメータで与えられているので、第２歩容の
足平軌道パラメータの一つである初期遊脚位置を−Δｘ
foottotal だけずらす。第２歩容の上体軌道はそのまま
とし、その代わりに倒立振子型動力学モデルの傾き角θ
mdl を−Δｘfoottotal/ｈtrunk だけずらす。この結
果、ロボット幾何学モデルの歩容の連続性を保ちつつ、
倒立振子型動力学モデルの状態量の一つである傾き角θ
mdl を−ｘfoottotal/ｈtrunk だけ操作することができ
る。即ち、着地位置を変更することにより、倒立振子型
動力学モデルの状態量を制御することができる。

【００５７】上記を前提とし、以下図１０フロー・チャ
ートを参照して、着地位置を進行方向に変更した場合の
モデル傾き制御アルゴリズムを説明する。

【００５８】先ず、Ｓ１０において倒立振子型モデルを
安定な直立位置に初期化し、Ｓ１２に進んで歩数カウン
タが基準歩容で設定した目標歩数になるまで、Ｓ１４か
らＳ２６を繰り返す。ここで、用語を次の様に定義す
る。 １．一歩の歩容は、両脚支持期の初めから次の遊脚が着
地するまでの期間を指す。 ２．ある歩容の支持脚とは、その歩容の片脚支持期に支
持脚となる脚とし、遊脚とは、その歩容の片脚支持期に
遊脚となる脚とする。 ３．歩容の基準座標を、その一歩の支持脚の足平接地点
にとることとする。

【００５９】Ｓ１４では今回の歩容パラメータをセット
し、Ｓ１６に進んで前回の歩容の修正後の着地位置と前
回の歩容の基準歩容の着地位置との差を前記したΔｘfo
ottotal とする。次いで、Ｓ１８に進んで今回の歩容の
基準初期遊脚位置からΔｘfoottotal を減算し、Ｓ２０
に進んで倒立振子型モデルの傾斜角θmdl から、Δｘfo
ottotal ／ｈtrunk だけ減算する。

【００６０】次いでＳ２２に進み、一歩分のサンプリン
グ回数だけＳ２４とＳ２６を繰り返す。即ち、Ｓ２４で
１周期が経過したことを確認した後、Ｓ２６に進んで姿
勢演算および制御のサブルーチンを実施する。

【００６１】図１１はそれを示し、先ずＳ１００におい
て実ロボットの傾斜を計測し、前記した様に幾何学モデ
ルに対する姿勢傾き角偏差θerr と傾き角速度偏差ωer
r を求め、Ｓ１０２に進んでそれらから前記したモデル
操作モーメントＭmdl を求め、Ｓ１０４に進んでＭmdl
を倒立振子型モデルの支点に加えてモデルの今回の傾斜
角θmdl と角速度ωmdl を求める。次いでＳ１０６に進
み、前記した理由から上体ずれΔｘを図示の如く求め、
Ｓ１０８に進んで着地までに時間の余裕があれば、倒立
振子型モデルの挙動を予測して着地目標位置パラメータ
の修正量Δｘfootを求め、基準歩容の着地目標位置パラ
メータにΔｘfootを加算し、着地目標位置パラメータを
修正する。

【００６２】これについては先にも述べたが、更に敷衍
すると、着地位置の変更量は、次の一歩の間に、倒立振
子型動力学モデルの傾き角θmdl と傾き角速度ωmdl 、
および幾何学モデルに対する実ロボットの傾き偏差θer
r と傾き角速度偏差ωerr が、なるべく０に収束する様
に決定するべきである。そのためには、θmdl ，ωmdl
，θerr ，ωerr などの現在状態から、着地位置の変
更により、次の一歩の間にθmdl ，ωmdl ，θerr ，ω
err がどの様な挙動を示すかを推測しなければならな
い。

【００６３】θerr とωerr はこの発明の根本原理によ
って０に収束するので、やや予測精度が低下するが、θ
err とωerr の現在状態を無視しても支障ない。つま
り、θmdl とωmdl の現在状態だけから予測計算して着
地位置の変更量を決定しても差し支えない。あるいは、
予め、現在状態と着地位置の変更量との関係をシミュレ
ーションによりマップ化しておいて、実際の歩行時にこ
のマップを用いて着地位置の変更量を決定しても良い。

【００６４】θmdl とωmdl の現在状態だけから着地位
置の変更量を決定する手法としては、竹馬ロボットなど
で行われている様に、倒立振子型動力学モデルの着地瞬
間の全エネルギ予測値が直立時の全エネルギに一致する
様に、変更量を決定する手法が一般的に知られている。
以下にその手法を説明する。

【００６５】着地瞬間の全エネルギ予測値が直立時の全
エネルギに一致するためには、予測される着地直後のθ
mdl とωmdl が数１２の式を満足する様に、着地位置が
決定されなければならない。

【００６６】

【数１２】

【００６７】また、直立状態に近づいていくために、θ
mdl とωmdl が逆極性でなければならないから、即ち、
数１３の式を満足しなければならない。

【００６８】

【数１３】

【００６９】数１２式、数１３式より、数１４の式が得
られる。

【００７０】

【数１４】

【００７１】数１４式を近似すれば、数１５の式が得ら
れる。

【００７２】

【数１５】

【００７３】つまり、予測される直立直後のωmdl とθ
mdl との比が、数１５式で定められる比になる様に着地
位置修正量Δｘfootが決定されれば良い。着地位置を修
正しない場合の予測される着地直後のωmdl とθmdl
は、倒立振子で現在のωmdl ，θmdl ，θerr ，ωerr
から動力学演算により求めることができ、それをωmdle
とθmdleとする。（特に、ωmdl およびθmdl に比べて
θerr およびωerr が無視できるほど小さい場合には、
解析的に容易に求めることができる。）。θmdleをωmd
le／平方根（２ｍｇｈ／Ｉ）に修正できれば、数１５式
を満足する。そのためには、前述の様に、着地位置をΔ
ｘfootだけ修正することによって、θmdlを−Δｘfoot
／ｈtrunk だけ操作することができるので、着地位置修
正量Δｘfootを数１６の式より決定すれば良い。

【００７４】

【数１６】

【００７５】以上の様に、着地位置修正量Δｘfootが決
定され、着地目標位置パラメータｘfootは、歩容の途中
で修正される。この修正は、着地目標位置を変更したと
きの足平の軌道生成計算が大変な場合には、一歩ごとに
１つずつだけ実行されることとなるが、足平の軌道を本
出願人が近時提案した別の技術（平成４年５月２２日出
願、整理番号Ａ９２−０４９３）を用いて発生させれ
ば、着地目標位置の変更をサンプリング周期毎に行うこ
とができる。なぜなら、この技術を用いれば、着地目標
位置パラメータの変更をサンプリング周期ごとに行って
も、足平の軌道は、そこからまた滑らかに修正されるか
らである。但し、着地時刻に近づいてから着地位置を大
幅に変更すると、遊脚軌道が急激に変わるので、着地ま
での残り時間に応じて再修正の可能限界量を求め、それ
を制限値として修正量の変化率にリミットをかけるのが
望ましい。

【００７６】図１１フロー・チャートにおいては次いで
Ｓ１１０に進んでＺＭＰ目標軌道パラメータからＺＭＰ
目標位置を算出し、Ｓ１１２に進んで着地目標位置パラ
メータなどの足平軌道パラメータから両足平の位置・姿
勢を算出し、Ｓ１１４に進んで基準歩容の上***置にθ
mdl とｈtrunk の積を加算した位置を上体目標位置とし
（上体の目標姿勢は基準通りとする）、Ｓ１１６に進ん
でモデル足平修正によるコンプライアンス制御を行う。

【００７７】図１２はそれを示すサブルーチン・フロー
・チャートであり、先ずＳ２００において６軸力センサ
３６の検出値を取り込み、Ｓ２０２に進んでそれからＺ
ＭＰ目標位置まわりの実床反力モーメントＭact を求
め、Ｓ２０４に進んで図示の様に座標回転角θctrlを算
出し、Ｓ２０６に進んでその値だけ両足平の位置・姿勢
をＺＭＰまわりに回転させ、幾何学モデルの両足平の位
置・姿勢とする。尚、この制御は先の出願（平成４年４
月３０日）に詳細に述べられているので、ここではこの
程度の説明に止める。

【００７８】次いで、図１１フロー・チャートに戻り、
Ｓ１１８に進んで上体目標位置・姿勢と修正された足平
位置・姿勢から幾何学モデルの関節変位を求め、Ｓ１２
０に進んで実ロボットの関節変位を幾何学モデルの変位
に追従させる制御を行う。

【００７９】この実施例は上記の如く、モデルに対する
実ロボットの傾き制御と倒立振子モデルの傾き偏差の一
歩ごとの離散制御により、安定な歩行を実現することが
できる。更に、故意にずらすＺＭＰをモデルのそれとし
たので、先に提案した制御に比べてＺＭＰの移動範囲を
大きくとることができ、姿勢復元力を大きくすることが
できる。従って、何らかの外乱によって傾き偏差が非常
に大きくなっても、接地性を確保したまま、姿勢を安定
に回復することができる。また、姿勢が崩れたときはモ
デルの姿勢をそれに応じて一旦崩し、その後に姿勢を回
復させると共に、実ロボットをそのモデルの姿勢を追従
する様に制御することから姿勢回復を滑らかな動きで実
現することができる。更に、モデルは床と干渉しないこ
とから、モデルに追従する実ロボットも床と干渉するこ
とがなく、また着地衝撃も小さい値に抑制することがで
きる。

【００８０】図１３はこの発明の第２実施例を示すブロ
ック図である。第１実施例では倒立振子モデルの傾斜制
御において、着地位置を操作量としていたが、第２実施
例ではモデル操作モーメントに、新たに倒立振子モデル
の傾斜に応じた操作量を加えて安定化を図る様にした。

【００８１】また第２実施例においては、幾何学モデル
に対する実ロボットの傾き角偏差θerr をＰＤなどのフ
ィードバック則Ｈ１（Ｓ）を通して得られる実傾き偏差
制御要求制御量Ｍerrdmd（即ち、Ｍerrdmd＝Ｈ１（Ｓ）
θerr ）と、倒立振子モデルの傾斜角θmdl をフィード
バック則Ｈ２（Ｓ）を通して得られるモデル傾き制御要
求制御量Ｍmdldmd（即ち、Ｍmdldmd＝Ｈ２（Ｓ）θmdl
）をリミッタおよび分配器に通して実モーメント操作
量Ｍactcomm とモデルモーメント操作量Ｍmdl に分配す
る様にした。

【００８２】図１４にリミッタおよび分配器を示す。こ
の例においては、実モーメント操作量Ｍactcomm は、Ｍ
errdmdとＭmdldmdの和にリミッタをかけることによって
求められる。このリミッタ作用により、実ロボットの床
反力が存在可能領域から超えない様に管理され、実ロボ
ットの接地性が確保される（例えば、平地歩行であれ
ば、床反力のＺＭＰが接地面を含む最小凸多角形の中に
あることが、床反力の存在可能条件である。）。

【００８３】モデルモーメント操作量Ｍmdl は、Ｍmdld
mdに前記リミッタの入力超過分を加えることによって求
められ、第１実施例と同様、倒立振子型ロボット摂動動
力学モデルに入力される。また、ＺＭＰまわりの実床反
力モーメントＭact から床反力モーメントフィードバッ
ク則によって、床反力モーメントフィードバック操作量
θcompが求められる。Ｍactcomm とコンプライアンス定
数Ｋcompの積に床反力モーメントフィードバック操作量
θcompを加えることにより、仮想床傾斜角指令が求めら
れる。幾何学モデルの足平位置は、目標足平軌道生成部
で生成される基準歩容の足平位置をＺＭＰ目標位置を中
心として、仮想床傾斜角指令の分だけ、座標回転させら
れる。

【００８４】実ロボットの傾き角偏差θerr の挙動を決
定するものは、ＺＭＰまわりの実床反力モーメントＭac
t とモデルモーメント操作量Ｍmdl の差である。ところ
で、コンプライアンス制御が十分に柔らかければ、Ｍac
t は実モーメント操作量Ｍactcomm にほぼ一致する。従
って、この場合、実ロボットの傾き角偏差θerr の挙動
を決定するものは、Ｍactcomm とＭmdl の差であると言
っても良い。Ｍactcomm とＭmdl の差は、前記リミッタ
が働いても働かなくても常にＭerrdmdとなるので、幾何
学モデルに対する実ロボットの傾き角偏差θerr を０に
収束させる制御は常に働く。

【００８５】一方、モデルの傾き角θmdl の挙動を決定
するものは、Ｍmdl である。Ｍmdlは、前記リミッタが
働いていないときにはＭmdldmdに一致し、モデルの傾き
を０に収束させる制御が正常に働く。前記リミッタが働
いているときには、幾何学モデルに対する実ロボットの
傾き角偏差θerr を０に収束させる制御を優先した上
で、可能な範囲でモデルの傾きを０に収束させようと作
用する。更に、Ｍerrdmdがリミッタ設定値に比べて過大
である場合にはモデルの傾き制御が犠牲になり、モデル
の傾きは発散しようとすることもある。即ち、実ロボッ
トのＺＭＰが存在可能領域の限界までまだ余裕があると
きのみ、倒立振子モデル傾斜制御が実行される。従っ
て、瞬間的な外乱や微小外乱に対しては、倒立振子モデ
ルが直立状態に回復できるが、大きな外乱が継続する
と、倒立振子モデルが直立状態に回復できなくなり、ロ
ボット幾何学モデルの姿勢が大きく崩れて転倒する。し
かし、足平の軌道が基準歩容通りであるので、階段や飛
び石の上を歩行するときの様に、着地位置が制約されて
いる際には、第２実施例は好適である。

【００８６】ここで、倒立振子モデルの傾き制御ゲイン
の設定について説明する。モデルの傾き角θmdl を０に
収束させる制御則を、例えば数１７の式で与えるものと
する。

【００８７】

【数１７】

【００８８】単純倒立振子を、現在状態から、支点にモ
ーメントを加えず、フリーな運動をさせるときに、直立
状態で静止するためには、現在の全エネルギが直立静止
状態の全エネルギに一致していなければならない。つま
り、数１８の式が成立していなければならない。

【００８９】

【数１８】

【００９０】また、直立状態に近づいていくために、ω
mdl とθmdl が逆極性でなければならないから、数１９
の式を満足しなければならない。

【００９１】

【数１９】

【００９２】数１８、数１９式より、数２０の式を得
る。

【００９３】

【数２０】

【００９４】数２０式を近似して数２１の式を得る。

【００９５】

【数２１】

【００９６】数２１式を満足した状態にあれば、倒立振
子モデルの支点にモデル操作モーメントＭmdl を加えな
くても、直立状態で静止する。従って、数２１式を満足
する状態でモデル操作モーメントＭmdldmdが０になる様
に制御則を設定すれば、倒立振子モデルに必要以上の余
分なモデル操作モーメントＭmdl を発生させず、直立状
態に収束させることができる。この様な制御則で数１７
の式を満足するものは、数２２の式である。

【００９７】

【数２２】

【００９８】数２２式を満足していても、Ｋωをやや小
さめに設定すると、倒立振子の挙動にオーバーシュート
が発生する。Ｋωをもっと小さく設定すると、重力モー
メントに負けて直立状態に復元できなくなる。直立状態
に復元できてかつオーバーシュートが発生しない様にす
るためには、フィードバックループの特性根が負の実数
になることであり、そのためには、Ｋωは次の数２３式
を満足しなければならない。

【００９９】

【数２３】

【０１００】数２２と数２３の式を満足する様にゲイン
を設定すれば、Ｍmdldmdの絶対値が小さく抑えられてＭ
actcomm の絶対値も小さく抑えられるので、実ロボット
の接地性が高くなる。

【０１０１】図１５から図１７は第２実施例の制御を示
すフロー・チャートであり、うち図１５はＳ３００から
Ｓ３１０にメイン・ルーチンを、図１６はＳ４００から
Ｓ４２２にその姿勢演算および制御のサブ・ルーチン
を、図１７はＳ５００からＳ５０６にそのコンプライア
ンスおよび姿勢安定化制御のサブ・ルーチンを示す。第
１実施例と相違する点に焦点をおいて説明すると、図１
５フロー・チャートにおいてＳ３０４とＳ３０６との間
には第１実施例の図１０のＳ１６からＳ２０に相当する
ステップは存在しない。これは、姿勢演算および制御の
サブルーチンで着地位置修正を行っていないためであ
る。また、図１６の姿勢演算および制御サブルーチン・
フロー・チャートにおいては、先に述べた構成からＳ４
０２からＳ４０６が追加されると共に、第１実施例の図
１１のＳ１０８に相当するステップは削除される。また
図１７サブルーチン・フロー・チャートにおいてはＳ５
０４の座標回転角の演算で先に述べた様に、実ロボット
操作モーメントＭactcomm にコンプライアンス定数Ｋco
mpを乗じたものが加算される。尚、残余の構成は、第１
実施例と相違しない。

【０１０２】第２実施例は足平の軌道が基準歩容通りで
あることから、階段や飛び石の上を歩行するときなど、
着地位置が制約される際に特に好適である。

【０１０３】図１８はこの発明の第３実施例を示すブロ
ック図である。第３実施例では、倒立振子モデルの傾斜
制御において、第１実施例と第２実施例の制御を併用し
た。倒立振子モデルを直立状態に回復させるために、瞬
間的な外乱や微小外乱に対しては、主に倒立振子モデル
にモーメントを加える制御が働き、大きな外乱が継続す
ると、主に着地位置や着地タイミングを修正する制御が
働く。

【０１０４】第３実施例においても、着地位置や着地タ
イミングの修正量は、第１実施例と同様、倒立振子モデ
ルが直立状態に戻る様に決定される。第１実施例に比べ
ると、モデル傾き制御要求制御量Ｍmdldmdの影響がある
分だけ、モデルの挙動予測演算が複雑になる様に見える
が、モデル傾き制御要求制御量Ｍmdldmdにより、倒立振
子モデルの発散が抑えられるので、むしろ予測精度が高
いとも言える。特に、第２実施例で述べた倒立振子モデ
ルの傾き制御ゲインの設定値（数２２式と数２３式を満
足するゲイン）を採用すれば、倒立振子モデルの全エネ
ルギが直立時の全エネルギに一致しているときには、モ
デル傾き制御要求制御量Ｍmdldmdが０になるので、第１
実施例で説明した、倒立振子型動力学モデルの着地瞬間
の全エネルギ予測値が直立時の全エネルギに一致する様
に、着地位置変更量を決定する手法をそのまま活用する
ことができる。

【０１０５】図１９は第３実施例のＳ６００からＳ６１
６よりなるメイン・ルーチン・フロー・チャート、図２
０はＳ７００からＳ７２４よりなるその姿勢演算および
制御サブルーチン・フロー・チャート、図２１はＳ８０
０からＳ８０６よりなるそのコンプライアンスおよび姿
勢安定化制御サブルーチン・フロー・チャートである。
図１９のメイン・ルーチン・フロー・チャートは第１実
施例のそれと、図２１のサブルーチン・フロー・チャー
トは第２実施例のそれと同様である。また図２０の姿勢
演算および制御サブルーチン・フロー・チャートは、第
２実施例と比べて、着地目標位置パラメータを修正する
ステップＳ７１２が追加されている点で異なるのみであ
る。尚、残余の構成は従前の実施例と相違しない。

【０１０６】第３実施例の場合、前述の如く、倒立振子
モデルを直立状態に回復させるために、瞬間的な外乱や
微小外乱に対しては主に倒立振子モデルにモーメントを
加える制御が働き、大きな外乱が継続すると主に着地位
置や着地タイミングを修正する制御が働くので、第１実
施例に比べ、着地位置の変更量が少なくなり、歩行経路
のふらつきが小さくなると共に、第１実施例、第２実施
例よりも安定度が一層向上する。

【０１０７】図２２はこの発明の第４実施例を示すブロ
ック図である。第１から第３までの実施例では、ロボッ
トのモデルを、基準歩容からの上***置摂動分に対する
動力学モデルと、上体や足平位置と関節角の関係を表現
する幾何学モデルに分割して備えていた。それに対し、
第４実施例では、剛体リンクで構成される動力学・幾何
学複合モデルを備える様にした。その他は後で述べる様
に、大局的姿勢制御部の詳細が異なることを除くと、第
１実施例とほぼ同一構成である。

【０１０８】第４実施例において、歩容は、ＺＭＰ目標
位置、および両足平の位置・姿勢で表現される。両足平
の位置・姿勢については、一歩ごとの足平軌道パラメー
タ（例えば、遊脚着地位置や着地時刻など）が、大局的
姿勢制御部から目標足平軌道生成部に与えられ、目標足
平軌道生成部において、リアルタイムに各瞬間のそれら
の位置や姿勢が算出される。ＺＭＰ目標軌道について
は、一歩ごとのＺＭＰ目標軌道パラメータが、大局的姿
勢制御部からＺＭＰ目標軌道生成部に与えられ、ＺＭＰ
目標軌道生成部においてリアルタイムに各瞬間のその位
置が算出される。上体の位置・姿勢については、第１実
施例ないし第３実施例ではＺＭＰ目標軌道を満足する様
に、予めオフラインで作成された時系列データとして大
局的姿勢制御部に記憶されていたが、第４実施例ではロ
ボットの幾何学・動力学モデルにてモデルの両足平の位
置・姿勢、ＺＭＰ目標軌道およびＺＭＰ目標位置まわり
のモデル操作モーメントを基に、リアルタイムに生成さ
れる。

【０１０９】第４実施例のロボットモデルでは、両足平
の位置・姿勢は、足平軌道生成部から与えられた足平の
位置・姿勢を仮想床傾斜指令θctrlだけ座標回転させた
位置・姿勢に変換される。ロボットモデルでは、上体の
位置・姿勢が、ＺＭＰ目標位置に発生する床反力モーメ
ントがＭmdl となる様に動力学計算によって求められ、
同時に各関節の変位が求められる。尚、Ｍmdl が０のと
きには、ロボットモデルのＺＭＰ位置はＺＭＰ目標位置
に一致するが、Ｍmdl が０でないときには、ＺＭＰ目標
位置にモーメントが発生していることから、もはやＺＭ
Ｐ目標位置はロボットモデルのＺＭＰ位置ではなく、ロ
ボットモデルのＺＭＰ位置は、ＺＭＰ目標位置からずれ
たところに存在する。

【０１１０】モデルの床面には、あらゆる全床反力が発
生可能であると仮定する。即ち、モデルの接地面には吸
着力も発生可能であるとし、例えば、平地歩行において
ＺＭＰが接地面を含む最小凸多角形を超えても、接地面
が離れない（脚と床の間の拘束条件が所期通り確保され
る）ものとする。この様に想定することによって、モデ
ルに対する実ロボットの傾き偏差制御において、実ロボ
ットの全床反力を操作するだけでは不可能であった大き
な復元作用も発生可能となる。従って、フィードバック
ゲインを大きくして短時間で偏差を０に収束させること
ができる。つまり、実ロボットは、関節変位のみなら
ず、傾きまでもモデルに高応答で追従する。但し、モデ
ルの全床反力の床法線方向成分は、上向き（正）になる
様にとるべきである。なぜなら、そうしないと、実ロボ
ットが一瞬床から浮いてしまう恐れがあるからである。

【０１１１】第４実施例においては、大局的姿勢制御部
において、モデルの挙動やモデルに対する実ロボットの
傾き偏差などから、次の着地位置、着地タイミングまた
はＺＭＰ目標軌道などの歩容パラメータを決定する。第
１から第３実施例では基準歩容が存在するので、基準歩
容からのずらし量を決定するだけで済むが、第４実施例
においては基準歩容が存在しないので、歩容パラメータ
の決定が難しくなる。決定をなるべく容易にするために
は、ある基準点から見たロボット全体の角運動量や重心
位置などのマクロな状態量に着目すれば良い。局所的姿
勢制御がこれらのマクロな状態量にあまり影響を与えな
い場合には、これらのマクロな状態量だけから将来の挙
動を予測し、それらのマクロな状態量が発散しない様に
歩容パラメータを決定すれば良い。具体的には、先に述
べた竹馬型２足歩行ロボットの着地位置制御で行われて
いる手法を用いたり、シミュレーションによりマクロな
状態量に応じた適切な着地位置を予め学習させておく手
法などが考えられる。

【０１１２】第４実施例のロボットにおいては、ゆっく
り歩行する場合には遊脚の反動が無視でき、単純倒立振
子で近似することができる。ロボットが単純倒立振子で
近似できる場合には、角運動量を縦軸に、重心位置を横
軸にとったときの軌跡は、双曲線上を移動することが知
られているので、挙動が解析的に予測でき、着地位置決
定も解析的に行うことができる。竹馬型２足歩行ロボッ
トの着地位置制御では、これを利用している。第４実施
例のロボットが高速で歩行する場合（例えば、３ｋｍ／
ｈなど）には、遊脚の反動が無視できなくなり、単純倒
立振子で近似できなくなる。この場合には、解析的な決
定法ではなく、マクロな状態量に応じた適切な着地位置
を予め学習させる手法などが有効である。学習には、人
工知能、ファジー、ニューロなどが使用できよう。

【０１１３】図２３は第４実施例のＳ９００からＳ９１
０よりなるメイン・ルーチン・フロー・チャートを、図
２４はＳ１０００からＳ１０１４よりなるその姿勢演算
および制御サブルーチン・フロー・チャートを、図２５
はＳ１１００からＳ１１０６よりなるそのコンプライア
ンス制御サブルーチン・フロー・チャートを示す。図２
５サブルーチン・フロー・チャートは、第１実施例のそ
れと同様である。

【０１１４】第４実施例においては、第１実施例に比べ
て動力学モデルがより精密になっているので、より正確
な姿勢制御が実現される。特に、大きな外乱が加わって
モデルの姿勢が大幅に崩れても、転倒することなく、復
元することができる。

【０１１５】図２６はこの発明の第５実施例を示すブロ
ック図である。この例において大局的姿勢制御部はな
く、歩容パラメータ決定部は、予め外乱がない状況で長
期的に安定な歩行が実現できる様に設定された一連の歩
容パラメータを吐き出しているだけである。

【０１１６】第５実施例において、ロボットの幾何学・
動力学モデルとしては、第１モデルと第２モデルの２つ
が備えられる。第１モデルと第２のモデルの初期状態
は、前記の予め設定された一連の歩容の初期状態に一致
させておく。第１モデルには目標足平軌道とＺＭＰ目標
軌道が与えられ、ＺＭＰ目標軌道を満足する様に上体軌
道が生成される。歩容パラメータ決定部が上に述べた様
に、予め外乱がない状況で長期的に安定な歩行が実現で
きる様に設定された一連の歩容パラメータを吐き出して
いるので、第１モデルの挙動は、その通り忠実に再現す
る。第２モデルには、目標足平軌道とＺＭＰ軌道以外
に、第１モデルと第２モデルの上***置の差を０に収束
させる制御の操作量と、第２モデルと実ロボットの姿勢
傾斜ずれを０に収束させる制御の操作量が、ＺＭＰ目標
位置まわりにモーメントとして加えられる。

【０１１７】第２モデルに対する実ロボットの傾き角偏
差θerr をＰＤなどのフィードバック則Ｈ１（Ｓ）を通
して得られる実傾き偏差制御要求制御量Ｍerrdmdと、第
１モデルに対する第２モデルの上***置ずれをフィード
バック則Ｈ２（Ｓ）を通して得られるモデル上***置制
御要求制御量Ｍmdldmdを第２実施例で用いたと同様なリ
ミッタおよび分配器を通して、実モーメント操作量Ｍac
tcomm とモデルモーメント操作量Ｍmdl に分配する。

【０１１８】ＺＭＰまわりの実床反力モーメントＭact
から床反力モーメントフィードバック則によって床反力
モーメントフィードバック操作量θcompが求められる。
Ｍactcomm とコンプライアンス定数Ｋcompの積に床反力
モーメントフィードバック操作量θcompを加えることに
より、仮想床傾斜角指令θctrlが求められる。第２モー
メントの足平位置は、目標足平軌道生成部で生成される
足平位置をＺＭＰ目標位置を中心として、仮想床傾斜角
指令の分だけ、座標回転させられる。

【０１１９】第１モデルと第２モデルは、第４実施例の
それと同一で良い。但し、第１モデルにはモデルモーメ
ント操作量Ｍmdl と仮想床傾斜角指令θctrlが与えられ
ないので、第１モデルを第２モデルと同一のプログラム
で作るならば、第１モデルに入力されるＭmdl とθctrl
を０にしておけば良い。

【０１２０】図２７は第５実施例のＳ１２００からＳ１
２１０よりなるメイン・ルーチン・フロー・チャート
を、図２８はＳ１３００からＳ１３１８よりなるその姿
勢演算および制御サブルーチン・フロー・チャートを、
図２９はＳ１４００からＳ１４０６よりなるそのコンプ
ライアンスおよび姿勢安定化制御サブルーチン・フロー
・チャートを示す。第２実施例のそれらとほぼ同様であ
る。

【０１２１】第２実施例では予め上体軌道が生成されて
いるのに対し、第５実施例では目標ＺＭＰ軌道を満足す
る様に、第１モデルにおいてリアルタイムに上体軌道が
生成される。第５実施例の効果は、本質的に第２実施例
と同じである。ただ、動力学モデルがより忠実になって
いるため、姿勢安定化制御の精度が高く、モデルの姿勢
が大きく崩れても復元することができる。

【０１２２】図３０はこの発明の第６実施例を示すブロ
ック図である。第６実施例ではモデルの姿勢安定化にお
いて、第４実施例と第５実施例の制御を併用した。第６
実施例においては、第２モデルの角運動量や重心位置な
どのマクロな状態量をある範囲に収めるために、瞬間的
な外乱や微小外乱に対しては主に実ロボットと第２モデ
ルにモーメントを加える制御が働き、大きな外乱が継続
すると、主に着地位置や着地タイミングを変更する制御
が働く。

【０１２３】第１モデルは、歩容の切り替わり目におい
て、第２モデルの状態に合わせる（つまり、一歩ごとの
歩容の初めに強制的に第１モデルの初期状態を第２モデ
ルのそのときの状態に合わせる）。こうしないと、過大
な外乱が長期的に実ロボットに加わって、第２モデルに
対する実ロボットの傾斜ずれが大きくなったときに、こ
の傾斜ずれを修正しようとして第２モデルに大きな操作
モーメントが作用すると、第１モデルと第２モデルの姿
勢ずれを０に収束させる制御が十分効かず、第１モデル
と第２モデルの姿勢ずれが発散してしまうからである。
但し、第１モデルの初期状態を第２モデルに急激に合わ
せると、第１モデルと第２モデルの姿勢ずれを０に収束
させる制御の操作量が急激に変化する恐れがあるので、
第１モデルと第２モデルの姿勢ずれを０に収束させる制
御のフィードバックゲインを歩容の変わり目の直前に連
続的に下げておいた方が良い。

【０１２４】第４実施例では不確定な外乱が実ロボット
に加わることによって、モデルの挙動も不確定な挙動を
示すため、モデルの将来挙動の予測精度が低下する。第
６実施例では、一歩の間、第２モデルは第１モデルの挙
動に収束しようとする。一歩の間、第１モデルの挙動に
は実ロボットに加わる外乱の影響を受けないので、第１
モデルの挙動は、確定的に予想できる。従って、実ロボ
ットに加わる外乱によって第２モデルの挙動が変化して
も、しばらくすれば第１モデルの挙動に収束しようとす
るので、第２モデルの挙動の不確定性が減少する。即
ち、第６実施例では、第４実施例に比べ、着地位置など
の歩容パラメータを操作することによる姿勢安定化作用
がより確実に働くこととなる。

【０１２５】図３１は第６実施例のＳ１５００からＳ１
５１０よりなるメイン・ルーチン・フロー・チャート、
図３２はＳ１６００からＳ１６２０よりなるその姿勢演
算および制御サブルーチン・フロー・チャート、図３３
はＳ１７００からＳ１７０６よりなるそのコンプライア
ンスおよび姿勢安定化制御サブルーチン・フロー・チャ
ートである。

【０１２６】第６実施例の場合は、第４実施例に比べ、
モデルの将来の挙動の不確定性が小さいので、より確実
かつ長期的な姿勢安定化が実現される。

【０１２７】尚、第６実施例では、第１モデルと第２モ
デルの偏差を歩容の切り替わり目で強制的に０にしてい
たが、それ以外の時期でも偏差が過大になったとき、第
１モデルと第２モデルロボットの偏差を０に収束させる
様に第１モデルに操作モーメントを加える制御を実行し
ても良い。但し、第１モデルに操作モーメントを加える
と、上体の位置がずれて第１モデルの姿勢が崩れようと
する。そこで、姿勢の崩れを防ぐために、第１モデルに
操作モーメントを加えるときには同時に着地位置などの
歩容パラメータも修正する。ところで、着地直前に、着
地位置や着地時期を大きく変更すると、脚の挙動が急激
に変化する。即ち、着地までの時間余裕が少なくなって
くるにつれ、着地位置や着地時期の修正可能量は小さく
なる。従って、第１モデルに操作モーメントを加え、そ
れに見合った着地位置などの修正を行う際には、着地ま
での時間余裕が少なくなるにつれ、操作モーメントの印
加量の制限値も小さくするべきである。

【０１２８】更に、第５、第６実施例においては、動力
学モデルが２段に構成されている。これを更に段数を増
やし、実ロボットとモデルとの偏差、およびモデルと他
のモデルとの偏差を制御する様にしても良い。上位のモ
デル（即ち、多段連結モデルのうちで実ロボットから遠
く離れているモデル）ほど実ロボットに作用する外乱の
影響が小さくなり、モデルの挙動予測精度が高くなる。
従って、上位のモデルの挙動を基に着地位置修正量を求
めれば、上位のモデルの姿勢安定性が確保でき、それよ
り下位のモデルはモデル操作モーメントを制御すること
によって上位のモデルに追従するので、結果的に実ロボ
ットと全モデルすべての姿勢安定性が確保される。摂動
モデルを用いた場合も同様である。

【０１２９】ここで、第２実施例などで用いたリミッタ
および分配器について説明を補足する。リミッタおよび
分配器の目的は、実ロボットの接地性を確保しながら、
制御操作量を分配することであるが、リミッタの変形例
としては、第２実施例で挙げた例以外に、以下の様な手
法やそれらの組み合わせが考えられる。 ａ．制御則によってモーメントの次元で算出される操作
量に、一定の制限を加える手法 ｂ．床反力の床垂直方向成分の実際値あるいは設計値に
応じて、モーメントの次元で算出される操作量の制限値
を変動させる手法 この場合、（ＺＭＰのずれ量＝モーメント／床反力垂直
成分）であるから、リミッタは、ＺＭＰ目標位置からＺ
ＭＰ存在領域の境界までの距離余裕×床反力垂直成分の
値に応じて変動させる方が、より的確に接地性が確保さ
れる。 ｃ．目標ＺＭＰ位置からＺＭＰ存在可能領域の境界まで
の余裕によって、モーメントの次元で算出される操作量
の制限値を変動させる手法 例えば、平地歩行では両脚支持期の間はＺＭＰ存在可能
領域が大きいので、実ロボットに大きな復元力を発生さ
せることができる。 ｄ．制御則によって求められる操作量を一旦ＺＭＰ位置
のずれに変換し、これに目標ＺＭＰ位置からＺＭＰ存在
可能領域の境界までの余裕に応じた制限を加える手法 ｅ．操作量がＰＤ制御則によって求められる場合、Ｐ成
分から求められる操作量にのみ制限を加え、発振を抑え
るダンピング効果を持つＤ成分には制限を加えない手
法、あるいはその逆の手法 ｆ．実床反力モーメントＭact が限界値を超えない様
に、Ｍact に応じて制限値が可変となるリミッタに、実
床反力操作モーメントＭactcomm を通す手法 ｇ．Ｍact が限界値を超えたら、超えた分に、あるゲイ
ンを乗じてＭactcomm から減算する手法 ｈ．実ロボットの床反力計測値から実ロボットのＺＭＰ
位置を求め、これがＺＭＰ存在可能領域を超えそうにな
ったら、それ以上Ｍactcomm の絶対値を増やさない手法

【０１３０】更に、分配を数２４の式の様に単純に比例
配分する手法も考えられる。

【０１３１】

【数２４】

【０１３２】また、周波数帯域に応じて分配する手法も
考えられる。例えば、実ロボットの床反力操作量Ｍactc
omm には、実傾き偏差制御要求制御量Ｍerrdmdとモデル
傾き（あるいはモデル上***置）制御要求制御量Ｍmdld
mdの高域成分だけを与え、低域をモデル操作量Ｍmdl に
与えれば、リミッタをかけなくても実ロボットの床反力
操作量は小さく抑えられるので、接地性は高くなる。

【０１３３】また、第２実施例ではフィードバック則で
操作量を求めてから、リミッタおよび分配器に通してい
るが、逆の順序で求めても良く、あるいは分配器の前後
両方にリミッタを挿入する手法なども考えられよう。

【０１３４】更に、第１実施例から第６実施例で述べた
歩容についての記述を補足すると、通常、歩容は接地を
確保するための床反力に関する要件とその他の拘束条件
により記述され、これらを満足する様に関節変位が決定
される。拘束条件としては、足平軌道や上体姿勢、関節
の変位が無理な挙動をしないための上体高さの決定式な
どが用いられる。床反力に関する要件としては、代表的
なものとして例えば、平面床歩行においてはＺＭＰの存
在可能領域が知られている。接地面を含む最小凸多角形
がＺＭＰの存在可能領域であり、その中にＺＭＰ目標軌
道を設定し、歩容からオイラー・ニュートン方程式など
を用いて動力学的に求められるＺＭＰが、ＺＭＰ目標軌
道に一致する様に歩容が生成される。また、床反力に関
する要件の代わりに、足首トルクの様なある特定の部位
に作用する力やモーメントに関する要件を与えても良
い。例えば、２足歩行ロボットの片脚支持期において
は、支持脚足首は床に近いので、足首トルクは、足首の
床への垂直投影点に作用する床反力モーメントと密接な
関係を持つからである。

【０１３５】また、動力学モデルでは、目標床反力の要
件を満足するモデルの挙動を求めなければならない。目
標床反力の要件とは、例えば、ＺＭＰ目標位置にモーメ
ントＭmdl が発生することである。ところで、モデルの
足平位置・姿勢と上体の姿勢は歩容生成部から与えられ
ているので、片脚あたり６自由度の実施例に係るロボッ
トでは、上体の姿勢を決定すれば、全関節の変位が決定
される。上体のうち、高さは例えば、各瞬間における膝
などの関節の変位、速度、加速度などがアクチュエータ
の能力を超えない様に、かつ床垂直抗力が負にならない
様に決定される。従って、上体の位置のうちで、残った
上体の前後左右の挙動によって目標床反力の要件を満足
させることとなる。しかし、各瞬間における目標床反力
の要件を満足する上体前後左右位置を解析的に直接求め
ることは困難であるので、実際には逆に上体の位置を与
え、それに対する床反力を求めながら、擬似的なニュー
トン法などの収束法により、目標床反力の要件を満足す
る上体の位置を探索する。尚、演算の高速性を重視する
場合には、多少の誤差を生じても、探索回数に制限を加
えれば良い。極端な場合、探索回数は１回にしても良い
であろう。

【０１３６】また、両脚支持期にはＭact を大きくして
も接地性が失われない。そこで、両脚支持期にリミッタ
制限値を大きくしたり、モデル上***置制御則などのゲ
インを高くしても良い。

【０１３７】また、歩行の環境や目的によって、姿勢を
重視したいときと、階段や飛び石上の歩行の様に着地位
置精度を重視したいときとがある。そこで、各制御ゲイ
ンを可変にすると、状況に応じたより緻密な制御が実現
できる。例えば、姿勢安定を重視したいときには、モデ
ル上***置制御（あるいはモデル傾き制御）の制御ゲイ
ンを下げて要求制御量Ｍmdldmdを小さくし、モデル傾き
（あるいはモデル上***置）を０に収束させる制御を主
に着地位置などの歩容パラメータ修正によって行う。こ
うすれば、実ロボットの操作モーメントＭactcomm が小
さくなって、実ロボットのＺＭＰ位置がＺＭＰ存在可能
領域の中央付近に寄ってくるので、安定余裕が大きくな
るからである。但し、その代わり着地位置などの歩容パ
ラメータが大きく修正されるので、着地位置精度は悪く
なる。また歩行の環境や目的によって、制御則の周波数
ゲイン特性を調整しても、状況に応じたより緻密な制御
が実現できる。

【０１３８】尚、上記した第１ないし第６実施例におい
て、実ロボットの床反力のフィードバック制御として、
コンプライアンス制御を導入しているが、トルク制御を
導入しても良い。床の形状が既知で、床の凹凸による外
乱があまり発生しない場合や、メカニカル機構によって
コンプライアンスが実現されている場合には、特に床反
力フィードバック制御を行わなくても良い。その場合で
もこの発明の効果が失われる訳ではない。

【０１３９】更に、上記において２足歩行の脚式移動ロ
ボットを例にとって説明してきたが、それに限られるも
のではなく、この発明は３足以上の脚式移動ロボットに
も妥当し、更には脚式に限らず、車輪型やクローラ型な
ど他の形態の移動ロボットに妥当するものである。

【０１４０】

【発明の効果】請求項１項にあっては、制御対象のモデ
ルを少なくとも１つ備えるモデル追従型の脚式移動ロボ
ットの姿勢安定化制御装置であって、前記モデルと実ロ
ボットの傾斜などの状態量の偏差に応じた操作量を少な
くとも前記モデルにフィードバックしてモデルの挙動を
修正する様に構成したので、何らかの外乱などによって
前記傾き角（角速度）偏差が非常に大きくなっても、接
地性を確保したまま（即ち、足裏が浮かない様にしなが
ら）、前記モデルと実ロボットの床反力の差を活用して
大きな姿勢復元作用を得ることができる。またモデルは
床と干渉しないから、モデルに追従する実ロボットも床
と干渉せず、着地衝撃を小さい値に抑制することができ
る。

【０１４１】請求項２項にあっては、制御対象のモデル
を少なくとも２つ備えるモデル追従型の脚式移動ロボッ
トの姿勢安定化制御装置であって、前記モデルと実ロボ
ットの傾斜などの状態量の偏差及び／又は前記モデル間
の傾斜などの状態量の偏差に応じた操作量を少なくとも
前記モデルのいずれかにフィードバックしてモデルの挙
動を修正する様に構成したので、上位のモデル（即ち、
多段連結モデルのうちで実ロボットから遠く離れている
モデル）ほど実ロボットに作用する外乱の影響が小さく
なり、モデルの挙動予測精度が高くなって、実ロボット
と全モデルすべての姿勢安定性を一層確実に実現するこ
とができる。

【０１４２】請求項３項にあっては、制御対象のモデル
を少なくとも１つ備えるモデル追従型の脚式移動ロボッ
トの姿勢安定化制御装置であって、前記モデルと実ロボ
ットの傾斜などの状態量の偏差に応じた操作量を前記モ
デルと実ロボットに分配しつつフィードバックしてモデ
ルの挙動を修正する様に構成したので、請求項１項で述
べた効果に加え、モデルの姿勢の崩れをある程度は抑制
することができる。

【０１４３】請求項４項にあっては、制御対象のモデル
を少なくとも１つ備えるモデル追従型の脚式移動ロボッ
トの姿勢安定化制御装置であって、前記モデルに対する
実ロボットの傾き偏差に応じて前記モデルに与える床反
力目標値を修正し、修正された床反力目標値を満足する
様に前記モデルの歩容を修正して前記傾き偏差を収束さ
せる様に構成したので、請求項１項で述べた効果をより
直接的に得ることができる。

【０１４４】請求項５項にあっては、制御対象のモデル
を少なくとも１つ備えるモデル追従型の脚式移動ロボッ
トの姿勢安定化制御装置であって、前記モデルと実ロボ
ットの傾き偏差に応じた操作量を前記モデルと実ロボッ
トに分配しつつ与えて床反力目標値を修正し、修正され
た床反力目標値を満足する様に前記モデルも歩容を修正
して前記傾き偏差を収束させる様に構成したので、請求
項１項で述べた効果をより直接的に得ることができると
共に、一層効果的にモデルの姿勢を回復することができ
る。

【０１４５】請求項６項にあっては、脚式移動ロボット
の姿勢安定化制御装置において、実ロボットの力学モデ
ルを基に接地性が保証される様に床反力が設計された基
準歩容からの挙動摂動分と、床反力摂動分の関係を模擬
する少なくとも１つの摂動動力学モデル、目標歩容と実
ロボットの姿勢傾き偏差を検出する手段、および前記偏
差を小さくする様に、前記摂動動力学モデルに床反力を
与え、それによって生じた摂動動力学モデルの変位に応
じて前記基準歩容を修正したものを前記目標歩容として
前記実ロボットの関節変位を追従させる手段を備える様
に構成したので、請求項１項で述べた効果に加えて、演
算量を低減することができ、コンピュータを用いて実現
するときもその能力が低いもので足りる。

【０１４６】請求項７項にあっては、脚式移動ロボット
の姿勢安定化制御装置において、実ロボットの力学モデ
ルを基に接地性が保証される様に床反力が設計された基
準歩容からの挙動摂動分と、床反力摂動分の関係を模擬
する少なくとも１つの摂動動力学モデル、実ロボットの
リンク構造を表す幾何学モデル、前記幾何学モデルと実
ロボットの姿勢傾き偏差を検出する手段、および前記偏
差を小さくする様に前記摂動動力学モデルに床反力を加
え、それによって生じた摂動動力学モデルの変位に応じ
て前記基準歩容を前記幾何学モデル上で修正し、幾何学
モデルの関節変位を目標として前記実ロボットの関節変
位を追従させる手段を備える様に構成したので、請求項
６項で述べた効果に加えて、床との干渉をより小さくす
ることができる。

【０１４７】請求項８項にあっては、少なくとも着地位
置などの歩容パラメータを修正して前記モデルの姿勢を
安定に保つ様に構成したので、従前までの請求項で述べ
た効果に加えて、一層簡易にモデルの姿勢を安定に回復
することができる。

【０１４８】請求項９項にあっては、少なくとも新たな
床反力を加えて前記モデルの姿勢を安定に保つ様に構成
したので、請求項８項で述べたと同様の効果を得ること
ができる。

【０１４９】請求項１０項にあっては、着地位置などの
歩容パラメータを修正すると共に、新たな床反力を加え
て前記モデルの姿勢を安定に保つ様に構成したので、従
前までの請求項で述べた効果に加えて、一層効果的にモ
デルの姿勢を安定に回復することができる。

【図面の簡単な説明】

【図１】図１は本出願人が先に提案したＺＭＰ制御を示
す説明図である。

【図２】図１に示す制御において実ＺＭＰが目標ＺＭＰ
（モデルから設定されるＺＭＰ）からずれた状態を示す
説明図である。

【図３】この発明に係る脚式移動ロボットの姿勢安定化
制御装置の特徴（原理）を示す説明図である。

【図４】この発明の原理（特徴）を説明するものであっ
て、単純な実ロボットの構造パラメータと実ロボットの
基本局所制御を示す説明図である。

【図５】図４に例示したものとこの発明の原理（特徴）
を比較する説明ブロック図である。

【図６】図５に示すブロック図を変形したものを簡略的
に示す説明図である。

【図７】この発明に係る脚式移動ロボットの姿勢安定化
制御装置を全体的に示す概略図である。

【図８】図７に示す制御ユニットのブロック図である。

【図９】この発明の第１実施例の動作を示すブロック図
である。

【図１０】第１実施例の動作を示すメイン・ルーチン・
フロー・チャートである。

【図１１】図１０フロー・チャートのうちの姿勢演算お
よび制御のサブルーチン・フロー・チャートである。

【図１２】図１０フロー・チャートのうちのコンプライ
アンス制御のサブルーチン・フロー・チャートである。

【図１３】この発明の第２実施例の動作を示すブロック
図である。

【図１４】第２実施例で使用するリミッタおよび分配器
を説明するブロック図である。

【図１５】第２実施例の動作を示すメイン・ルーチン・
フロー・チャートである。

【図１６】図１５フロー・チャートの中の姿勢演算およ
び制御のサブルーチン・フロー・チャートである。

【図１７】図１５フロー・チャートの中のコンプライア
ンスおよび姿勢安定化制御のサブルーチン・フロー・チ
ャートである。

【図１８】この発明の第３実施例の動作を示すブロック
図である。

【図１９】第３実施例の動作を示すメイン・ルーチン・
フロー・チャートである。

【図２０】図１９フロー・チャートの中の姿勢演算およ
び制御のサブルーチン・フロー・チャートである。

【図２１】図１９フロー・チャートの中のコンプライア
ンスおよび姿勢安定化制御のサブルーチン・フロー・チ
ャートである。

【図２２】この発明の第４実施例の動作を示すブロック
図である。

【図２３】第４実施例の動作を示すメイン・ルーチン・
フロー・チャートである。

【図２４】図２３フロー・チャートの中の姿勢演算およ
び制御のサブルーチン・フロー・チャートである。

【図２５】図２３フロー・チャートの中のコンプライア
ンス制御のサブルーチン・フロー・チャートである。

【図２６】この発明の第５実施例の動作を示すブロック
図である。

【図２７】第５実施例の動作を示すメイン・ルーチン・
フロー・チャートである。

【図２８】図２７フロー・チャートの中の姿勢演算およ
び制御のサブルーチン・フロー・チャートである。

【図２９】図２７フロー・チャートの中のコンプライア
ンスおよび姿勢安定化制御のサブルーチン・フロー・チ
ャートである。

【図３０】この発明の第６実施例の動作を示すブロック
図である。

【図３１】第６実施例の動作を示すメイン・ルーチン・
フロー・チャートである。

【図３２】図３１フロー・チャートの中の姿勢演算およ
び制御のサブルーチン・フロー・チャートである。

【図３３】図３１フロー・チャートの中のコンプライア
ンスおよび姿勢安定化制御のサブルーチン・フロー・チ
ャートである。

【符号の説明】

１ 脚式移動ロボット（２足歩行ロボ
ット） ２ 脚部リンク １０Ｒ，１０Ｌ 脚部回旋用の関節 １２Ｒ，１２Ｌ 腰部のロール方向の関節 １４Ｒ，１４Ｌ 腰部のピッチ方向の関節 １６Ｒ，１６Ｌ 膝部のピッチ方向の関節 １８Ｒ，１８Ｌ 足首部のピッチ方向の関節 ２０Ｒ，２０Ｌ 足首部のロール方向の関節 ２２Ｒ，２２Ｌ 足平 ２４ 上体 ２６ 制御ユニット ３６ ６軸力センサ

Claims (10)

【特許請求の範囲】
1. 【請求項１】 制御対象のモデルを少なくとも１つ備え
   るモデル追従型の脚式移動ロボットの姿勢安定化制御装
   置であって、前記モデルと実ロボットの傾斜などの状態
   量の偏差に応じた操作量を少なくとも前記モデルにフィ
   ードバックしてモデルの挙動を修正することを特徴とす
   る脚式移動ロボットの姿勢安定化制御装置。
2. 【請求項２】 制御対象のモデルを少なくとも２つ備え
   るモデル追従型の脚式移動ロボットの姿勢安定化制御装
   置であって、前記モデルと実ロボットの傾斜などの状態
   量の偏差及び／又は前記モデル間の傾斜などの状態量の
   偏差に応じた操作量を、少なくとも前記モデルのいずれ
   かにフィードバックしてモデルの挙動を修正することを
   特徴とする脚式移動ロボットの姿勢安定化制御装置。
3. 【請求項３】 制御対象のモデルを少なくとも１つ備え
   るモデル追従型の脚式移動ロボットの姿勢安定化制御装
   置であって、前記モデルと実ロボットの傾斜などの状態
   量の偏差に応じた操作量を前記モデルと実ロボットに分
   配しつつフィードバックしてモデルの挙動を修正するこ
   とを特徴とする脚式移動ロボットの姿勢安定化制御装
   置。
4. 【請求項４】 制御対象のモデルを少なくとも１つ備え
   るモデル追従型の脚式移動ロボットの姿勢安定化制御装
   置であって、前記モデルに対する実ロボットの傾き偏差
   に応じて少なくとも前記モデルに与える床反力目標値を
   修正し、修正された床反力目標値を満足する様に前記モ
   デルの歩容を修正して前記傾き偏差を収束させることを
   特徴とする脚式移動ロボットの姿勢安定化制御装置。
5. 【請求項５】 制御対象のモデルを少なくとも１つ備え
   るモデル追従型の脚式移動ロボットの姿勢安定化制御装
   置であって、前記モデルと実ロボットの傾き偏差に応じ
   た操作量を前記モデルと実ロボットに分配しつつ与えて
   床反力目標値を修正し、修正された床反力目標値を満足
   する様に前記モデルの歩容を修正して前記傾き偏差を収
   束させることを特徴とする脚式移動ロボットの姿勢安定
   化制御装置。
6. 【請求項６】 脚式移動ロボットの姿勢安定化制御装置
   において、 ａ．実ロボットの力学モデルを基に接地性が保証される
   様に床反力が設計された基準歩容からの挙動摂動分と、
   床反力摂動分の関係を模擬する少なくとも１つの摂動動
   力学モデル、 ｂ．目標歩容と実ロボットの姿勢傾き偏差を検出する手
   段、 および ｃ．前記偏差を小さくする様に、少なくとも前記摂動動
   力学モデルに床反力を与え、それによって生じた摂動動
   力学モデルの変位に応じて前記基準歩容を修正したもの
   を前記目標歩容として前記実ロボットの関節変位を追従
   させる手段、を備えたことを特徴とする脚式移動ロボッ
   トの姿勢安定化制御装置。
7. 【請求項７】 脚式移動ロボットの姿勢安定化制御装置
   において、 ａ．実ロボットの力学モデルを基に接地性が保証される
   様に床反力が設計された基準歩容からの挙動摂動分と、
   床反力摂動分の関係を模擬する少なくとも１つの摂動動
   力学モデル、 ｂ．実ロボットのリンク構造を表す幾何学モデル、 ｃ．前記幾何学モデルと実ロボットの姿勢傾き偏差を検
   出する手段、 および ｄ．前記偏差を小さくする様に、少なくとも前記摂動動
   力学モデルに床反力を与え、それによって生じた摂動動
   力学モデルの変位に応じて前記基準歩容を前記幾何学モ
   デル上で修正し、幾何学モデルの関節変位を目標として
   前記実ロボットの関節変位を追従させる手段、を備えた
   ことを特徴とする脚式移動ロボットの姿勢安定化制御装
   置。
8. 【請求項８】 少なくとも着地位置などの歩容パラメー
   タを修正して前記モデルの姿勢を安定に保つことを特徴
   とする請求項１項ないし７項のいずれかに記載の脚式移
   動ロボットの姿勢安定化制御装置。
9. 【請求項９】 少なくとも新たな床反力を加えて前記モ
   デルの姿勢を安定に保つことを特徴とする請求項１項な
   いし７項のいずれかに記載の脚式移動ロボットの姿勢安
   定化制御装置。
10. 【請求項１０】 着地位置などの歩容パラメータを修正
    すると共に、新たな床反力を加えて前記モデルの姿勢を
    安定に保つことを特徴とする請求項１項ないし７項のい
    ずれかに記載の脚式移動ロボットの姿勢安定化制御装
    置。