JP2006068884A - ロボット装置及びその制御方法、並びに受動車輪装置 - Google Patents

Abstract

【課題】 ２足歩行ロボットの各可動脚に対し、駆動アクチュエータを持たない受動車輪機構を装備し、車輪の推進による高速且つ高効率の移動を実現する。
【解決手段】 足底ベース部をロール方向に回転することで、受動回動軸回りの回転を生じさせることにより、受動車輪を操舵し、脚をヨー方向に駆動することを容易にすることができる。これにより両脚支持状態であっても滑らかな操舵が可能となり、走行路面上で脚先を左右対称に蛇行運動させることで直進・旋回することが出来る。
【選択図】 図８

Description

本発明は、複数の可動部を備えたロボット装置及びその制御方法、並びに受動車輪装置に係り、特に、移動手段を備えたロボット装置及びその制御方法、並びに受動車輪装置に関する。

さらに詳しくは、本発明は、脚式の移動と車輪型の移動の双方の特質を兼ね備えた脚車輪ハイブリッド型のロボット装置及びその制御方法、並びに受動車輪装置に係り、特に、２足歩行ロボットの各可動脚に受動車輪を付加することで脚による走行性能を向上させるロボット装置及びその制御方法、並びに受動車輪装置に関する。

電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行なう機械装置のことを「ロボット」という。ロボットの語源は、スラブ語の“ＲＯＢＯＴＡ（奴隷機械）”に由来すると言われている。わが国では、ロボットが普及し始めたのは１９６０年代末からであるが、その多くは、工場における生産作業の自動化・無人化などを目的としたマニピュレータや搬送ロボットなどの産業用ロボット（ｉｎｄｕｓｔｒｉａｌ ｒｏｂｏｔ）であった。

最近では、ヒトやサルなどの２足直立歩行を行なう動物の身体メカニズムや動作を模した脚式移動ロボットに関する研究開発が進展し、実用化への期待も高まってきている（例えば、特許文献１を参照のこと）。２足直立による脚式移動は、クローラ式や、４足又は６足式などに比し不安定で姿勢制御や歩行制御が難しくなるが、不整地や障害物など作業経路上に凹凸のある歩行面や、階段や梯子の昇降など不連続な歩行面に対応することができるなど、柔軟な移動作業を実現できるという点で優れている。

人間の作業空間や居住空間のほとんどは、２足直立歩行という人間が持つ身体メカニズムや行動様式に合わせて形成されおり、車輪その他の駆動装置を移動手段とした現状の機械システムが移動するのには多くの障壁が存在する。したがって、機械システムすなわちロボットがさまざまな人的作業を代行し、さらに人間の住空間に深く浸透していくためには、ロボットの移動可能範囲が人間のそれとほぼ同じであることが好ましい。これが、脚式移動ロボットの実用化が大いに期待されている所以でもある。

多くの場合、脚式移動ロボットの姿勢安定制御には、ＺＭＰ（Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔ）が歩行の安定度判別の規範として用いられている。ここで言う「ＺＭＰ」とは、歩行中の床反力によるモーメントがゼロとなる床面上の点のことである。ＺＭＰによる安定度判別規範は、歩行系から路面には重力と慣性力、並びにこれらのモーメントが路面から歩行系への反作用としての床反力並びに床反力モーメントとバランスするという「ダランベールの原理」に基づく。力学的推論の帰結として、足底接地点と路面の形成する支持多角形の内側にピッチ軸及びロール軸モーメントがゼロとなる点、すなわちＺＭＰが存在する（例えば、非特許文献１を参照のこと）。また、支持多角形が広くなる姿勢において、ロボットの姿勢はより安定化する。

目標ＺＭＰ制御は、すべての瞬間において、動的釣り合いを取るように運動を計画することにより、実機上で成功を収めている。ＺＭＰ規範に基づく２足歩行パターン生成は、足底着地点をあらかじめ設定することができ、路面形状に応じた足先の運動学的拘束条件を考慮し易いなどの利点がある。また、ＺＭＰを安定度判別規範とすることは、力ではなく軌道を運動制御上の目標値として扱うことを意味するので、技術的に実現可能性が高まる。

ところが、脚式移動ロボットは高い対地適応性が得られる反面、移動速度や効率の面で、車輪型移動ロボットよりも劣るという問題がある。このため、脚式の移動と車輪型の移動の双方の特質を兼ね備えた、いわば脚車輪ハイブリッド型の移動体に関する研究が行なわれている。

車輪を利用した移動ロボットとして、例えば、災害現場への進入を行う極限作業用の６脚走行車（例えば、非特許文献２を参照のこと）や移動体（例えば、非特許文献３を参照のこと）、またクローラも連続的な無限軌道を用いるという観点から広義の車輪と捉えれば、地雷撤去を目的として開発されたＣＯＭＥＴ−ＩＩＩ（例えば、非特許文献４を参照のこと）などが挙げられる。

これらの移動体は車輪として駆動力を持つ能動車輪を用いている。これに対し、脚式による歩行機械は一般に歩行のための多くの自由度を有し、機体質量は増大しがちである。その上、車輪駆動のためのアクチュエータを搭載すると、いたずらに質量増加を招き、その結果、歩行機械としての運動性能を逆に制約する。

そこで、簡素な機構で質量増加も少ない受動車輪を用いた歩行機械のハイブリッド化手法が提案されている。

例えば、ローラースケート靴を履くことにより、通常の歩行動作時よりもダイナミックで高速な移動作業を実現することができる脚式移動ロボットについて提案がなされている（例えば、特許文献２を参照のこと）。この場合のロボット装置は、２本の可動脚と上体で構成される２足歩行型の移動ロボットで、下肢と上体を用いた全身運動を動作制御することにより各種の動作パターンを実現することができる。そして、各可動脚の足底に所定の滑走方向を持つ滑走ユニットが着脱自在に取り付けられ、滑走ユニットを滑走方向に一致させながら移動速度を維持するとともに、滑走ユニットを滑走方向と異ならせることにより制動することができる。

この種のローラースケート靴を履いたロボット装置の場合、以下の事柄が前提となる。すなわち、

（１）受動車輪は脚関節ピッチ軸と常に平行である。
（２）滑走方法は歩行のように交互に脚を遊脚化する。

ここで、受動車輪は脚関節ピッチ軸と平行に保持されている場合、両足支持期には進行方向を変更することができない。このため、推進方向の変更は支持脚切り替え時にのみ行なうことができ、連続ではない。また、両脚接地期においてスキーのボーゲンのように車輪をハの字に傾けることにより制動することができるが、車輪が接地したままで脚の足先をヨー回転させることは、車軸方向に速度を発生させることから（図２３を参照のこと）、非常に大きな負荷トルクが発生する。

また、歩行のように交互に脚を遊脚化するという滑走方法では、片足支持期を前提とすることで、転倒し易くなる。また、受動車輪の軸方向摩擦力を用いて推進方向に蹴り出すことで推進を行なっているが、この方式では、蹴り出すエネルギをバネなどで蓄積しない限り、原理的に足先が出す速度以上の推進速度は得られない。このため、最大歩行速度とほぼ同程度の推進速度しか出し得ないと思料される。

前者の受動車輪がピッチ軸に常に平行に保持され、ヨー回転反モーメントが増大するという問題に関しては、車輪間距離（ホイールベース・トレッド）を縮める、あるいはインライン・スケートのように受動車輪を一列に並べるという解決方法も考えられる。しかしながら、現状の２足歩行ロボットのハードウェア構成では十分な足底接地面積を持つことが転倒回避のために必要であることから、これらは現実的な解決策ではない。

また、足先に取り付けられた受動車輪に推進力を与える手法として、ローラースケートと同様の原理を利用した「ローラーウォーカー」を挙げることができる（例えば、非特許文献５を参照のこと）。

図２４及び図２５には、ローラーウォーカーの自由度構成を模式的に示している。同図に示すハイブリッド歩行機械は、４足の脚式移動ロボットであり、各脚部は、足平より付け根に向かって、３つのロール回りの自由度と１つのヨー回りの自由度の合計４自由度構成である（但し、ロボットの前方向をＸと置き、進行方向として座標系を図示のように設定する）。足部の足平は円盤状をなし、車輪としての機能を兼ね備えている。すなわち、歩行時には、図２４に示すように、足首角度をロール回りに回転させることで、円盤状の車輪を倒して接地させ、足裏として利用する。また、車輪を用いた走行時には、図２５に示すように足首角度をロール回りに回転させ、円盤状の車輪を起こして、足首以降で車輪をピッチ軸周りに受動回転可能にする。このように簡素な機構を用いることで、車輪を用いた走行性能を実現しつつ、過大な重量増加を抑え、歩行機械としての性能低下を最小限に抑えることができる。

さて、受動車輪による推進は、車輪の転がり方向は摩擦係数が少なく、軸方向は摩擦が大きい。このような抗力の異方性を利用することにより、受動車輪による推進を実現する。例えば左右の各脚の付け根のヨー軸回転を利用することにより、左右の車輪はそれぞれＸ方向に対して傾きを持ちながら左右の車輪間の軸方向の距離が伸縮する。このとき、軸方向の摩擦が大きいことから、車輪の軸方向に発生する摩擦力が車輪の転がりによって解放されて、Ｘ方向への推進力に変換される。

ここで、車輪の軸方向の摩擦力を車輪の回転に変換するには、車輪の転がり方向をヨー回りに回転させる機構を持ち、車輪に印加される摩擦力に対し転がり方向が非直交である必要がある。また、車輪の転がり方向と推進方向（若しくはロボットの主たる進行方向）のなす角θ_G（グライド角と呼ぶことにする）は言わばギアの減速比に相当する。したがって、グライド角θ_Gにより大きな角度をつければ低速となることから装置の推進方向に大きな推進力を発生することができる。逆に、グライド角θ_Gにより小さな角度を与えることにより、小さな推進力であるが、ロボットを高速に推進することができる（例えば、非特許文献６及び非特許文献７を参照のこと）。

このように、ローラーウォーカーによれば、足先が出す最大速度以上の高速な推進や、脚軌道を変更することによる減速比調整などを実現することができる。しかしながら、基本的には４脚歩行ロボットを前提としており、この手法を２足歩行ロボットに適用することができない。

特開平１３−１２９７７５号公報 特開２００１−１３８２７２号公報 ヴコブラトビッチ（Ｍｉｏｍｉｒ Ｖｕｋｏｂｒａｔｏｖｉｃ）著「脚式移動ロボット（ＬＥＧＧＥＤ ＬＯＣＯＭＯＴＩＯＮ ＲＯＢＯＴＳ）」（加藤一郎外著『歩行ロボットと人工の足』（日刊工業新聞社）） N.Kimura, T.Kamigaki, N.Suzuki, A.Nishikawa and N.Yamamoto: "Locomotion Mechanism and Control Architecture for Disaster Preventing Robot" '91 ISART pp.375-380(1991) H.Adachi, N.Koyachi, T.Arai, A.SHimizu and Y.Nogami: "Mechanism and Control of a Leg-Wheel Hybrid Mobile Robot", International Conference on Intelligent Robots and Systems Proc., pp.1792-1797(1999) http://mec2.tm.chiba-u.jp/~nonami/ G.Endo, S.Hirose: "Study on Roller-Walker(Multi-mode Steering Control and Self-contained Locomotion", IEEE International Conference on Robotics and Automation, pp.2808-2814(2000) 遠藤玄："索状能動体と脚車輪ハイブリッド移動体におけるグライド推進の研究"，東京工業大学大学院理工学研究科機械物理工学専攻学位論文，pp.8-10(2000) 遠藤玄："索状能動体と脚車輪ハイブリッド移動体におけるグライド推進の研究"，東京工業大学大学院理工学研究科機械物理工学専攻学位論文，pp.80-87(2000)

本発明の目的は、脚式の移動と車輪型の移動の双方の特質を兼ね備えた脚車輪ハイブリッド型の優れたロボット装置及びその制御方法、並びに受動車輪装置を提供することにある。

本発明のさらなる目的は、２足歩行ロボットの各可動脚に車輪機構を付加することで脚による走行性能を向上させることができる、優れたロボット装置及びその制御方法、並びに受動車輪装置を提供することにある。

本発明のさらなる目的は、２足歩行ロボットの各可動脚に対し、駆動アクチュエータを持たない受動車輪機構を装備することで、車輪の推進による高速且つ高効率の移動を実現することができる、優れたロボット装置及びその制御方法、並びに受動車輪装置を提供することにある。

本発明は、上記課題を参酌してなされたものであり、１以上の可動脚を備えたロボット装置であって、
前記可動脚の足先に取り付けられた滑走ユニットと、
少なくとも可動脚の動作を制御する動作制御手段とを備え、
前記滑走ユニットは、
前記可動脚の足部に取り付けられ、ＸＹ平面を構成する足部ベース部と、
ＸＹ平面と一定の角度をなす２つの傾斜面を前後にそれぞれ有する第１の支持部材と、
前記の各傾斜面に対し、傾斜面法線方向と平行となるように配設された前方及び後方の受動回転軸と、
前記の前方及び後方の各受動回転軸に、前記第１の支持部材に対して受動回転軸回りに回動自在にそれぞれ取り付けられた第２の支持部材と、
前記の前方及び後方の第２の支持部材の左右両端に回転可能にそれぞれ取り付けられた略同軸状の受動車輪とを備える、
ことを特徴とするロボット装置である。

脚式移動ロボットは高い対地適応性が得られる反面、移動速度や効率の面で、車輪型移動ロボットよりも劣るということから、脚式の移動と車輪型の移動の双方の特質を兼ね備えた、いわば脚車輪ハイブリッド型の移動体が優れていると思料される。また、機体の総重量を考慮すると、能動車輪ではなく、受動車輪を用いることが好ましいが、推進力をいかに得るかが問題となる。

しかしながら、２足型の脚式移動ロボットに車輪機構を適用した場合、受動車輪が脚関節ピッチ軸と平行に保持されている構成では、推進方向の変更は支持脚切り替え時にのみ行なうことができ、連続ではない。また、歩行のように交互に脚を遊脚化するという滑走方法では、片足支持期を前提とすることで、転倒し易くなる。

本発明によれば、４個の受動車輪を備えた滑走ユニットが各可動脚の足底に取り付けられている。足部の前後にそれぞれ配設された第２の支持部材の左右両端部にそれぞれ取り付けられた受動車輪は対を成して、第２の支持部材は第１の支持部材に対し受動回動軸回りに回転することができる。ここで、第２の支持部材の受動回動軸回りの角度については、駆動力を持たないことから、直接回動することはできない。そこで、前記動作制御手段は、第２の支持部材の受動回動軸回りの角度を、足底ベース部のロール角度調節によって間接的に角度を変更することができる。

すなわち、足底ベース部がロール方向に傾くと、左右のうち床面と足底ベース部の距離が短くなった側では前後の車輪の間隔が短くなり、逆に、左右のうち床面と足底ベース部の距離が長くなった側では、前後の車輪の間隔が長くなる。この場合、すべての受動車輪が足底ベース部と床面のなす空間にちょうど収まるように、第２の支持部材の受動回動軸回りの受動的な回転を生じることになる。この結果として、前方並びに後方の第２の支持部材にそれぞれ取り付けられた左右１対の受動車輪の転がり方向はロボットのＸ方向に対し傾くので、受動車輪機構全体として操舵角を与え、ロボットの進行方向を操舵することができる。

したがって、このような滑走ユニットによれば、両脚支持したままの姿勢で推進力を得ることができることから、支持多角形が大きくなり、転倒しにくくなる。また、支持多角形面積を十分に取ることができるので、実現可能性が高く、受動車輪を用いた動作のための高度な制御系を新たに必要とはしない。

ここで、前記滑走ユニットは、前記第２の支持部材の前記第１の支持部材に対する回転を拘束する回転拘束手段をさらに備えていてもよい。回転拘束手段は、具体的には電磁ブレーキやパウダークラッチなどにより、受動回動軸回りの摩擦トルクを制御する、あるいは単純にラッチピンなどにより、一定角度で固定するようにしても良い。例えば、受動車輪の転がり方向がロボットの進行方向すなわちＸ方向と一致するような位置で受動回動軸を固定すれば、滑走ユニットは特許文献２で述べられている、脚を遊脚化することによるスケート推進制御法をそのまま用いることができる。

また、前記ロボット装置は、それぞれ前記滑走ユニットを装着した左右の可動脚を備えている場合、前記動作制御手段は、左右の可動脚の足部に対するロール角度調節を同期的に行なうことにより、ロボット装置の両脚支持状態で滑走させることができる。例えば、空走状態では車輪転がり方向は進行方向に平行となり、停止状態ではトーイン角を与えるように、左右の可動脚の足部に対するロール角度調節を同期的に行なうようにすることができる。

また、前記動作制御手段は、前記ＸＹ平面上でＹ方向への足先軌道を与え、単脚では蛇行軌道を描くようにしてもよい。前記ＸＹ平面上でのＹ方向への足先軌道は、正弦波、半円弧を組み合わせた複合曲線、又はクロソイド曲線を用いた複合曲線、サーペノイド曲線（曲率の変化率が正弦波）に基づいて与えることができる。

このとき、受動車輪が受動回転軸方向に速度が生じないようにすれば、受動車輪による推進力を得ることができる。例えば、左右の脚の足先にＹ方向への運動を左右対称に行なわせることによって、車輪の転がり方向は摩擦係数が少ないが軸方向は摩擦が大きいという抗力の異方性に基づいて、Ｙ方向への運動が推進用受動車輪の回転運動に変換されて、推進方向（ロボットの進行方向すなわちＸ方向）への推進力を得ることができる。すなわち、受動車輪の転がり方向にのみ滑らかに推進することができ、アクチュエータ負荷は非常に小さくなる。

また、前記動作制御手段は、左右の可動脚の足部に与えるロール角度に異なるオフセットを与えることにより左右の足先軌道に速度差を与え、前記オフセットに相当する旋回半径を以って進行方向を変化させることができる。

また、前記受動車輪の回転を一方向に限定する手段をさらに備えていても良い。このような手段は、例えば、受動車輪に内蔵される一方向クラッチとして構成することができる。

受動車輪の回転を一方向に限定することにより、上述したような推進動作は非常に簡単化することができる。定常直進の場合を例にとると、脚Ｘ位置を正弦波で駆動すれば、脚を後方に蹴る動作はクラッチにより推進力となり、逆に前方に復帰する動作は受動車輪が空転することにより、抵抗力にはならない。また、旋回する場合は、ＸＹ平面上で曲線となる基準軌道を設定し、その軌道に沿うように往復運動をすることで、直進と同様に推進力を得ることができる。

本発明によれば、脚式の移動と車輪型の移動の双方の特質を兼ね備えた脚車輪ハイブリッド型の優れたロボット装置及びその制御方法、並びに受動車輪装置を提供することができる。

また、本発明によれば、２足歩行ロボットの各可動脚に車輪機構を付加することで脚による走行性能を向上させることができる、優れたロボット装置及びその制御方法、並びに受動車輪装置を提供することができる。

また、本発明によれば、２足歩行ロボットの各可動脚に対し、駆動アクチュエータを持たない受動回転軸とその回転を拘束する機構及び受動車輪を持つ足底機構を装備することで、車輪の推進による高速且つ高効率の移動を実現することができる、優れたロボット装置及びその制御方法、並びに受動車輪装置を提供することができる。

本発明の具体的な効果として以下の事柄を挙げることができる。
（１）支持脚期においても滑らかに進行方向を変更することができる。
（２）両脚支持で推進できることから、支持多角形が大きくなり、転倒しにくくなる。また、支持多角形面積を十分に取ることができるので、実現可能性が高く、受動車輪を用いた動作のための高度な制御系を新たに必要とはしない。
（３）ユーザがインタラクティブに受動車輪機構による推進速度・方向を変更できる。
（４）簡素な機構でありながら、車輪型の高速・高効率の移動が可能になる。
（５）足先速度よりも速い推進が可能となることから、エンタテインメント性が高い。
（６）上下動の少ない滑らかな移動であることから、カメラ画像などを用いた制御に適する。
（７）歩行機械に付加する形態であるので、既存の２足歩行ロボットに広く適用することができる。
（８）足底に付加することから、力センサなど歩行のためのセンサ系をそのまま用いることができる。
（９）脚軌道を選ぶことにより減速比の調整ができることから、傾斜面の登坂や高速の移動も実現することができる。
（１０）受動車輪は転がり摩擦が少ないことから、傾斜面を下る場合、移動エネルギを必要としない。

本発明のさらに他の目的、特徴や利点は、後述する本発明の実施形態や添付する図面に基づくより詳細な説明によって明らかになるであろう。

以下、図面を参照しながら本発明の実施形態について詳解する。

Ａ．ロボット装置の構成
本発明では、胴体部に繋がった複数の関節を持ち、ロボット内部の制御周期毎に静的なモーション及びリアルタイムな動作生成による目標指令値（角度やトルク、アクチュエータ・ゲインなど）を各関節アクチュエータ（若しくは関節駆動に対応するデバイス）に与えることができるロボット装置を想定としている。

図１及び図２には本発明の実施に供される「人間形」又は「人間型」のロボット装置１００が直立している様子を前方及び後方の各々から眺望した様子を示している。図示の通り、ロボット装置１００は、胴体部と、腰部と、頭部と、左右の上肢部と、脚式移動を行なう左右２足の下肢部とで構成され、例えば胴体に内蔵されている制御部（図示しない）によりロボット装置の動作を統括的にコントロールするようになっている。

左右各々の下肢は、大腿部と、膝関節と、脛部と、足首と、足平とで構成され、股関節によって体幹部の略最下端にて連結されている。また、左右各々の上肢は、上腕と、肘関節と、前腕とで構成され、肩関節によって体幹部の上方の左右各側縁にて連結されている。また、頭部は、首関節によって体幹部の略最上端中央に連結されている。

このように構成されたロボット装置１００は、制御部（図１及び図２には図示しない）による全身協調的な動作制御により、２足歩行を実現することができる。かかる２足歩行は、一般に、以下に示す各動作期間に分割される歩行周期を繰り返すことによって行なわれる。すなわち、

（１）右脚を持ち上げた、左脚による単脚支持期
（２）右足が接地した両脚支持期
（３）左脚を持ち上げた、右脚による単脚支持期
（４）左足が接地した両脚支持期

制御部は、このロボット装置１００を構成する各関節アクチュエータの駆動制御や各センサ（後述）などからの外部入力を処理するコントローラ（主制御部）や、電源回路その他の周辺機器類を搭載した筐体である。制御部は、その他、遠隔操作用の通信インターフェースや通信装置を含んでいてもよい。

脚式移動ロボット１００における歩行制御は、例えばＺＭＰを安定度判別規範として、あらかじめ下肢の目標軌道を計画し、上記の各期間において計画軌道の修正を行なうことによっても実現される。この場合、両脚支持期では、下肢軌道の修正を停止して、計画軌道に対する総修正量を用いて腰の高さを一定値で修正する。また、単脚支持期では、修正を受けた脚の足首と腰との相対位置関係を計画軌道に復帰させるように修正軌道を生成する。

あるいは、脚式移動ロボット１００の左右の脚部など、全身の可動部のうち少なくとも一部を物理振動子として捉え、センサ出力などに基づいて得られる内部状態と外部環境に応じて物理振動子の位相を数学的に操作により発生させて、機体の大局的な安定性を実現するとともに、未知の外乱に適応的に対応することができる。

図３には、このロボット装置１００が具備する関節自由度構成を模式的に示している。同図に示すように、ロボット装置１００は、２本の腕部と頭部１を含む上肢と、移動動作を実現する２本の脚部からなる下肢と、上肢と下肢とを連結する体幹部と、腰部で構成された、複数の肢を備えた構造体である。

頭部を支持する首関節（Ｎｅｃｋ）は、首関節ヨー軸１０１と、首関節ピッチ軸１０２Ａ、頭ピッチ軸１０２Ｂ、首関節ロール軸３という４自由度を有している。

また、各腕部は、その自由度として、肩（Ｓｈｏｕｌｄｅｒ）における肩関節ピッチ軸１０４と、肩関節ロール軸１０５と、上腕ヨー軸６、肘（Ｅｌｂｏｗ）における肘関節ピッチ軸１０７と、手首（Ｗｒｉｓｔ）における手首関節ヨー軸１０８と、手部とで構成される。手部は、実際には、複数本の指を含む多関節・多自由度構造体である。

また、体幹部（Ｔｒｕｎｋ）は、体幹ピッチ軸１０９と、体幹ロール軸１１０という２自由度を有する。

また、下肢を構成する各々の脚部は、股関節（Ｈｉｐ）における股関節ヨー軸１１１と、股関節ピッチ軸１１２と、股関節ロール軸１１３と、膝（Ｋｎｅｅ）における膝関節ピッチ軸１１４と、足首（Ａｎｋｌｅ）における足首関節ピッチ軸１１５と、足首関節ロール軸１１６と、足部とで構成される。

但し、ロボット装置１００が上述したすべての自由度を装備しなければならない訳でも、あるいはこれに限定される訳でもない。設計・製作上の制約条件や要求仕様などに応じて、自由度すなわち関節数を適宜増減することができることは言うまでもない。

上述したようなロボット装置１００が持つ各自由度は、実際には回転型アクチュエータを用いて実装され、これらの回転位置制御に基づいて運動制御を行なうようになっている。外観上で余分な膨らみを排してヒトの自然体形状に近似させること、２足歩行という不安定構造体に対して姿勢制御を行なうことなどの要請から、これら関節アクチュエータは小型且つ軽量であることが好ましい。

本実施形態では、ギア直結型で、且つサーボ制御系、電源系、並びにセンサ系の回路を搭載した制御基板をモータ・ユニットに内蔵したタイプの小型ＡＣサーボ・アクチュエータを搭載することとした。モータ・ユニット内のセンサには、サーボ制御のための回転位置若しくは関節位置を検出する角度・位置センサ、姿勢安定制御（例えばＺＭＰ方程式のパラメータ取得）のための加速度センサやジャイロ・センサ、異常状態検出のためのトルク・センサや電流検出センサなどが含まれる。また、アクチュエータ・モータの直結ギアとして低減速ギアを採用することにより、人間との物理的インタラクションを重視するタイプのロボット１００に求められている駆動系自身の受動的特性を得ている。この種のＡＣサーボ・アクチュエータに関しては、例えば本出願人に既に譲渡されている特開２０００−２９９９７０号公報や特開２００４−１８１６１３号公報などに開示されている。

図４には、ロボット装置１００の制御システム構成を模式的に示している。同図に示すように、ロボット装置１００は、ヒトの四肢を表現した各機構ユニット１３０、１４０、１４１、１５０Ｒ／Ｌ、１６０Ｒ／Ｌと、各機構ユニット間の協調動作を実現するための適応制御を行なう制御ユニット１８０とで構成される（但し、Ｒ及びＬの各々は、右及び左の各々を示す接尾辞である。以下同様）。

ロボット装置１００全体の動作は、制御ユニット１８０によって統括的に制御される。制御ユニット１８０は、ＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）やメモリなどの主要回路コンポーネント（図示しない）で構成される主制御部１８１と、電源回路やロボット１００の各構成要素とのデータやコマンドの授受を行なうインターフェース（いずれも図示しない）などを含んだ周辺回路１８２とで構成される。

ここで言う周辺回路１８２は、ロボット装置に搭載される周辺機器類の他、ケーブルや無線を通して接続される外付けの周辺機器、充電ステーション（図示しない）やその他の周辺機器を接続するためのインターフェース・コネクタなどを含むものとする。

本発明を実現する上で、この制御ユニット１８０の設置場所は特に限定されない。図４では体幹部ユニット１４０に搭載されているが、頭部ユニット１３０に搭載してもよい。あるいは、ロボット装置１００外に制御ユニット１８０を配設して、ロボット装置１００本体とは有線若しくは無線で交信するようにしてもよい。

図３に示したロボット装置１００内の各関節自由度は、それぞれに対応するアクチュエータによって実現される。すなわち、頭部ユニット３０には、首関節ヨー軸１０１、首関節ピッチ軸１０２、首関節ロール軸１０３の各々を表現する首関節ヨー軸アクチュエータＭ₁、首関節ピッチ軸アクチュエータＭ_2A、頭ピッチ軸アクチュエータＭ_2B、首関節ロール軸アクチュエータＭ₃が配設されている。

また、体幹部ユニット１４０には、体幹ピッチ軸１０９、体幹ロール軸１１０の各々を表現する体幹ピッチ軸アクチュエータＭ₉、体幹ロール軸アクチュエータＭ₁₀が配設されている。

また、腕部ユニット１５０Ｒ／Ｌは、上腕ユニット１５１Ｒ／Ｌと、肘関節ユニット１５２Ｒ／Ｌと、前腕ユニット１５３Ｒ／Ｌに細分化されるが、肩関節ピッチ軸１０４、肩関節ロール軸１０５、上腕ヨー軸１０６、肘関節ピッチ軸１０７、手首関節ヨー軸１０８の各々を表現する肩関節ピッチ軸アクチュエータＭ₄、肩関節ロール軸アクチュエータＭ₅、上腕ヨー軸アクチュエータＭ₆、肘関節ピッチ軸アクチュエータＭ₇、手首関節ヨー軸アクチュエータＭ₈が配設されている。

また、脚部ユニット１６０Ｒ／Ｌは、大腿部ユニット１６１Ｒ／Ｌと、膝ユニット１６２Ｒ／Ｌと、脛部ユニット１６３Ｒ／Ｌに細分化されるが、股関節ヨー軸１１１、股関節ピッチ軸１１２、股関節ロール軸１１３、膝関節ピッチ軸１１４、足首関節ピッチ軸１１５、足首関節ロール軸１１６の各々を表現する股関節ヨー軸アクチュエータＭ₁₁、股関節ピッチ軸アクチュエータＭ₁₂、股関節ロール軸アクチュエータＭ₁₃、膝関節ピッチ軸アクチュエータＭ₁₄、足首関節ピッチ軸アクチュエータＭ₁₅、足首関節ロール軸アクチュエータＭ₁₆が配設されている。

各関節に用いられるアクチュエータＭ₁、Ｍ₂、Ｍ₃…は、より好ましくは、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニット内に搭載したタイプの小型ＡＣサーボ・アクチュエータ（前述）で構成することができる。

頭部ユニット１３０、体幹部ユニット１４０、腕部ユニット１５０、各脚部ユニット１６０などの機構ユニット毎に、アクチュエータ駆動制御用の副制御部１３５、１４５、１５５、１６５が配設されている。

腰部１４１には、加速度センサ１９６と姿勢センサ１９５が配設されている。加速度センサ１９６は、ＸＹＺの各軸方向に配置する。また、腰部１４１に加速度センサ１９６を配設することによって、質量操作量が大きな部位である腰部を制御対象点として設定して、その位置における姿勢や加速度を直接計測して、ＺＭＰに基づく姿勢安定制御を行なうことができる。加速度センサ９６と姿勢センサ９５は、図３中ではそれぞれ加速度センサＡ１及びジャイロ・センサＧ１として構成されている。

また、左右の各脚部１６０Ｒ及び１６０Ｌには、接地確認センサ１９１及び１９２と、加速度センサ１９３及び１９４がそれぞれ配設されている。接地確認センサ１９１及び１９２は、例えば足底に圧力センサを装着することにより構成され、床反力の有無により足底が着床したか否かを検出することができる。また、加速度センサ１９３及び１９４は、少なくともＸ及びＹの各軸方向に配置する。左右の足部に加速度センサ１９３及び１９４を配設することにより、ＺＭＰ位置に最も近い足部で直接ＺＭＰ方程式を組み立てることができる。図３中では、左右の足首に、足平における加速度を計測するセンサＡ２及びＡ２と、足平の姿勢を計測するジャイロ・センサＧ２及びＧ３がそれぞれ配設されている。また、左右の足底の四隅に、接地並びに床反力を計測する力センサＦ１〜Ｆ４、Ｆ５〜Ｆ８が配設されている。

本実施形態では、路面との接触部位である足部にＺＭＰと力を直接する反力センサ・システム（床反力センサなど）を配設するとともに、制御に用いるローカル座標とその座標を直接的に計測するための加速度センサを配設している。したがって、ＺＭＰ位置に最も近い足部で直接的にＺＭＰ釣合い方程式を組み立てることによって、より厳密な姿勢安定化制御を高速で実現することができる。

主制御部１８０は、各センサＡ１〜Ａ３、Ｇ１〜Ｇ３、Ｆ１〜Ｆ８の出力に応答して制御目標をダイナミックに補正することができる。より具体的には、副制御部１３５、１４５、１５５、１６５の各々に対して適応的な制御を行ない、ロボット装置１００の上肢、体幹、及び下肢が協調して駆動する全身運動パターンを実現する。

ロボット装置１００の全身運動は、足部運動、ＺＭＰ軌道、体幹運動、上肢運動、腰部高さなどを設定するとともに、これらの設定内容に従った動作を指示するコマンドを各副制御部１３５、１４５、１５５、１６５に転送する。そして、各々の副制御部１３５、１４５…では、主制御部１８１からの受信コマンドを解釈して、各アクチュエータＭ₁、Ｍ₂、Ｍ₃…に対して駆動制御信号を出力する。

Ｂ．受動車輪機構
本実施形態に係るロボット装置は、足部に受動車輪機構を着脱自在に取り付けることにより、脚式の移動と車輪型の移動の双方の特質を兼ね備えたハイブリッド型の移動を実現することができる。また、車輪は足部の動作により受動的に推進力を得ることができ、車輪駆動用のアクチュエータを搭載しないことから、総重量を増大させずに済む。

また、本発明では、足先の受動車輪機構は着脱自在とし、足先に装着することで、脚式及び車輪式併用の移動機能を実現することができる。図５〜図９には、本発明の一実施形態に係る滑走ユニットの構成を示している。

同図において、足底ベース部１０は、脚式移動ロボットの足部に取り付けるための部材であり、形状は脚構造によって任意に設計することができる。以下の構造は、ＹＺ平面に対して対称とする．

第１のステー１は、足底ベース部１０に取り付けられている。図４からも判るように、第１のステー１は、ＸＹ平面と一定の角度をなす２つの傾斜面を前後にそれぞれ有する。各傾斜面には、傾斜面法線に平行となる受動回動軸が回転自在に取り付けられている。

各受動回転軸には、第１のステー１に対して受動回転軸回りに自在に回動する第２のステー２がそれぞれ連結されている。

また、前後の各第２のステー２の左右両端には、１対のホイル・ステー１１がそれぞれ取り付けられている。ホイル・ステー１１にはそれぞれ車軸と車軸止めが取り付けられている。そして、左右の車軸には、車輪が車軸回りに回転自在に軸支されている。前後の各第２のステー２ではそれぞれ、左右の車軸はほぼ同軸となるように配設されているものとする。

この車輪は、車軸回りに駆動力を持たない受動車輪である。受動回動軸は、第１のステー１に取り付けられた回転拘束機構により、第２のステー２の回転を拘束することができる。

なお、図示の例では、足底ベース部１０と第１のステー１は組み立て易さを考え別部品としたが、一体で構成することも可能である。また、受動回動軸、第２のステー２、ホイル・ステー１１、車軸止めも一体で構成しても構わない。また、図２１に示すように、第１のステー１は前後分離し、傾斜面角度を図４の場合と逆になるように構成しても良い。

以上のように構成すると、足部の前後にそれぞれ配設された第２のステー２の左右両端部にある受動車輪は対を成しており、第２のステー２は第１のステー１に対し受動回動軸回りに回転することができる。受動回動軸回りの角度については、駆動力を持たないことから、直接回動することはできないが、後述するように足底ベース部１０のロール角度調節によって間接的に角度を変更することができる。

図１０には、受動車輪の構造の一例を示している。図示しないが、車輪内部には一方向クラッチなどの回転拘束機構を内蔵しても良い。この場合、車輪推進による後退動作はできなくなるが、前方への推進は非常に簡潔な制御方法を用いることができる（後述）。

回転拘束機構は、具体的には電磁ブレーキやパウダークラッチなどにより、受動回動軸回りの摩擦トルクを制御する、あるいは単純にラッチピンなどにより、一定角度で固定するようにしても良い。受動回動軸を図７で示した位置で固定すれば、滑走ユニットは特許文献２で述べられている、脚を遊脚化することによるスケート推進制御法をそのまま用いることができ、本発明と矛盾しない。

図１１には、図５〜図９に示した受動車輪機構において、進行方向を変化させるための操舵角を得る仕組みを図解している。また、図２２には、２足脚式ロボットが足先にロール角θ_Rollを与えた様子を示している。

図示するように、足底ベース部１０をロール方向にロール角θ_Rollだけ回転する。この場合、足底の前後それぞれに配設された各第２のステー２それぞれの左右両端に取り付けられた４つの車輪が同じ床面内での接地状態を維持するようにする。すなわち、足底ベース部がロール方向に傾くと、左右のうち床面と足底ベース部の距離が短くなった側では前後の車輪の間隔が短くなり、逆に、左右のうち床面と足底ベース部の距離が長くなった側では、前後の車輪の間隔が長くなる。この場合、４つの車輪が足底ベース部１０と床面のなす空間にちょうど収まるように、第２のステー２の受動回動軸回りの受動的な回転を生じることになる。例えば、図１１に示すように、前方の第２のステー２が受動回動軸回りにθ_passiveだけ受動回転するとともに、後方の第２のステー２が受動回動軸回りに−θ_passiveだけ受動回転する。

この結果として、前方の第２のステー２に取り付けられた左右１対の受動車輪の転がり方向はロボットのＸ方向に対しθ_strだけ傾きを持ち、且つ後方の第２のステー２に取り付けられた左右一対の受動車輪の転がり方向はロボットのＸ方向に対し−θ_strだけ傾きを持つので、受動車輪機構全体を操舵角θ_strを以って操舵することができる。このような仕組みにして操舵することで、脚をヨー方向に駆動することを容易にすることができる。

一例として、特許文献２で述べられている、両脚支持状態で直進滑走を行ない、スキーのボーゲンのようにトーイン角をつけることで制動する方法について示す。

図１２には、図５〜図９に示した受動車輪機構を左右の両脚の足部に装着した場合において、制動操作を行なった場合に左右の受動車輪機構がそれぞれ描く軌道を示している。同図に示すように、空走状態では車輪転がり方向は進行方向に平行であり、停止状態ではトーイン角を持っている。

過渡的な状態では時間の関数として受動車輪軌跡は必ず曲率半径ρ（ｔ）を持つことになる。この曲率半径に合わせて受動車輪を操舵することができれば、滑らかな移動が可能になり、また脚部ヨー回転アクチュエータ・トルクを非常に低くできる。この例では、トーイン角が単調に増加する軌跡について述べたが、曲率が複雑に変化する曲線に関しても適用することが可能である。したがって、特許文献２とは相違し、支持脚時の連続的な方向転換が可能である。

Ｃ．操舵方法
図１１を参照しながら既に説明したように、本発明に係る受動車輪機構によれば、足底ベース部１０をロール方向に回転することで、足底の前後にそれぞれ配設された第２のステー２が受動回動軸回りに回動する。その結果として、前後それぞれの受動車輪における転がり方向にはロボット本体の進行方向に対する傾きが与えられ、受動車輪を操舵するための操舵角θ_strを得ることができる。

以下では、足底ベース部１０のロール角度と操舵角の関係について、数式を用いながら説明する。足底ベース部１０の傾きをθ_Roll（但し、θ_Roll≠０）、第１のステー１（若しくは足底ベース部１０）の傾斜面とＸＹ平面のなす角をθ_Pitch（θ_Pitch≠０）、第２のステー２の受動回動軸回りの回転角をθ_Passive、受動車輪の転がり方向と進行方向（ここではＸ方向とする）のなす角を操舵角θ_strとおく。また、受動回転軸の受動回転の中心Ｚ座標をＺ₀、受動車輪の受動回転軸に対する回動半径をＲとおく。図５〜図９に示した受動車輪機構では、第２のステー２の構成並びに操舵時の動作は前後方向で対称であることから、前後輪どちらか一方のみ扱えば十分である。

まず始めに、左右対になっている受動車輪のどちらか一方を外し、一輪のみである場合を考える。この場合の受動車輪の下端が描く軌跡は、図１３に示すように受動回動軸を中心として傾斜面上の円で表される。車輪は常に接地しているものと仮定すれば、床面からの垂直抗力がＺ正方向に働く。したがって、受動回転軸は回動し、第１のステー１若しくは足底ベース部１０のなす平面の最大傾斜線方向と、受動車輪軌跡円の交点が安定平衡点となり、停止する。すなわち、車輪の最下端の接地点が床面とベース面の距離が最も離れている点に到達するように、第２のステー２が受動回転軸に対し首振り動作し、その到達点が安定平衡点となる。ここで、受動車輪下端の位置を下式のように定める

このとき受動車輪下端の描く軌跡はθ_Passiveをパラメータとして次式で表される。

安定平衡点はＰ_zが最大値となる点であることから、以下の関数ｇを最大化するθ_Passiveを求めればよい。

そして、上式を解くことにより次式を得ることができる。

以上より、一輪の場合の安定平衡点が求められる。次に、１つの第２のステー２の左右両端に取り付けられた２輪の車輪が対になっている場合を考える。受動回転角θ_Passiveは明らかに左右のＰ_zが等しくなる点が安定平衡点である。一輪の場合の安定平衡点を受動回動軸周りにπ／２回動させた点であることから，改めてθ_Passiveは下式の通りとなる。

このとき床面に対する実効的な操舵角θ_strは図示する投影角度であることから、１輪の場合の安定平衡点座標（ｐ_x，ｐ_y）を用い、下式に従って求めることができる。

より具体的には進行方向とのなす角を考えると、下式のように表される。

以上より、望みのθ_strを得るための（θ_Roll，θ_Pitch）が求められる。なお、ロール角度θ_Roll＝０のときは、明らかに操舵角θ_str＝０である。

図１４には、ピッチ角度θ_Pitchを第１のステー１の設計パラメータとして、θ_Rollとθ_strの関係を示している。ここでは、左右の対称性に考慮して、ゼロから９０［ｄｅｇ］の範囲でのみ図示する。操舵にθ_Rollを用いるとすると、θ_Pitchをθ_strへの変換ゲインとみなすことができる。つまり、θ_Pitchを小さく設定すれば、少ないθ_Rollで大きな操舵角θ_strを得ることができる。また逆に、θ_Pitchを大きく設定すれば、θ_Roll変化に対して小さな操舵角θ_strの変換となる。

例えば、脚部の可動範囲制限によりロール角度θ_Rollが大きく取れない場合には、ピッチ角度θ_Pitchを小さくすることで、操舵角θ_strを大きく拡大することができる。また、ピッチ角度θ_Pitchを大きく取れば、操舵角θ_strの安定性を高めることができる。つまり、ロール角度θ_Rollの変化に対して操舵角θ_strが鈍くなることから、外乱が加わりロール角度θ_Rollが乱されるような場合であっても操舵角θ_str自体の変化は微小となることから、操舵は安定する。

通常の自動車での操舵の場合、操舵角θ_strはおよそ３０［ｄｅｇ］程度である。最大操舵角のときにθ_Roll＝θ_strとなるようにθ_Pitch＝４１［ｄｅｇ］と設定すると、ロール角度θ_Rollと操舵角θ_strとの関係は図１５に示すようになる。この範囲で線形と近似しても十分に差し支えない、したがって、ロール角度θ_Rollを通常の自動車のステアリングとみなしても全く遜色が無いことが分る。

以上より、ピッチ角度θ_Pitchが機構的に一定値である場合、足底ベース部１０のロール角度θ_Rollを変えることで一意に操舵角θ_strを求められることが示された。

Ｄ．受動車輪機構を備えた脚式移動ロボットによる運動生成方法
この項では、上述した受動車輪機構を利用した脚式移動ロボットによる運動生成方法について詳解する。ここでは、図１〜図４に示したような２つの可動脚を備えた２脚歩行ロボットへ適用した具体例について考察する。但し、ロボット装置は、足先に受動車輪機構を備え車輪移動動作を行なう場合には、両脚支持のまま推進する方法をとるものとする。

図１６には、受動車輪機構を利用した脚式移動ロボットの運動を生成するための処理手順をフローチャートの形式で示している。

まず、ロボット装置の進行速度並びに進行方向を設定し（ステップＳ１）、これに基づいて、周期関数や初期位置などの脚の運動を設定する（ステップＳ２）。

ここで、設定された脚の運動が、脚の可動範囲や速度上限値の許容範囲内であるかどうかをチェックする（ステップＳ３）。ここで、許容範囲を逸脱する場合には、ステップＳ２に戻り、脚の運動の再設定を行なう。

次いで、絶対空間デカルト座標系から見た足先速度を算出し（ステップＳ４）、滑走ユニットの受動車輪の接地面における摩擦抗力を算出し（ステップＳ５）、重心加速度を算出する（ステップＳ６）。そして、重心加速度を時間積分することにより重心速度を得て（ステップＳ７）、設定した進行速度を得ることができたかどうかを判別する（ステップＳ８）。ここで、設定した進行速度が得られなかった場合には、ステップＳ２に戻り、脚の運動の再設定を行なう。

このようにして、ステップＳ２において設定した脚の運動を得ることができたならば、これを実行する（ステップＳ９）。

以下では、図１６に示した運動生成手順に従って、図１〜図４に示した２足ロボット装置により直進運動並びに旋回運動を行なう場合についてそれぞれ説明する。

Ｄ−１．直進
走行路面は平坦であると仮定し、足先Ｚ位置を一定とし、遊脚化は行なわない。ロボットの進行速度（絶対座標系から見たローカル座標原点の速度）を設定する。一例として、ロボットはロール軸方向（Ｘ方向）に一定速度ωで進むとする（ステップＳ１）。

次に、ローカル座標系を用いて、脚運動の設定を行なう（ステップＳ２）。足先軌道をロール−ピッチ軸平面上（ＸＹ平面上）でピッチ軸方向（Ｙ方向）に振動させ、単脚では図１７に示すような蛇行軌道を描くものとする。

このとき、受動車輪が受動回転軸方向に速度が生じないようにすれば、受動車輪による推進力を得ることができる。例えば、左右の脚の足先にＹ方向への運動を左右対称に行なわせることによって、車輪の転がり方向は摩擦係数が少ないが軸方向は摩擦が大きいという抗力の異方性に基づいて、Ｙ方向への運動が推進用受動車輪の回転運動に変換されて、推進方向（ロボットの進行方向すなわちＸ方向）への推進力を得ることができる。すなわち、受動車輪の転がり方向にのみ滑らかに推進することができ、アクチュエータ負荷は非常に小さくなる。この仕組みを、以下では幾何学的関係から求める。

ωを定数、ｔを時間として、ロボットがロール軸方向（Ｘ方向）に一定に進む場合、絶対空間座標系において下式のように表すことができる。

このとき、ピッチ軸方向（Ｙ方向）位置をｘの関数として以下のように仮定する。

ここで、ｆ（ｘ）は２階微分可能な連続関数、ｙ_offsetは定数である。このとき、足先のヨー方向回転角度θ_Yawは次式で表される。

また、曲率半径ρはよく知られるように、次式で表される。

この曲率半径に沿うように操舵角θ_strを制御すれば、受動車輪軸方向速度は生じない。したがって、図１８に示すように前後輪の軸間距離を２Ｌ_wxとおくと、下式のように表される。

よって式（７）及び式（１２）より、下式が得られる。

以上より、ＸＹ方向の脚軌道位置が与えられたときに幾何学的に矛盾を生じないための条件式が得られる。

推進するための具体的な関数ｆ（ｘ）として、代表的なものを挙げると、正弦波、半円弧を組み合わせた複合曲線、クロソイド曲線を用いた複合曲線、サーペノイド曲線（曲率の変化率が正弦波）などが考えられる。以上の軌道を両脚で左右対称に描くことで（図１９を参照のこと）、Ｙ方向の力を釣り合わせ相殺し、Ｘ方向への推進力を得ることができる。すなわち車輪の転がり方向は摩擦係数が少ないが軸方向は摩擦が大きいという抗力の異方性に基づいて、Ｙ方向への運動が推進用受動車輪の回転運動に変換されて、推進方向（ロボットの進行方向すなわちＸ方向）への推進力を得ることができる。

この脚軌道が各関節の可動範囲・速度上限値内であるか否かの判定を行なう。そして、実現できないようであれば、周期関数ｆ（ｘ）、初期位置ｙ_offsetを変更する（ステップＳ３）。

さて、胴体座標系から見た足先位置が決められているので、時間微分し、胴体座標系の移動速度を加算することで、絶対座標系から見た足先速度Ｖ_legを求めることができる（ステップＳ４）。受動車輪が足先速度Ｖ_legで動く場合、車輪に生ずる床面からの反力は、クーロン摩擦条件から下式のように表される。

但し、Ｆ_t、Ｆ_n、μ_t、μ_nはそれぞれ受動車輪転がり方向摩擦力、軸方向摩擦力、転がり方向動摩擦係数、軸方向動摩擦係数である。また、Ｎは垂直抗力である。よって、この関係から、ロボットに働く反力が求められる（ステップＳ５）。この力によってロボットは推進することから、加速度を算出することができる（ステップＳ６）。そして、一階積分することで進行速度を得ることができる（ステップＳ７）。

上記の式（９）〜式（１３）で定められる脚軌道はロボットの進行速度がωのときＦ_n＝０となり、車輪軸方向に滑りを生じず、最も移動のエネルギ効率が良くなる平衡速度ωに収束する。したがって、定常状態では多くの場合、進行速度はωとなる。しかしながら、μ_t、μ_nの値によってはωに達するまで非常に長い時間を要したり、全く推進できない場合も考えられる。このような場合、再び脚の運動設定のステップに戻り、パラメータの調節を行なう（ステップＳ８）。そして、設定した進行速度との差が十分小さくなった軌道を用いて、運動を実行する（ステップＳ９）。

移動速度はωによって変更可能である。実際に実験を行なったところ、移動速度０からおよそ０．５［ｍ／ｓ］までの滑らかな速度変化を確認した。なお、最大推進速度０．５［ｍ／ｓ］は歩行に比しておよそ２倍の高速な移動を実現することができる。

Ｄ−２．旋回運動
推進方向を変化させる場合、次式に示すようにオフセットを加えることにより、旋回半径を変更することができる。

このとき、θ_{Roll_offset}により規定される旋回半径ρ_offsetは次式で表される。

図２０には、このときの足先軌道の外形を示している。同図では、左右脚のピッチ軸方向オフセットｙ_{offset_L}並びにｙ_{offset_R}を合わせて示している。もしこれらのオフセット量が大きければ、自動車で言う内輪差が左右脚に生じ、速度差が発生する。この場合、図１６に示したフローチャートのステップ２に戻り、軌道の修正を行なう。しかしながら、旋回半径に比してｙ_{offset_L}、ｙ_{offset_R}は通常十分に小さいので、軌道修正は多くの場合必要がない。

この場合、オフセット値θ_{Roll_offset}によって連続的に旋回半径が変更されることから、ユーザがインタラクティブに指令値を変更しても対応することができる。このオフセットは一般の乗用車のステアリング操舵角に相当するものであり、直観的に操作し易い。

なお、旋回のためのオフセットを加えることで足首ロール方向の関節可動範囲リミットに制約される場合も考えられる。この場合は左右脚Ｚ高さを変更することで、ロボット全体をロール方向に倒し込み、可動範囲の不足を補うことができる。高速で旋回する場合には、遠心力が無視できなくなるが、ロボット全体を旋回中心側に傾けることで釣り合いを保つことができる。

以上の方法を実装したところ、直進から半径０．５［ｍ］程度の円弧まで滑らかに旋回できることが確かめられた。

Ｅ．一方向クラッチを使用する場合
受動車輪内に一方向クラッチを内蔵する場合、推進動作は非常に簡単化することができる。定常直進の場合を例にとると、脚Ｘ位置を正弦波で駆動すれば、脚を後方に蹴る動作はクラッチにより推進力となり、逆に前方に復帰する動作は受動車輪が空転することにより、抵抗力にはならない。また、旋回する場合は、ＸＹ平面上で曲線となる基準軌道を設定し、その軌道に沿うように往復運動をすることで、直進と同様に推進力を得ることができる。但し、この場合、最大推進速度は足先最大速度であることから、前述の方式の方が優れていると考えられる。

以上、脚位置軌道のみに注目して述べたが、実際に制御する際にはＺＭＰ制御則などを用いて、転倒しないように運動を調整することが必要である。また、足底力センサ情報などを用いて、左右脚に均等に荷重が負荷できるよう調節することで、例えば左右で高さが異なるような路面であっても推進することができる。

以上、特定の実施形態を参照しながら、本発明について詳解してきた。しかしながら、本発明の要旨を逸脱しない範囲で当業者が該実施形態の修正や代用を成し得ることは自明である。

本発明の要旨は、必ずしも「ロボット」と称される製品には限定されない。すなわち、電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行なう機械装置あるいはその他一般的な移動体装置であるならば、例えば玩具などのような他の産業分野に属する製品であっても、同様に本発明を適用することができる。

また、本明細書では、２足ロボットに本発明を適用した実施形態について説明してきたが、勿論、４足などの多足の移動ロボットに対して本発明を適用することも可能である。

要するに、例示という形態で本発明を開示してきたのであり、本明細書の記載内容を限定的に解釈するべきではない。本発明の要旨を判断するためには、特許請求の範囲を参酌すべきである。

図１は、本発明の実施に供される「人間形」又は「人間型」のロボット装置１００が直立している様子を前方から眺望した様子を示した図である。 図２は、本発明の実施に供される「人間形」又は「人間型」のロボット装置１００が直立している様子を後方から眺望した様子を示した図である。 図３は、ロボット装置１００が具備する関節自由度構成を模式的に示した図である。 図４は、ロボット装置１００の制御システム構成を模式的に示した図である。 図５は、本発明の一実施形態に係る滑走ユニットの構成を示した図である。 図６は、本発明の一実施形態に係る滑走ユニットの構成を示した図である。 図７は、本発明の一実施形態に係る滑走ユニットの構成を示した図である。 図８は、本発明の一実施形態に係る滑走ユニットの構成を示した図である。 図９は、本発明の一実施形態に係る滑走ユニットの構成を示した図である。 図１０は、受動車輪の構造の一例を示した図である。 図１１は、図５〜図９に示した受動車輪機構において、進行方向を変化させるための操舵角を得る仕組みを説明するための図である。 図１２は、図５〜図９に示した受動車輪機構を左右の両脚の足部に装着した場合において、制動操作を行なった場合に左右の受動車輪機構がそれぞれ描く軌道を示した図である。 図１３は、左右対になっている受動車輪のどちらか一方を外し、一輪のみである場合の受動車輪の下端が描く軌跡を示した図である。 図１４は、ピッチ角度θ_Pitchを第１のステー１の設計パラメータとして、θ_Rollとθ_strの関係を示した図である。 図１５は、ロール角度θ_Rollと操舵角θ_strとの関係を示した図である。 図１６は、受動車輪機構を利用した脚式移動ロボットの運動を生成するための処理手順を示したフローチャートである。 図１７は、足先軌道をロール−ピッチ軸平面上（ＸＹ平面上）でピッチ軸方向（Ｙ方向）に振動させ、単脚では蛇行軌道を描く様子を示した図である。 図１８は前後輪の軸間距離を示した図である。 図１９は、両脚で左右対称に足先軌道を描く様子を示した図である。 図２０は、旋回運動を行なう際の足先軌道の外形を示した図である。 図２１は、第１のステー１の変形例を示した図である。 図２２は、２足脚式ロボットが足先にロール角θ_Rollを与えた様子を示した図である。 図２３は、両脚接地期においてスキーのボーゲンのように車輪をハの字に傾けることにより制動するときの挙動を説明するための図である。 図２４は、ローラーウォーカーの自由度構成を模式的に示した図である。 図２５は、ローラーウォーカーの自由度構成を模式的に示した図である。

符号の説明

１…第１のステー
２…第２のステー
１０…足底ベース部
１１…ホイル・ステー
１００…脚式移動ロボット
１０１…首関節ヨー軸
１０２Ａ…第１の首関節ピッチ軸
１０２Ｂ…第２の首関節（頭）ピッチ軸
１０３…首関節ロール軸
１０４…肩関節ピッチ軸
１０５…肩関節ロール軸
１０６…上腕ヨー軸
１０７…肘関節ピッチ軸
１０８…手首関節ヨー軸
１０９…体幹ピッチ軸
１１０…体幹ロール軸
１１１…股関節ヨー軸
１１２…股関節ピッチ軸
１１３…股関節ロール軸
１１４…膝関節ピッチ軸
１１５…足首関節ピッチ軸
１１６…足首関節ロール軸
１３０…頭部ユニット
１４０…体幹部ユニット
１４１…腰部ユニット
１５０…腕部ユニット，１５１…上腕ユニット
１５２…肘関節ユニット，１５３…前腕ユニット
１６０…脚部ユニット，１６１…大腿部ユニット
１６２…膝関節ユニット，１６３…脛部ユニット
１８０…制御ユニット，１８１…主制御部
１８２…周辺回路
１９１，１９２…接地確認センサ
１９３，１９４…加速度センサ
１９５…姿勢センサ
１９６…加速度センサ

Claims (18)

1. １以上の可動脚を備えたロボット装置であって、
   前記可動脚の足先に取り付けられた滑走ユニットと、
   少なくとも可動脚の動作を制御する動作制御手段とを備え、
   前記滑走ユニットは、
   前記可動脚の足部に取り付けられ、ＸＹ平面を構成する足部ベース部と、
   前記ＸＹ平面と一定の角度をなす２つの傾斜面を前後にそれぞれ有する第１の支持部材と、
   前記の各傾斜面に対し、傾斜面法線方向と平行となるように配設された前方及び後方の受動回転軸と、
   前記の前方及び後方の各受動回転軸に、前記第１の支持部材に対して受動回転軸回りに回動自在にそれぞれ取り付けられた第２の支持部材と、
   前記の前方及び後方の第２の支持部材の左右両端に回転可能にそれぞれ取り付けられた略同軸状の受動車輪とを備える、
   ことを特徴とするロボット装置。
2. 前記第２の支持部材の前記第１の支持部材に対する回転を拘束する回転拘束手段をさらに備える、
   ことを特徴とする請求項１に記載のロボット装置。
3. 前記動作制御手段は、足底ベース部のロール角度調節に基づいて第２の支持部材の受動回動軸回りの角度を間接的に変更することにより、前記受動車輪の進行方向を前記ロボット装置のＸ方向に傾けて操舵角を得る、
   ことを特徴とする請求項１に記載のロボット装置。
4. 前記ロボット装置は、それぞれ前記滑走ユニットを装着した左右の可動脚を備え、
   前記動作制御手段は、左右の可動脚の足部に対するロール角度調節を同期的に行ない、両脚支持状態で滑走させる、
   ことを特徴とする請求項３に記載のロボット装置。
5. 前記動作制御手段は、空走状態では車輪転がり方向は進行方向に平行となり、停止状態ではトーイン角を与えるように、左右の可動脚の足部に対するロール角度調節を同期的に行なう、
   ことを特徴とする請求項４に記載のロボット装置。
6. 前記動作制御手段は、前記ＸＹ平面上でＹ方向の足先軌道を与え、単脚では蛇行軌道を描かせる、
   ことを特徴とする請求項３に記載のロボット装置。
7. 前記動作制御手段は、前記ＸＹ平面上でのＹ方向への足先軌道を正弦波、半円弧を組み合わせた複合曲線、クロソイド曲線を用いた複合曲線、又はサーペノイド曲線に基づいて与える、
   ことを特徴とする請求項６に記載のロボット装置。
8. 前記動作制御手段は、左右の可動脚の足部に与えるロール角度に異なるオフセットを与えることにより左右の足先軌道に速度差を与え、前記オフセットに相当する旋回半径を以って進行方向を変化させる、
   ことを特徴とする請求項４に記載のロボット装置。
9. 前記受動車輪の回転を一方向に限定する手段をさらに備える、
   ことを特徴とする請求項１に記載のロボット装置。
10. １以上の可動脚を備え、前記可動脚の足先に滑走ユニットが取り付けられたロボット装置の制御方法であって、
    前記滑走ユニットは、前記可動脚の足部に取り付けられ、ＸＹ平面を構成する足部ベース部と、前記ＸＹ平面と一定の角度をなす２つの傾斜面を前後にそれぞれ有する第１の支持部材と、前記の各傾斜面に対し、傾斜面法線方向と平行となるように配設された前方及び後方の受動回転軸と、前記の前方及び後方の各受動回転軸に、前記第１の支持部材に対して受動回転軸回りに回動自在にそれぞれ取り付けられた第２の支持部材と、前記の前方及び後方の第２の支持部材の左右両端に回転可能にそれぞれ取り付けられた略同軸状の受動車輪で構成され、
    足底ベース部のロール角度調節に基づいて第２の支持部材の受動回動軸回りの角度を間接的に変更することにより、前記受動車輪の進行方向を前記ロボット装置のＸ方向に傾けて操舵角を得る動作制御ステップを備える、
    ことを特徴とするロボット装置の制御方法。
11. 前記ロボット装置は、それぞれ前記滑走ユニットを装着した左右の可動脚を備え、
    前記動作制御ステップでは、左右の可動脚の足部に対するロール角度調節を同期的に行ない、両脚支持状態で滑走させる、
    ことを特徴とする請求項１０に記載のロボット装置の制御方法。
12. 前記動作制御ステップでは、空走状態では車輪転がり方向は進行方向に平行となり、停止状態ではトーイン角を与えるように、左右の可動脚の足部に対するロール角度調節を同期的に行なう、
    ことを特徴とする請求項１１に記載のロボット装置の制御方法。
13. 前記動作制御ステップでは、前記ＸＹ平面上でＹ方向の足先軌道を与え、単脚では蛇行軌道を描かせる、
    ことを特徴とする請求項１０に記載のロボット装置の制御方法。
14. 前記動作制御ステップでは、前記ＸＹ平面上でのＹ方向への足先軌道を正弦波、半円弧を組み合わせた複合曲線、クロソイド曲線を用いた複合曲線、又はサーペノイド曲線に基づいて与える、
    ことを特徴とする請求項１３に記載のロボット装置の制御方法。
15. 前記動作制御ステップでは、左右の可動脚の足部に与えるロール角度に異なるオフセットを与えることにより左右の足先軌道に速度差を与え、前記オフセットに相当する旋回半径を以って進行方向を変化させる、
    ことを特徴とする請求項１１に記載のロボット装置の制御方法。
16. 複数の可動脚を備え脚式移動動作を行なうロボット装置に対して適用され、前記可動脚の動作に応じた受動的な回転作用を生じて推進力を得る受動車輪装置であって、
    前記可動脚の足部に取り付けられ、ＸＹ平面を構成する足部ベース部と、
    前記ＸＹ平面と一定の角度をなす２つの傾斜面を前後にそれぞれ有する第１の支持部材と、
    前記の各傾斜面に対し、傾斜面法線方向と平行となるように配設された前方及び後方の受動回転軸と、
    前記の前方及び後方の各受動回転軸に、前記第１の支持部材に対して受動回転軸回りに回動自在にそれぞれ取り付けられた第２の支持部材と、
    前記の前方及び後方の第２の支持部材の左右両端に回転可能にそれぞれ取り付けられた略同軸状の受動車輪と、
    を具備することを特徴とする受動車輪装置。
17. 前記第２の支持部材の前記第１の支持部材に対する回転を拘束する回転拘束手段をさらに備える、
    ことを特徴とする請求項１６に記載の受動車輪装置。
18. 前記受動車輪の回転を一方向に限定する手段をさらに備える、
    ことを特徴とする請求項１６に記載の受動車輪装置。
    

Images