JPH0663881A

JPH0663881A - 脚式移動ロボットの歩行制御装置

Info

Publication number: JPH0663881A
Application number: JP9547593A
Authority: JP
Inventors: Nobuaki Ozawa; 信明小澤
Original assignee: Honda Motor Co Ltd
Current assignee: Honda Motor Co Ltd
Priority date: 1992-03-31
Filing date: 1993-03-30
Publication date: 1994-03-08

Abstract

(57)【要約】【構成】脚式移動ロボットの歩行制御装置であって剛
体モデルで近似して制御値を決定すると共に、剛性不足
による変形をフィードバック補正して制御値を修正す
る。【効果】剛体モデルと実際のロボットの間に誤差があ
っても、剛性不足による変形を補正することで、ロボッ
トの剛性を、見掛け上、無限大にすることができて比較
的低レベルの制御装置を用いることができ、またコンプ
ライアンス（制御）の自由度も増すことができる。

Description

【発明の詳細な説明】

【０００１】

【産業上の利用分野】この発明は脚式移動ロボットの歩
行制御装置に関し、より具体的にはモデルで想定するロ
ボットの剛性と実際の剛性とのズレをフィードバック補
償して見掛け上の剛性を増加させ、ロボットを理想的な
剛体モデルで扱うことができる様にしたものに関する。

【０００２】

【従来の技術】脚式移動ロボットとしては例えば、特開
昭６２−９７００６号公報記載のものが知られている。

【０００３】

【発明が解決しようとする課題】この様な脚式移動ロボ
ットが安定に歩行するためには、所定の力学的な安定条
件を満足しなければならない。従って、ロボットはリア
ルタイムにその力学問題を解きながら歩行するか、ある
いは予め解いておいて歩行することになる。そのときに
使用されるロボットのモデルが、実際のロボットを十分
に精度良く近似していれば良いが、実際にはモデル化の
困難な要素が多く含まれていたり、種々の制約、例えば
演算処理時間の短縮やモデル製作労力の軽減などから、
近似モデルが使用されることが多い。

【０００４】ところで、脚式移動ロボットは、移動の際
に脚部を高速で振らなければならない反面、脚部の関節
やリンクに大きな負荷（曲げモーメント）がかかると言
う特徴がある。それ故に、脚部を振るために必要なエネ
ルギを削減するために、ないしは脚部を振ることで発生
する反力によって安定性が低下することを防止するため
に、ロボットの脚部は軽量でイナーシャ（慣性力）が低
いことが望ましい。ところが、上記の近似モデルがロボ
ットの剛性は十分に大きいと言う仮定に基づいていた
り、ロボットの弾性要素を十分に考慮していない場合、
実際のロボットの剛性はその通りに十分大きいことが必
要になる。ここにロボットに対して、軽量で低イナーシ
ャであることと、高剛性であることと言う、両立の困難
な要求が課せられることになる。特に、脚式移動ロボッ
トは関節など剛性を高くすることが難しい可動部を必ず
有するし、歪みを検出するタイプの力センサなどやはり
剛性を高くすることが困難な要素を含んでいることも多
く、軽量、低イナーシャ化を追求しながら、ロボットに
含まれる弾性要素を無視できるほどまで剛性を高くする
ことは、実質的に不可能と言って差し支えない。従っ
て、実際に弾性要素を含むロボットについて剛体モデル
を想定し、それを使用して力学的な安定条件を満足させ
て歩行させようとしても、実際のロボットとモデルとの
間に存在する近似誤差のために所期の歩行安定性が得ら
れないと言う問題が生じる。

【０００５】従って、この発明の目的は上記した欠点を
解消し、ロボットのモデルとして剛体モデルを使用する
ことを可能として制御系の負担を軽減し、軽量、低イナ
ーシャ化によって生じる剛性不足を許容した上で、上記
した歩行安定性が低下するのを防止する様にした脚式移
動ロボットの歩行制御装置を提供することにある。

【０００６】更には、剛性不足を補償することで、ロボ
ットに対してコンプライアンスの自由度を増加すること
ができる様にした脚式移動ロボットの歩行制御装置を提
供することを目的とする。

【０００７】

【課題を解決するための手段】上記した課題を解決する
ためにこの発明は例えば請求項１項に示す如く、関節と
脚部リンクとを有し、該脚部リンクで自重を支持し、ま
たは移動のための駆動力を発生する脚式移動ロボットの
歩行制御装置であって、該関節を目標値に従うように追
従制御する関節サーボ系を備えるものにおいて、該関節
部またはその近傍に作用するモーメントを検出する手
段、前記検出したモーメントから前記関節部またはその
近傍の変形量を推定する手段、及び前記推定された変形
量を減少または解消するように前記関節の目標値を補正
する手段を備えるように構成した。

【０００８】

【作用】関節部またはその近傍に作用するモーメントを
検出し、検出したモーメントから関節部またはその近傍
の変形量を推定し、その変形量を減少または解消するよ
うに関節の目標値を補正する様にしたことから、脚部リ
ンクがモデルで予定する剛性を不足して変形したとして
も、その変形を補償することができる。即ち、ロボット
を剛体モデルで近似して制御値を決定するだけで所期の
歩行安定性を確保することができて制御系の負担を軽減
することができると共に、脚部リンクを軽量かつ低イナ
ーシャな構造とすることができ、歩行安定性を一層向上
させることができる。更には、弾性モデルを処理できな
い様な比較的低レベルの制御装置を使用する場合やモデ
ルに関する演算をより高速に処理することが必要な場合
など、種々の制約から剛体モデルを使用しながら実際に
は弾性要素を含むロボットを制御する場合に、弾性要素
を考慮したかの様に安定に歩行させることができる。ま
た制御装置は特に高性能なものが必要ではなく、ロボッ
トの弾性要素を現実的に設計できる程度まで許容するこ
とができる。

【０００９】

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

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

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

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

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

【００１４】図３はその動作を示す足関節１８，２０Ｒ
（Ｌ）についてのブロック線図である。この制御におい
ては足関節を除く他の関節１０，１２，１４，１６Ｒ
（Ｌ）については公知の位置、速度フィードバックのみ
を行って各関節の角度を指令値に追従制御すると共に、
図示の如く足関節１８，２２Ｒ（Ｌ）については更に、
足部の弾性変形をフィードバック補償する様にした。即
ち、足関節１８，２２Ｒ（Ｌ）は脚部リンク２の先端に
位置するので、その重量が増加することは脚部リンク全
体のイナーシャを大きく増加させるため、軽量化を優先
することになる。また２軸が交差する構造となっている
ため、剛性を高くする設計にも限界がある。また足関節
１８，２０Ｒ（Ｌ）の下部には前記した６軸力センサ３
６が配置されているために、他の部分に比べて相対的に
剛性が低い。そこで、図１に示したロボット１について
は剛体モデルで捉えて指令値を決定すると共に、足部周
辺を図４に示す様にバネ・ダンパ・質点系として近似
し、６軸力センサ３６で検出したモーメントをそのバネ
に作用する力と考えて変形量を推定し、それを打ち消す
様に剛体モデルを前提として決定された指令値を補正
し、それを操作量として足関節を駆動する様にした。

【００１５】簡単のために、ダンパの効果を無視して静
的な釣合条件の下で考える。足部の剛性をｋfoot、力を
Ｆ、変位量をＸとすると、Ｆ＝ｋfoot・Ｘ、と言う関係
が成立する。この剛性ｋfootにはサーボ系の剛性とロボ
ット１の機械的な剛性とが含まれる。そこで、この制御
では、この剛性ｋfootの逆数１／ｋfootを求め、その逆
数１／ｋfootに関連した値をフィードバックゲインｋｄ
として検出したモーメントに乗じて足関節角度の指令値
θankle.commを補正する様にした。即ち、図５に示す様
に、フィードバックゲインｋｄによってサーボ系の剛性
と機械的な剛性とに等価な値を補償して見掛け上剛性を
無限大にする様にした。即ち、図４に示すモデルにおい
て足関節の角度の指令値θankle.commに対して、剛性が
無限大でないために実際の足関節の角度がθankle.act
になったとすると、足関節のまわりのモーメントＭは剛
性が無限大であれば、モデルで予定するモーメントＭco
mmは、Ｍcomm＝mgh × sin( θankle.comm) となるはずであるが、実際の足関節の角度がθankle.ac
t となったために、実際のモーメントＭact がＭact ＝mgh × sin( θankle.act) となり、Ｍcomm ＜Ｍact となる。ここで、適当な補正をほどこして、θankle.ac
t ＝θankle.commとなったとすると、Ｍact ＝mgh × sin( θankle.comm) となる。このとき、この実際のモーメントＭact によっ
て発生する足関節回りの変形量( θankle.deformとす
る) は前記の如く、 θankle.deform＝Ｍact × ｋｄとなるので、修正された指令値(θ'ankle.comm)を θ'ankle.comm＝θankle.comm−θankle.deform とすれば、 θankle.act ＝θ'ankle.comm ＋Ｍact ・ｋｄ＝θa
nkle.comm となる。この様に足関節回りの変形を補償する結果、ロ
ボット１は少なくとも足関節１８，２０Ｒ（Ｌ）につい
ては、見掛け上無限大の剛性を得たことになる。尚、ロ
ボットが静的な釣合条件の下にないときは、運動方程式
を解いて該操作量を決定すれば良い。

【００１６】更に特徴的なことは、足関節については剛
性を見掛け上無限大にすることができた結果、図５に示
す様にコンプライアンス（制御）の自由度を増したこと
である。従って、図３ブロック線図に示す様に、コンプ
ライアンス制御ゲインｋｃを用いてコンプライアンス制
御を行うときも、一層効果的に行うことができる。

【００１７】以上を前提として以下図６、図７フロー・
チャートを参照して詳細に説明する。尚、図６は図２に
示す制御ユニット２６の動作を示すフロー・チャートの
前半部（スタート〜Ｓ３０）、図７は後半部（Ｓ３２〜
ＥＮＤ）である。

【００１８】先ず図６のＳ１０で装置各部をイニシャラ
イズした後、Ｓ１２に進んで歩行パターンi θcomm
（ｔ）を検索する。これはロボット１が理想的に平坦で
かつ硬さも均一な路面を歩行するときの各関節角の目標
値を示す。ここで添字i は関節の番号を示し、添字は時
刻ｔのときの角度を示す。関節の番号は下から順に、２
０Ｒ＝１，２０Ｌ＝２，．．とする（図４ではｉ＝１か
ら４を”ankle ”と示した）。これらの時系列データは
先に述べた様にロボット１を剛体モデルで近似した上、
予め大型コンピュータで算出しておき、前記した制御ユ
ニット内のマイクロ・コンピュータのＲＯＭ６４に格納
しておく。

【００１９】続いてＳ１４に進んでパラメータ、例えば
フィードバックゲインｋpos,ｋｖ... を入力する。続い
てＳ１６に進んでタイマ値ｔ、カウンタ値Count 及び関
節番号（カウンタ）値を零にリセットし、Ｓ１８に進ん
で歩行を開始し、Ｓ２０に進んで関節番号ｉをカウント
するカウンタ値を１にセットする。次いでＳ２２に進ん
でセットした関節番号に該当する関節角度ｉθcomm
（ｔ）（ｉ＝１）などをＲＯＭ６４から読み出す。尚、
図示のｉθcomm（ｔ＋1 ）は現在の時刻ｔの次の時刻、
即ち次回のプログラム起動時の目標関節角度を示す。ま
たＦｔ（Ｃ）は着地衝撃吸収制御期を示すフラグであ
り、当該期間にあるときそのビットが１にセットされ
る。この制御では着地衝撃吸収制御期は、遊脚期間中お
よびそれに続く着地直後とする。遊脚期間中に着地衝撃
吸収制御を実施するようにしたのは、予定より早く着地
した場合に備えるためである。

【００２０】次いで、Ｓ２４に進んでセンサ検出値を読
み込む。ここでｉθact はｉ番目の関節の実際の関節角
度を、Ｍは図４などで説明した足部に加わる実際のモー
メント（先のＭact)を示す。次いでＳ２６に進んで関節
角度の指令値ｉθcommと実際の関節角度ｉθact との偏
差に位置フィードバック制御ゲインｋpos を乗じて、ア
ンプに指令される速度指令値のうちの位置フィードバッ
ク制御成分が算出される。次いでＳ２８に進んで、現在
の時刻をｔとすれば、時刻ｔ＋１における関節角度の指
令値i θcomm（ｔ＋１）と現在の時刻ｔにおける関節角
度指令値ｉθcomm（ｔ）の差分にゲインｋｖを乗じるこ
とによってアンプに指令される速度指令値のうちの速度
フィードフォワード制御成分が算出される。

【００２１】続いてＳ３０に進んで関節番号ｉが５以上
か否か、即ち膝から上の関節か否かを判断し、否定され
るときは足関節であるので、図７のＳ３２に進む。Ｓ３
２では着地衝撃吸収制御を実行するか否かをフラグＦｔ
（Ｃ）によって判断する。前述の如く遊脚期間中および
それに続く着地直後にあってはこのフラグのビットが１
にセットされ、Ｓ３４に進んでコンプライアンス制御ゲ
インｋｃを算出する。ゲインｋｃは図８に示す如くその
特性が設定されており、Count(時間相当値) で検索して
求める。次いでＳ３６に進んで求めたゲインｋｃを検出
したモーメントＭに乗じてアンプに指令する速度指令値
のうち第３のコンプライアンス制御成分ｉv3を算出し、
次いでＳ３８に進んでCount 値をインクリメントする。
尚、Ｓ３２でフラグのビットが０、即ち、着地衝撃吸収
制御期にないと判断されるときはＳ４０に進んで第３の
制御値を零にすると共に、Ｓ４２に進んでCount 値を零
にリセットする。

【００２２】続いて、Ｓ４４に進んで前記した弾性変形
補償ゲインｋｄを求める。ゲインｋｄは図９に示す如く
その特性が設定されており、時刻ｔで検索して求める。
ここでゲインｋｄは前記した様にサーボ系とロボットの
機械的な剛性の和であるｋfootの逆数（" ＫＤ" とす
る）に関連した値とし、両脚支持期ではＫＤより小さく
設定し、片脚支持期では値ＫＤに設定すると共に、ＫＤ
に対して滑らかに変化する様に設定した。尚、両脚支持
期の補正量を小さくするのは、両脚支持期は閉リンクと
なり、足関節を補正すると干渉が発生し、目的とする補
償を却って適切に行えないためである。次いでＳ４６に
進み、求めたゲインｋｄを使用して図示の式から第４の
速度制御値iV4 を算出する。

【００２３】続いてＳ５２に進んで算出した全ての制御
値を加算して総和iVCOMMを求めてサーボアンプに出力
し、Ｓ５４に進んで関節番号カウンタをインクリメント
し、Ｓ５６に進んで最終関節か否か判断し、肯定される
ときはＳ５８に進んで次の目標関節角度ｉθcomm（ｔ＋
1 ）を検索するためにタイマ値ｔをインクリメントし、
Ｓ６０において歩行終了と判断されるまで、上記した作
業を繰り返す。

【００２４】この実施例は上記の如く剛性の比較的低い
足関節に作用するモーメントを検出してその変形を補正
する様にしたので、ロボットとしては剛体モデルで近似
して制御値を決定し、その制御値を補正して剛性不足に
よる位置ズレなどを効果的に修正する様にした。従っ
て、ロボットを所期の通り安定して歩行させることがで
きる。また図５に関して述べた様に剛性を見掛け上無限
大にしてモデルで予定する理論上の剛性を与える様にし
たことから、コンプライアンス（制御）の自由度が大幅
に増加し、着地するときの衝撃などを一層効果的に吸収
することができる。更に、剛体モデルで近似して安定歩
行を実現する様にしたことから、弾性モデルを処理でき
ない様な比較的低レベルの制御装置を使用することも可
能となり、またモデルに関する演算をより高速に処理す
ることも可能となる。この様に剛体モデルを使用しなが
ら、弾性要素を含むロボットを、あたかも弾性要素を考
慮したかの様に、安定に歩行させることができる。

【００２５】尚、上記においてゲインｋｄの値を１／ｋ
footに関連した値として剛性不足分を相殺することによ
り剛性を見掛け上無限大にしたが、これに限られるもの
ではなく、適宜な剛性となる様にｋｄの値を設定しても
良い。また、剛性不足を補う制御とコンプライアンス制
御とを併用する例を示したが、剛性不足を補う制御のみ
に止めても良いことは言うまでもない。

【００２６】また、上記において、図８ないし図９の離
床、着床は接地スイッチ３８の出力から検出すれば良い
が、それ以外にも歩行パターンで予め設計された時間を
用いても良く、あるいは６軸力センサ３６の検出したモ
ーメント、外力、ないしは後で第２実施例で述べる電流
センサの検出値などを適宜設定するしきい値と比較して
判断しても良い。

【００２７】図２に想像線で示す様に電流センサを設け
た構成は、この発明の第２実施例を示す。即ち、モデル
と実際のロボットとの誤差が関節角度制御ループのサー
ボ剛性が低いことが要因となっている場合は、モータに
流れる電流Ｉにモータのトルク定数Ｔc を乗ずることに
よって負荷トルクＴL が、さらにはモータの角度誤差が
推定できるので、関節を駆動するモータに流れる電流値
を検出して第１実施例と同様の制御を行う様にした。具
体的には図７フロー・チャートのＳ２４においてモーメ
ントの代わりにモータ電流Ｉを読み込み、負荷トルクＴ
L を、ＴL ＝Ｔc ×Ｉと求めて制御すれば良い。

【００２８】同様に図２に想像線で示す様にストレイン
ゲージを設けた構成は、この発明の第３実施例を示す。
即ち、モデルと実際のロボットとの誤差がハーモニック
減速機の剛性不足に起因するときは、ストレインゲージ
を用いてハーモニック減速機の非線形摩擦を測定し、図
７フロー・チャートのＳ４６において測定値にゲインを
乗じた値をフィードバックして非線形摩擦を補償する。
尚、ストレインゲージに非線形摩擦の測定およびトルク
制御による補償については、『ハーモニック・ドライブ
の弾性を利用したトルク計測とそのトルク制御への応
用』（橋本稔ほか。ハーモニックドライブ国際シンポジ
ウム（1991年）講演資料（招7-1 ））に述べられている
ので、ここでの説明は省略する。

【００２９】尚、上記において足関節に制御を行う例を
示したが、それに限られるものではなく、膝関節ないし
はその上方の関節について行っても良い。

【００３０】また上記において、歩行パターンとして予
め設定しておく場合に適用する例を示したが、それに限
られるものではなく、歩行のときリアルタイムに求める
様にした技術に適用させても良い。

【００３１】また上記において、２足歩行の脚式移動ロ
ボットを例にとって説明してきたが、それに限られるも
のではなく、３足以上の脚式移動ロボットにも妥当する
ものである。

【００３２】

【発明の効果】関節と脚部リンクとを有し、該脚部リン
クで自重を支持し、または移動のための駆動力を発生す
る脚式移動ロボットの歩行制御装置であって、該関節を
目標値に従うように追従制御する関節サーボ系を備える
ものにおいて、該関節部またはその近傍に作用するモー
メントを検出する手段、前記検出したモーメントから前
記関節部またはその近傍の変形量を推定する手段、及び
前記推定された変形量を減少または解消するように前記
関節の目標値を補正する手段を備えるように構成したの
で、実際には無限大の剛性を有しない関節部やその近傍
の変形を補償し、見掛け上の剛性を無限大にすることが
可能となるため、ロボットを剛体モデルで近似して設計
した歩行パターンに基づいて歩行制御する場合、モデル
誤差を縮小することができるので歩行安定性を一層向上
させることが可能となる。また、言い換えれば関節部ま
たはその近傍の剛性不足を補うことができるので、脚部
リンクの軽量化、低イナーシャ化を進めることが可能と
なる。更に、ロボットのモデルとして、剛体モデルを使
用するほうが弾性までも考慮したモデルを使用する場合
に比べれば制御装置にかかる負荷が小さいので、比較的
低レベルの制御装置で安定な歩行制御を実現できる。

【００３３】請求項２項の装置にあっては、前記ロボッ
トに作用するモーメントおよび／または力に応じて前記
関節の目標値を補正して前記ロボットにコンプライアン
スを与える様にしたことから、即ち、見掛け上、剛性を
無限大にすることができたので、コンプライアンス（制
御）の自由度を増加させることができ、それにより着地
時の衝撃なども一層効果的に緩和でき、一層安定な歩行
制御を実現することができる。

【図面の簡単な説明】

【図１】この発明に係る脚式移動ロボットの歩行制御装
置を全体的に示す概略図である。

【図２】図１に示す制御ユニットの説明ブロック図であ
る。

【図３】図２に示す制御ユニットの動作を示すブロック
線図である。

【図４】図３ブロック線図に示す弾性変形補償を説明す
る足関節について仮想的に設定したバネ・質点系を示す
説明図である。

【図５】図３ブロック線図に示す弾性変形補償を説明す
る説明図である。

【図６】図２に示す制御ユニットの動作を示すフロー・
チャートの前半部である。

【図７】図２に示す制御ユニットの動作を示すフロー・
チャートで、図６のフロー・チャートに続く後半部であ
る。

【図８】図７フロー・チャートで使用するコンプライア
ンス制御ゲインの経時的特性を示すタイミング・チャー
トである。

【図９】図７フロー・チャートで使用する弾性変形補正
ゲインの経時的特性を示すタイミング・チャートであ
る。

【符号の説明】

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

Claims

【特許請求の範囲】

【請求項１】関節と脚部リンクとを有し、該脚部リン
クで自重を支持し、または移動のための駆動力を発生す
る脚式移動ロボットの歩行制御装置であって、該関節を
目標値に従うように追従制御する関節サーボ系を備える
ものにおいて、ａ．該関節部またはその近傍に作用するモーメントを検
出する手段、ｂ．前記検出したモーメントから前記関節部またはその
近傍の変形量を推定する手段、及びｃ．前記推定された変形量を減少または解消するように
前記関節の目標値を補正する手段を備えるように構成し
たことを特徴とする脚式移動ロボットの歩行制御装置。
【請求項２】前記ロボットに作用するモーメントおよ
び／または力に応じて前記関節の目標値を補正して前記
ロボットにコンプライアンスを与える様にしたことを特
徴とする請求項１項記載の脚式移動ロボットの歩行制御
装置。