JP2004249374A - 脚式移動ロボット - Google Patents
脚式移動ロボット Download PDFInfo
- Publication number
- JP2004249374A JP2004249374A JP2003039560A JP2003039560A JP2004249374A JP 2004249374 A JP2004249374 A JP 2004249374A JP 2003039560 A JP2003039560 A JP 2003039560A JP 2003039560 A JP2003039560 A JP 2003039560A JP 2004249374 A JP2004249374 A JP 2004249374A
- Authority
- JP
- Japan
- Prior art keywords
- joint
- actuator
- polygon
- link
- floor
- 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.)
- Pending
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
【課題】起き上がりの途上における機体全体の運動時においてアクチュエータ特性を動的又は静的に制御することにより安定且つ高効率な動作を実現する。
【解決手段】最も狭い支持多角形の探索に関与する接床リンクの各関節部位のアクチュエータの特性を、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくし、支持多角形の大きさの精度を確保する。また、支持多角形に関与しない離床リンクの各関節部位のアクチュエータの特性を、より狭い接地多角形を形成するために接床するまでの期間中、低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくし、腕や脚の動作や着床動作を円滑にする。
【選択図】 図１
【解決手段】最も狭い支持多角形の探索に関与する接床リンクの各関節部位のアクチュエータの特性を、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくし、支持多角形の大きさの精度を確保する。また、支持多角形に関与しない離床リンクの各関節部位のアクチュエータの特性を、より狭い接地多角形を形成するために接床するまでの期間中、低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくし、腕や脚の動作や着床動作を円滑にする。
【選択図】 図１
Description
【０００１】
【発明の属する技術分野】
本発明は、ロボットや汎用組立機器、ロボット・ハンド機器、その他の多軸制御装置などのような多軸駆動系の機械装置に係り、特に、直列補償の比例ゲイン、位相補償要素から成り立つ位置制御系を構成するアクチュエータのサーボ制御器によって各関節部位が構成されるロボットに関する。
【０００２】
さらに詳しくは、本発明は、高ゲインＰＤ制御で各軸リンクが制御される２足歩行の脚式移動ロボットに係り、特に、うつ伏せ又は仰向けの姿勢からの起き上がり動作を始めとしてさまざまな動作の実行時においてアクチュエータそのものの特性とアクチュエータの制御器の特性の２つを動的又は静的に制御することにより安定且つ高効率な動作を実現する脚式移動ロボットに関する。
【０００３】
【従来の技術】
電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置のことを「ロボット」という。ロボットの語源は、スラブ語の”ＲＯＢＯＴＡ（奴隷機械）”に由来すると言われている。わが国では、ロボットが普及し始めたのは１９６０年代末からであるが、その多くは、工場における生産作業の自動化・無人化などを目的としたマニピュレータや搬送ロボットなどの産業用ロボット（ｉｎｄｕｓｔｒｉａｌ ｒｏｂｏｔ）であった。
【０００４】
アーム式ロボットのように、ある特定の場所に植設して用いるような据置きタイプのロボットは、部品の組立・選別作業など固定的・局所的な作業空間でのみ活動する。これに対し、移動式のロボットは、作業空間は非限定的であり、所定の経路上または無経路上を自在に移動して、所定の若しくは任意の人的作業を代行したり、ヒトやイヌあるいはその他の生命体に置き換わる種々の幅広いサービスを提供したりすることができる。なかでも脚式の移動ロボットは、クローラ式やタイヤ式のロボットに比し不安定で姿勢制御や歩行制御が難しくなるが、階段や梯子の昇降や障害物の乗り越えや、整地・不整地の区別を問わない柔軟な歩行・走行動作を実現できるという点で優れている。
【０００５】
最近では、イヌやネコのように４足歩行の動物の身体メカニズムやその動作を模したペット型のロボット、あるいは、ヒトのような２足直立歩行を行う動物の身体メカニズムや動作をモデルにしてデザインされた「人間形」若しくは「人間型」と呼ばれるロボット（ｈｕｍａｎｏｉｄ ｒｏｂｏｔ）など、脚式移動ロボットに関する研究開発が進展し、実用化への期待も高まってきている。
【０００６】
ここで、直立歩行型の脚式移動ロボットの場合、歩行などの機体運動を考慮した場合における基準となる姿勢は、２足で立ち上がった立ち姿勢である。例えば、立ち姿勢の中では最も安定した状態（すなわち不安定性の極小点）を基本立ち姿勢にすることができる。
【０００７】
基本立ち姿勢は、その姿勢を安定に維持するためには、姿勢安定制御の実行、制御指示による脚部などの関節軸モータのトルク生成が必要である。無電源状態では立ち姿勢は決して安定ではないことから、ロボットは、仰向けやうつ伏せなどの物理的に最も安定した床上姿勢から起動を開始することが好ましいと思料される。しかしながら、これら床上姿勢のロボットの電源を投入しても、ロボットが自律的に起き上がることができなければ、オペレータが手を貸して機体を持ち上げるなどの作業を施してあげなければならず、煩わしい。
【０００８】
また、ロボットが一旦立ち姿勢となり、歩行やその他の自律的な脚式作業を行なう場合、基本的には転倒することなく、脚を使って移動するように最大限に努力するが、敢え無く転倒してしまうこともある。さまざまな障害物や不測の事態を包含する人間の住環境下でロボットが動作する上で、「転倒」は不可避である。そもそも人間自体が転倒する。このような場合も、オペレータが手を貸して機体を持ち上げなければならないのでは、やはり煩わしい。
【０００９】
ロボットが床上姿勢になる度に、ロボットが自分で起き上がることができなければ、結局のところ無人環境でロボットが作業できない、すなわち作業に自己完結性がないということになり、完全に自立化された環境に置くことはできない。
【００１０】
また、多軸駆動系の機械装置は、一般に、多数の関節自由度を備え、関節の動きをアクチュエータ・モータで実現する。この場合、各モータの回転位置、回転量などを取り出して、サーボ制御により、所望の動作パターンを再現するとともに、姿勢制御を行なうことができる。運動制御理論から見た関節各部位は、高ゲインＰＤ制御で各軸リンクが制御され、それらが一定の特性のまま動作するのが一般的である。
【００１１】
しかしながら、人間の動作研究の結果からも分かるように、安定且つ高効率な動作を実現するには局所的に力を増減させることや関節各部位のコンプライアンス（機械的受動性）を増減させることが重要である。
【００１２】
位置制御系として関節各軸の動作を捉えたときは高ゲイン且つ高帯域なサーボ制御器を使って、制御偏差が少なくなるように制御した方がよいが、力学モデルとして捉えたときはポテンシャル・エネルギーや運動エネルギの作用を考慮してゲインを低くしたり位相補償している周波数帯を上下させたりすることも同時に行なうとよい。
【００１３】
ところが、ロボットの機体上でそのような制御を実現するにはアクチュエータそのものの特性と、アクチュエータの制御器の特性の２つを動的・静的に制御する機能が必要になる。
【００１４】
例えば、既知乃至未知の歩行路面でも安定して歩行することができる脚式移動ロボットの歩行制御装置に関する提案がなされている。すなわち、２足歩行の脚式移動ロボットで上体に腕を備えた人体類似の構造を有するものにおいて、歩行路面で摩擦力が低下して安定性が低下したとき、状態を駆動して安定性を確保ないし回復する（例えば、特許文献１を参照のこと）。しかしながら、これはフィード・フォワード・ゲインを制御することによって実現するものであり、関節の粘性や周波数特性に対する言及はなく、また、コンプライアンスの有無といった概念もない。
【００１５】
【特許文献１】
特開平７−２０５０６９号公報
【００１６】
【発明が解決しようとする課題】
本発明の目的は、仰向けやうつ伏せなどの床上姿勢から自律的に立ち姿勢を回復することができる、優れた脚式移動ロボットを提供することにある。
【００１７】
本発明のさらなる目的は、うつ伏せ又は仰向けの姿勢からの起き上がり動作を始めとしてさまざまな動作の実行時においてアクチュエータそのものの特性とアクチュエータの制御器の特性の２つを動的又は静的に制御することにより安定且つ高効率な動作を実現することができる、優れた脚式移動ロボットを提供することにある。
【００１８】
【課題を解決するための手段及び作用】
本発明は、上記課題を参酌してなされたものであり、複数の可動脚を含む複数の関節部位で構成される脚式移動ロボットであって、
各関節部位におけるアクチュエータのサーボ制御器のゲイン及び位相補償制御とアクチュエータ・モータの粘性抵抗の制御とを組み合わせて行なうアクチュエータ特性制御手段と、
機体の寝姿勢からの起き上がり動作を制御する起き上がり動作制御手段とを備え、
前記アクチュエータ特性制御手段は、起き上がり動作の各段階毎に、各関節部位のアクチュエータを、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性と、低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくする第２のアクチュエータ特性との間で切り替える、
ことを特徴とする脚式移動ロボットである。
【００１９】
本発明によれば、脚式移動ロボットの各関節部位を構成するアクチュエータのサーボ制御器において、比例ゲインと位相補償要素を調整することにより、ロボットの関節各部位において必要な位置決め精度、機械的受動性（コンプライアンス）、動作速度を任意に設定することができる。
【００２０】
また、アクチュエータ・モータのコイルへの非通電時においてコイルを間歇的に短絡状態又はオープン状態に切り替えることによって、モータの粘性抵抗を調整し振動などの外乱に対するロバスト性を変更することができる。
【００２１】
さらに、これらアクチュエータのサーボ制御器におけるゲイン及び位相補償制御とアクチュエータ・モータの粘性抵抗の制御とを組み合わせることによって、位置決め精度が重要な部分に適用することができるアクチュエータの周波数特性、あるいは即応性とコンプライアンスが重要となる部分に適用することができるアクチュエータの周波数特性を得ることができる。
【００２２】
そして、前記アクチュエータ特性制御手段は、アクチュエータの特性を「低域ゲインを大きく」、「高い周波数領域で位相進み量を小さく」、「関節の粘性抵抗を大きく」する設定を行なうことで、高精度な位置決め制御が可能となり、姿勢の安定性が増す。
【００２３】
また、前記アクチュエータ特性制御手段は、アクチュエータの特性を「低域ゲインを小さく」、「位相進み量を大きく」、「関節の粘性抵抗を小さく」する設定を行なうことで、機械的受動性と速い応答性を持たせることができるので、着床の瞬間の衝撃力を緩和しつつ高い帯域の追従制御を行なうことができる。
【００２４】
ここで、前記脚式移動ロボットの機体は略平行な関節自由度を持つ複数の関節軸を長さ方向に連結したリンク構造体で構成される。前記リンク構造体は、少なくとも肩関節ピッチ軸、体幹ピッチ軸、股関節ピッチ軸、膝ピッチ軸が機体の高さ方向に連結されてなる。勿論、脚式移動ロボットの機体は、これら以外の関節ピッチ軸を備えていてもよいし、また、各関節部位において、ピッチ軸以外のロール軸並びにヨー軸回りの回転自由度を備えていてもよい。
【００２５】
また、前記起き上がり動作制御手段は、
機体の重心となる重心リンクを含む２以上のリンクが接床した床上姿勢において、接床リンクが形成する接地多角形内において最も少ないリンク数で形成される最も狭い支持多角形を探索する手段と、
接地多角形中の前記探索された支持多角形以外の接床リンクを離床させる手段と、
２以上の連続する離床リンクを屈曲させ、そのリンク端の端部を接床させて、より狭い接地多角形を形成する手段と、
支持多角形が充分狭くなったことに応答して、前記リンク構造体の一端側から第１の所定数以上のリンクを離床して機体を直立させる手段と、
で構成することができる。ここで、床面と接床する複数の機体の端部が形成する多角形のことを接地多角形という。また、ＺＭＰが存在する接地多角形のことを支持多角形という。ＺＭＰの安定領域は、支持多角形内においてロボットの姿勢などを安定に制御可能な領域である。
【００２６】
脚式移動ロボットは、仰向け又はうつ伏せなどの基本的な床上姿勢においては、これら関節ピッチ軸、体幹ピッチ軸、股関節ピッチ軸、膝ピッチ軸を連結するすべてのリンクは接床している。また、基本的な立ち姿勢や歩行姿勢においては、これら関節ピッチ軸、体幹ピッチ軸、股関節ピッチ軸、膝ピッチ軸を連結するすべてのリンクは離床し、略鉛直方向に整列している。
【００２７】
床上姿勢から立ち姿勢に移行する起き上がりの際には、通常の立ち姿勢を維持したり歩行動作を行なう場合に比し、関係する関節アクチュエータには高いトルク出力が必要とされる。このため、ＺＭＰ支持多角形が最小となる姿勢を利用して起き上がり動作を行なうことによって、より少ない駆動トルクで起き上がり動作を実現する。
【００２８】
まず、ほとんどすべてのリンクが接床している床上姿勢において、接床リンクが形成する接地多角形内で、最も狭い支持多角形を探索する。このとき、機体の一端側から少なくとも２以上のリンクを離床させたときの、ＺＭＰが計画可能かどうかを判定する。例えば、体幹ピッチ軸及び股関節ピッチ軸を連結するリンクを重心リンクとして接床状態に保ったままで、より狭い支持多角形を探索する。そして、肩関節ピッチ軸を含む一端側から連続する２以上のリンクを離床させることを試みる。
【００２９】
次いで、支持多角形となる接床リンクを残し、接地多角形の一端側から２以上の連続するリンクを離床する。そして、一端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する。例えば、リンク構造体の一端側から肩関節を含む２以上のリンクを支持多角形に関与しないリンクとして離床する。そして、肩関節を含む２以上のリンクが離床している状態で、肩関節ピッチ軸で屈曲させて、そのリンク端の端部である手先を接床させる。そして、手先を機体重心位置である体幹ピッチ軸側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成する。
【００３０】
さらに、この接地多角形において、最も狭い支持多角形を探索する。今度は他端から少なくとも２以上のリンクを離床させて、ＺＭＰが計画可能かどうかを判定する。例えば、体幹ピッチ軸及び股関節ピッチ軸を連結する重心リンクを接床状態に保ったままで、膝関節ピッチ軸を含む他端側から連続する２以上のリンクを離床させることを試みる。
【００３１】
次いで、支持多角形となる接床リンクを残し、接地多角形の他端側から２以上の連続するリンクを離床する。そして、他端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する。例えば、膝関節を含む２以上のリンクが離床している状態で、膝関節ピッチ軸で屈曲させて、そのリンク端の端部である足底を接床させる。そして、足底を機体重心位置である股関節ピッチ軸側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成する。
【００３２】
次いで、接地多角形の両リンク端の端部を接床した状態で前記重心リンクを離床可能か否かによって、支持多角形が充分狭くなったか否かを判断する。例えば、接地多角形の両リンク端の端部としての手先及び足底を接床した状態で、体幹ピッチ軸及び股関節ピッチ軸を連結した前記重心リンクを離床可能か否かによって支持多角形が充分狭くなったか否かを判断する。
【００３３】
そして、機体の支持多角形が充分に狭くなったことに応答して、支持多角形の両リンク端の端部を接床した状態で前記重心リンクを離床し、両リンク端の着床リンクによって形成される支持多角形内にＺＭＰを維持しながら、支持多角形の両リンク端の端部の間隔を縮めて、ＺＭＰを前記リンク構造体の他端側に移動させる。例えば、接地多角形の両リンク端の端部としての手先及び足底を接床した状態で体幹ピッチ軸及び股関節ピッチ軸を連結した前記重心リンクを離床し、手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かってに移動させていく。
【００３４】
そして、前記リンク構造体の他端から第２の所定数以下の接床リンクのみで形成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま前記リンク構造体の一端側から第１の所定数以上のリンクを離床して、該離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる。例えば、前記足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、前記肩ピッチ軸から前記膝ピッチ軸に至までのリンクを離床して、該離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させることができる。
【００３５】
また、前記アクチュエータ特性制御手段は、機体の起き上がり動作の各段階において、最も狭い支持多角形の探索に関与する接床リンクの各関節部位のアクチュエータの特性を、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に設定するようにしてもよい。
【００３６】
このように該当する関節部位のアクチュエータを低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めを可能にし、支持多角形の大きさの精度を確保することができる。
【００３７】
また、前記アクチュエータ特性制御手段は、機体の起き上がり動作の各段階において、支持多角形に関与しない離床リンクの各関節部位のアクチュエータの特性を、より狭い接地多角形を形成するために接床するまでの期間中、低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくした第２のアクチュエータ特性から、接床後は低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に切り替えるようにしてもよい。
【００３８】
このように該当する関節部位に機械的受動性（コンプライアンス）と速応性を与えることにより、起き上がりのためにより狭い接地多角形を逐次形成していく動作の過程で、腕や脚の動作や着床動作が円滑になるとともにエネルギ消費を少なくすることができる。
【００３９】
また、前記アクチュエータ特性制御手段は、支持多角形が充分狭くなったことに応答して機体を直立させる動作に関わる各関節部位のアクチュエータの特性を、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に設定するようにしてもよい。
【００４０】
このように該当する関節部位のアクチュエータを低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めを可能にし、直立姿勢に復帰したときの姿勢安定制御を実現することができる。
【００４１】
本発明のさらに他の目的、特徴や利点は、後述する本発明の実施形態や添付する図面に基づくより詳細な説明によって明らかになるであろう。
【００４２】
【発明の実施の形態】
以下、図面を参照しながら本発明の実施形態について詳解する。
【００４３】
Ａ．脚式移動ロボットの機械的構成
図１及び図２には本発明の実施に供される「人間形」又は「人間型」の脚式移動ロボットが直立している様子を前方及び後方の各々から眺望した様子を示している。図示の通り、脚式移動ロボットは、胴体部と、頭部と、左右の上肢部と、脚式移動を行う左右２足の下肢部とで構成され、例えば胴体に内蔵されている制御部（図示しない）により機体の動作を統括的にコントロールするようになっている。
【００４４】
左右各々の下肢は、大腿部と、膝関節と、脛部と、足首と、足平とで構成され、股関節によって体幹部の略最下端にて連結されている。また、左右各々の上肢は、上腕と、肘関節と、前腕とで構成され、肩関節によって体幹部の上方の左右各側縁にて連結されている。また、頭部は、首関節によって体幹部の略最上端中央に連結されている。
【００４５】
制御部は、この脚式移動ロボットを構成する各関節アクチュエータの駆動制御や各センサ（後述）などからの外部入力を処理するコントローラ（主制御部）や、電源回路その他の周辺機器類を搭載した筐体である。制御部は、その他、遠隔操作用の通信インターフェースや通信装置を含んでいてもよい。
【００４６】
このように構成された脚式移動ロボットは、制御部による全身協調的な動作制御により、２足歩行を実現することができる。かかる２足歩行は、一般に、以下に示す各動作期間に分割される歩行周期を繰り返すことによって行われる。すなわち、
（１）右脚を持ち上げた、左脚による単脚支持期
（２）右足が接地した両脚支持期
（３）左脚を持ち上げた、右脚による単脚支持期
（４）左足が接地した両脚支持期
【００４７】
脚式移動ロボットにおける歩行制御は、あらかじめ下肢の目標軌道を計画し、上記の各期間において計画軌道の修正を行なうことによって実現される。すなわち、両脚支持期では、下肢軌道の修正を停止して、計画軌道に対する総修正量を用いて腰の高さを一定値で修正する。また、単脚支持期では、修正を受けた脚の足首と腰との相対位置関係を計画軌道に復帰させるように修正軌道を生成する。
【００４８】
歩行動作の軌道修正を始めとして、機体の姿勢安定制御には、一般に、ＺＭＰに対する偏差を小さくするための位置、速度、及び加速度が連続となるように、５次多項式を用いた補間計算により行なう。ＺＭＰ（Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔ）を歩行の安定度判別の規範として用いている。ＺＭＰによる安定度判別規範は、歩行系から路面には重力と慣性力、並びにこれらのモーメントが路面から歩行系への反作用としての床反力並びに床反力モーメントとバランスするという「ダランベールの原理」に基づく。力学的推論の帰結として、足底接地点と路面の形成する支持多角形（すなわちＺＭＰ安定領域）の辺上あるいはその内側にピッチ軸及びロール軸モーメントがゼロとなる点、すなわち「ＺＭＰ（Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔ）」が存在する。
【００４９】
図３には、この脚式移動ロボットが具備する関節自由度構成を模式的に示している。同図に示すように、脚式移動ロボットは、２本の腕部と頭部１を含む上肢と、移動動作を実現する２本の脚部からなる下肢と、上肢と下肢とを連結する体幹部とで構成された、複数の肢を備えた構造体である。
【００５０】
頭部を支持する首関節（Ｎｅｃｋ）は、首関節ヨー軸１と、第１及び第２の首関節ピッチ軸２Ａ及び２Ｂと、首関節ロール軸３という４自由度を有している。
【００５１】
また、各腕部は、その自由度として、肩（Ｓｈｏｕｌｄｅｒ）における肩関節ピッチ軸４と、肩関節ロール軸５と、上腕ヨー軸６、肘（Ｅｌｂｏｗ）における肘関節ピッチ軸７と、手首（Ｗｒｉｓｔ）における手首関節ヨー軸８と、手部とで構成される。手部は、実際には、複数本の指を含む多関節・多自由度構造体である。
【００５２】
また、体幹部（Ｔｒｕｎｋ）は、体幹ピッチ軸９と、体幹ロール軸１０という２自由度を有する。
【００５３】
また、下肢を構成する各々の脚部は、股関節（Ｈｉｐ）における股関節ヨー軸１１と、股関節ピッチ軸１２と、股関節ロール軸１３と、膝（Ｋｎｅｅ）における膝関節ピッチ軸１４と、足首（Ａｎｋｌｅ）における足首関節ピッチ軸１５と、足首関節ロール軸１６と、足部とで構成される。
【００５４】
Ｂ．脚式移動ロボットの制御システム構成
図４には、脚式移動ロボット１００の制御システム構成を模式的に示している。同図に示すように、脚式移動ロボット１００は、ヒトの四肢を表現した各機構ユニット３０，４０，５０Ｒ／Ｌ，６０Ｒ／Ｌと、各機構ユニット間の協調動作を実現するための適応制御を行う制御ユニット８０とで構成される（但し、Ｒ及びＬの各々は、右及び左の各々を示す接尾辞である。以下同様）。
【００５５】
脚式移動ロボット１００全体の動作は、制御ユニット８０によって統括的に制御される。制御ユニット８０は、ＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）やメモリ等の主要回路コンポーネント（図示しない）で構成される主制御部８１と、電源回路やロボット１００の各構成要素とのデータやコマンドの授受を行うインターフェース（いずれも図示しない）などを含んだ周辺回路８２とで構成される。
【００５６】
本発明を実現する上で、この制御ユニット８０の設置場所は特に限定されない。図４では体幹部ユニット４０に搭載されているが、頭部ユニット３０に搭載してもよい。あるいは、脚式移動ロボット１００外に制御ユニット８０を配備して、脚式移動ロボット１００の機体とは有線若しくは無線で交信するようにしてもよい。
【００５７】
図３に示した脚式移動ロボット１００内の各関節自由度は、それぞれに対応するアクチュエータによって実現される。すなわち、頭部ユニット３０には、首関節ヨー軸１、第１及び第２の首関節ピッチ軸２Ａ及び２Ｂ、首関節ロール軸３の各々を表現する首関節ヨー軸アクチュエータＡ１、第１及び第２の首関節ピッチ軸アクチュエータＡ２Ａ、Ａ２Ｂ、首関節ロール軸アクチュエータＡ３がそれぞれ配設されている。
【００５８】
また、体幹部ユニット４０には、体幹ピッチ軸９、体幹ロール軸１０の各々を表現する体幹ピッチ軸アクチュエータＡ９、体幹ロール軸アクチュエータＡ１０が配備されている。
【００５９】
また、腕部ユニット５０Ｒ／Ｌは、上腕ユニット５１Ｒ／Ｌと、肘関節ユニット５２Ｒ／Ｌと、前腕ユニット５３Ｒ／Ｌに細分化されるが、肩関節ピッチ軸４、肩関節ロール軸５、上腕ヨー軸６、肘関節ピッチ軸７、手首関節ヨー軸８の各々を表現する肩関節ピッチ軸アクチュエータＡ４、肩関節ロール軸アクチュエータＡ５、上腕ヨー軸アクチュエータＡ６、肘関節ピッチ軸アクチュエータＡ７、手首関節ヨー軸アクチュエータＡ８が配設されている。
【００６０】
また、脚部ユニット６０Ｒ／Ｌは、大腿部ユニット６１Ｒ／Ｌと、膝ユニット６２Ｒ／Ｌと、脛部ユニット６３Ｒ／Ｌに細分化されるが、股関節ヨー軸１１、股関節ピッチ軸１２、股関節ロール軸１３、膝関節ピッチ軸１４、足首関節ピッチ軸１５、足首関節ロール軸１６の各々を表現する股関節ヨー軸アクチュエータＡ１１、股関節ピッチ軸アクチュエータＡ１２、股関節ロール軸アクチュエータＡ１３、膝関節ピッチ軸アクチュエータＡ１４、足首関節ピッチ軸アクチュエータＡ１５、足首関節ロール軸アクチュエータＡ１６が配設されている。
【００６１】
各関節に用いられるアクチュエータＡ１，Ａ２，Ａ３…は、より好ましくは、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニット内に搭載したタイプの小型ＡＣサーボ・アクチュエータで構成することができる。
【００６２】
頭部ユニット３０、体幹部ユニット４０、腕部ユニット５０、各脚部ユニット６０などの各機構ユニット毎に、アクチュエータ駆動制御用の副制御部３５，４５，５５，６５が配設されている。
【００６３】
機体の体幹部４０には、加速度センサ９５と姿勢センサ９６が配設されている。加速度センサ９５は、Ｘ，Ｙ，Ｚ各軸方向に配置する。機体の腰部に加速度センサ９５を配設することによって、質量操作量が大きな部位である腰部を制御目標点として設定して、その位置における姿勢や加速度を直接計測して、ＺＭＰに基づく姿勢安定制御を行なうことができる。
【００６４】
また、各脚部６０Ｒ，Ｌには、接地確認センサ９１及び９２と、加速度センサ９３，９４がそれぞれ配設されている。接地確認センサ９１及び９２は、例えば足底に圧力センサを装着することにより構成され、床反力の有無により足底が着床したか否かを検出することができる。また、加速度センサ９３，９４は、少なくともＸ及びＹの各軸方向に配置する。左右の足部に加速度センサ９３，９４を配設することにより、ＺＭＰ位置に最も近い足部で直接ＺＭＰ方程式を組み立てることができる。
【００６５】
主制御部８０は、各センサ９１〜９６の出力に応答して制御目標をダイナミックに補正することができる。より具体的には、副制御部３５，４５，５５，６５の各々に対して適応的な制御を行ない、脚式移動ロボット１００の上肢、体幹、及び下肢が協調して駆動する全身運動パターンを実現する。
【００６６】
ロボット１００の機体上での全身運動は、足部運動、ＺＭＰ（Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔ）軌道、体幹運動、上肢運動、腰部高さなどを設定するとともに、これらの設定内容に従った動作を指示するコマンドを各副制御部３５，４５，５５，６５に転送する。そして、各々の副制御部３５，４５…では、主制御部８１からの受信コマンドを解釈して、各アクチュエータＡ１，Ａ２，Ａ３…に対して駆動制御信号を出力する。ここで言う「ＺＭＰ」とは、歩行中の床反力によるモーメントがゼロとなる床面上の点のことであり、また、「ＺＭＰ軌道」とは、例えばロボット１００の歩行動作期間中にＺＭＰが動く軌跡を意味する。
【００６７】
Ｃ．アクチュエータ特性の制御
Ｃ−１．アクチュエータの動作速度、機械的受動性
本出願人に既に譲渡されている特願２００１−２３３６９１号明細書には、外界や作業対象に対して、閉リンク状態と開リンク状態の繰り替え動作を高速に行なう脚式移動ロボットについて開示されている。すなわち、１以上の回転型関節（１関節当り２自由度以上備えていてもよい）で構成される肢を持つロボットにおいて、各肢に動的閉合誤差を除去するに最低限必要な受動自由度（減速機のバックラッシュなど）を配し、さらに各肢の可動範囲を適切に管理する。たとえ、関節部を駆動するアクチュエータがトルク情報を取得する手段を持たない場合であっても、閉リンク状態と開リンク状態の高速切替え動作を安定に実現する。
【００６８】
これは、２足歩行ロボットにおいて、腰部基準座標に近い部位にバックラッシュ量が少ないギアードモータを配置、手先・足先に近い部位にバックラッシュ量が多いギアードモータを配置し最適な特性を得るというものである。そして、ロボットを最適化する第２の方法として、各関節軸アクチュエータにおける位置サーボ補償器の開ループ・ゲインを任意に調整することで、位置エラー偏差量を制御する。すなわち、バックラッシュ量が均一の場合にはサーボゲインの大小によるサーボ偏差をバックラッシュ量に見立て、それを制御する。
【００６９】
本実施形態では、このような脚式移動ロボットの最適化方法をさらに拡張し、サーボ制御器の比例ゲインだけでなく位相補償要素も関節各部位で調整する。
【００７０】
図５には、アクチュエータのサーボ制御器の構成を示している。同図に示すように、サーボ制御器は、直列補償の比例ゲインＫと位相補償要素Ｃ（ｓ）という２つの制御要素を持ち、比例ゲインだけでなく位相補償要素も関節各部位で調整する。また、図６には、図５に示したモータと減速機の伝達関数表現モデルのゲイン及び位相の周波数特性を示している。
【００７１】
ここで、位相補償要素は以下の式で表される。但し、ｎ、ｍは任意の自然数であり、また、ａｉ、ｂｉは任意の実数であり、状態変数を表現した場合はフィードバック・ゲインに相当する。また、ｓはラプラス演算子である。
【００７２】
【数１】
【００７３】
また、モータと減速器の伝達関数表現モデルＧ（ｓ）は以下の式で表される。但し、Ｋはモータ・ゲインであり、Ｊはモータの慣性モーメントであり、Ｄはモータの粘性抵抗係数である。
【００７４】
【数２】
【００７５】
まず、図５に示したサーボ制御器において、位相補償型制御の設計例として位相補償帯域を任意に選択する例（位相補償量が一定で周波数帯域を任意に選ぶ）について、図７を参照しながら説明する。同図において、
【００７６】
▲１▼Ｃ（ｓ）−１：１．０〜１００Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与えている。
▲２▼Ｃ（ｓ）−２：０．１〜１０Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与えている。
▲３▼Ｃ（ｓ）−３：１０〜１ｋＨｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与えている。
【００７７】
このように、位相補償を施す周波数帯域を任意に選択することで、アクチュエータの周波数特性を自在に設定することができる。したがって、このようなアクチュエータで構成されるロボットの関節軸は、機体の姿勢や動作の局面に応じて、周波数特性を動的に調整することができる。
【００７８】
なお、図７に示す例では、位相進み補償の例を示したが、位相遅れ補償場合も同様に任意の周波数帯域で任意の位相遅れ量を設定することができる。
【００７９】
次いで、図５に示したサーボ制御器において、位相補償型制御の設計例として位相補償を施す量を任意に選択する例（周波数帯域が一定で位相補償量を任意に選ぶ）について、図８を参照しながら説明する。同図において、
【００８０】
▲４▼Ｃ（ｓ）−４：４．０〜７０Ｈｚの帯域で約＋３．５ｄＢのゲイン増幅、約＋１２ｄｅｇの位相進みを与えている。
▲５▼Ｃ（ｓ）−５：２．０〜７０Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与えている。
▲６▼Ｃ（ｓ）−６：１．０〜７０Ｈｚの帯域で約＋６．５ｄＢのゲイン増幅、約＋２１ｄｅｇの位相進みを与えている。
【００８１】
このように、位相補償を施す量を任意に選択することで、アクチュエータの周波数特性を自在に設定することができる。したがって、このようなアクチュエータで構成されるロボットの関節軸は、機体の姿勢や動作の局面に応じて、周波数特性を動的に調整することができる。
【００８２】
なお、図８に示す例では、位相進み補償の例を示したが、位相遅れ補償の場合も同様に任意の周波数帯域で任意の位相遅れ量を設定することができる。
【００８３】
次いで、図５に示したサーボ制御器において、Ｋで示した直列補償ゲインの大小を変更する制御器の設計例について、図９を参照しながら説明する。同図は、図９において、Ｋを±３ｄＢだけ上下させたことに相当する。図示の通り、直列補償ゲインの大小も任意に設定することができる。
【００８４】
図７〜図９に示した内容をロボットの関節軸駆動用のアクチュエータに適用するためには、これらの制御器を構成するパラメータを動的又は静的に変更するための通信プロトコルを実装する。これによって、ロボットの各関節軸にさまざまな特性を与えることができる。
【００８５】
次いで、これらの特性を備えたアクチュエータのサーボ制御器を実装したときのアクチュエータの特性について説明する。
【００８６】
図１０には、図７に示したように位相補償量が一定で周波数帯域を任意に選ぶようにアクチュエータのサーボ制御器を実装したときの開ループ特性を示している。
【００８７】
▲１▼Ｃ（ｓ）−１：１．０〜１００Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与える
→ 全体的にゲインが高めとなるので、位置決め精度と追従性がよくなるが、エネルギーロスとなり易い。また、負荷が大きくなると不安定になる可能性がある。
▲２▼Ｃ（ｓ）−２：０．１〜１０Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与える
→ Ｃ（ｓ）−１とＣ（ｓ）−２の中間的な特性を持つ。
▲３▼Ｃ（ｓ）−３：１０〜１ｋＨｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与える
→ 高域でのみ位相進み補償をしていることになるので、ゆっくりした動作時にはあまり効果が見られないが、走る、飛ぶ、踊るといった速い動作には効果がある。
【００８８】
このように、位相補償を施す周波数帯域を任意に選択することで、アクチュエータの周波数特性を自在に設定することができる。したがって、このようなアクチュエータで構成されるロボットの関節軸は、機体の姿勢や動作の局面に応じて、周波数特性を動的に調整することができる。
【００８９】
また、図１１には、図１０に示したうち高域でのみ位相進み補償を施した例Ｃ（ｓ）−３においてさらに直列補償ゲインの制御を採り入れた様子を示している。この場合、図５に示した例と同様に、同位相においてゲインが上下する。
【００９０】
図１０に示した例では、位相補償例Ｃ（ｓ）−３ではゆっくりした動作時にはあまり効果が見られないが、図１１に示すように、低周波数帯域においてゲインを増やすことにより、低周波数帯域での制御偏差を少なくすることができる。この結果、ゆっくりした動作時でも指令値に対して少ない遅れで応答することが可能となる。
【００９１】
以上、アクチュエータのサーボ制御器においてサーボ制御器の比例ゲインだけでなく位相補償要素も関節各部位で調整するメカニズムについて説明してきた。これによって、安定且つ高効率な動作を実現するには局所的に力を増減させることや関節各部位のコンプライアンス（機械的受動性）を増減させることが可能となる。
【００９２】
例えば、位置制御系として関節各軸の動作を捉えたときは高ゲイン且つ高帯域なサーボ制御器を使って、制御偏差が少なくなるように制御した方がよいが、力学モデルとして捉えたときはポテンシャル・エネルギーや運動エネルギの作用を考慮してゲインを低くしたり位相補償している周波数帯を上下させたりすることも同時に行なうとよい。
【００９３】
Ｃ−２．アクチュエータ・モータの粘性抵抗
上記のＣ−１項で説明したようなアクチュエータの動作速度や動作時の機械的受動性という特性に加え、アクチュエータの粘性抵抗を可変に制御するという方式を採り入れることができる。
【００９４】
例えば、コイルへの供給電流を制御して所定の磁束分布を形成することにより回転トルクを発生させるタイプのモータは、一般に、コイル端子を電源電圧に接続する第１のトランジスタ・スイッチ群と、コイル端子を接地する第２のトランジスタ・スイッチ群からなるスイッチング動作回路をＰＷＭ制御により駆動することによって、コイル電流を制御し、所望のトルク又は回転位置、回転速度などを得るようになっている。
【００９５】
ここで、モータ・コイルが非通電の期間においてオープン状態となるタイミングにおいて、モータ・コイルに通電された電流（厳密には電荷）が抜けてしまうため、トルクのロスになる。またコギングによるトルクむらの影響を受け易くなる。
【００９６】
このような場合、モータ・コイルが非通電の期間においても、コイルがオープン状態とならない短絡（ショート）状態を形成することにより、モータ・コイルに通電された電流（厳密には電荷）が抜けないようにすることができる。このとき、モータのコイルには、永久磁石側からの磁束密度により逆起電力が発生する。この逆起電力により、モータの回転方向の逆方向に力が作用するので、外力による回転に対する粘性抵抗を作り出すことができ、ブレーキに類似した効果を得ることができる。このようなモータへの粘性抵抗により、トルク・ロスがなくコギングによるトルクむらの影響が軽減される。
【００９７】
一方、モータの非通電時において、このようなコイルの短絡状態を形成した場合、上述したように、モータに一種の粘性抵抗を与えることができるが、このようなモータをロボットに使用した場合、コイル・ショートによるブレーキの影響のため、コンプライアンス（機械的受動性）がなくなってしまうという問題を招来する。
【００９８】
そこで、モータ・コイルの非通電時におけるコイルのオープン状態と短絡状態の期間の比率を、所望の機械的特性に応じて調整することにより、モータ・コイルがオープン状態となるタイミングにおけるモータ・コイルに通電された電流（厳密には電荷）が抜けてしまうことによるトルクのロスやコギングによるトルクむらの問題と、モータ・コイルの非通電時におけるコイル・ショートによるブレーキの影響のためコンプライアンス（機械的受動性）がなくなるという問題を、ともに解決することができる。
【００９９】
ここで、モータ・コイルの通電及び非通電状態の比率はＰＷＭ制御により実現することができるが、モータ・コイルの非通電状態におけるコイルのオープン状態と短絡状態の期間の比率も同様にＰＷＭ制御を用いて実現することができる。
【０１００】
図１２には、コイル電流の制御メカニズムを適用したＤＣモータのコイル電流供給用の電流制御回路の等価回路の構成例を示している。
【０１０１】
同図に示す電流制御回路は、フルブリッジ構成であり、ｐｎｐ型のトランジスタＡ’とｎｐｎ型のトランジスタＡを順方向接続した回路と、同じくｐｎｐ型のトランジスタＢ’とｎｐｎ型のトランジスタＢを順方向接続した回路を電源電圧ＶｃｃとグランドＧＮＤの間に並列接続し、さらにトランジスタＡ’及びＡの中間点とトランジスタＢ’及びＢの中間点を固定子の単相コイルで接続している。
【０１０２】
トランジスタＡ’及びＢをオンにするとともに、トランジスタＡ及びＢ’をオフにすることによって、モータ・コイルには、図示の矢印方向の電流Ｉｍが流れる。また、トランジスタＡ’及びＢをオフにすることによって、コイルはオープン状態となって、電流Ｉｍは流れなくなる。また、トランジスタＡ’及びＢをオフにするとともに、トランジスタＡ’及びＢ’をオンにすることによって、モータ・コイルは短絡（ショート）状態となる。
【０１０３】
ＰＷＭ制御論理回路は、図示しない中央制御部からの電流軸電流指令（又はトルク指令）に基づいてコイルへの電流指令を生成し、これら電流指令に基づいて各トランジスタをＰＷＭ方式にてスイッチング制御する。すなわち、トランジスタＡ’及びＢをオンにするとともにトランジスタＡ及びＢ’をオフにしてコイル電流Ｉｍを流す通電期間と、トランジスタＡ’及びＢをオフにしてコイルを非通電にする非通電期間を交互に生成する。
【０１０４】
付加論理回路は、さらにＰＷＭ制御論理回路が出力する信号Ａ０及びＡ０’、並びＢ０及びＢ０’をオン／オフ動作を制御する制御論理を付加論理により切り替える。これによって、モータ・コイルの非通電状態におけるコイルのオープン状態と短絡状態の切替動作を行なう。図１３には、付加論理回路の具体的な回路構成を示している。
【０１０５】
ＰＷＭ制御論理回路からのトランジスタＡ’制御用の信号Ａ０’とトランジスタＢ０’制御用の信号Ｂ０’の論理積と、トランジスタＡ制御用の信号Ａ０とトランジスタＢ制御用の信号Ｂ０の排他的論理和がとられ、さらにこれらの論理演算値の論理積を反転したものがＢＲＡＫＥ＿ＰＷＭ制御信号の反転信号と論理和される。この論理和の結果を元の各トランジスタ制御用信号との間で論理積を取ったものが、最終的なそれぞれのトランジスタ制御用信号となる。
【０１０６】
付加論理回路は、ＢＲＡＫＥ＿ＰＷＭ制御信号がハイ・レベルが入力されると、コイル非通電時にコイルを短絡させるようにトランジスタ制御用信号を切り替える。通常のコイル非通電時において、ＰＷＭ制御論理回路からは、制御信号Ａ０’及びＡ０をハイ、Ｂ０’及びＢ０をローにするトランジスタ制御用信号が出力される。これに対し、付加論理回路は、ハイ・レベルのＢＲＡＫＥ＿ＰＷＭ制御信号が入力されると、ハイ状態のＡ１’及びＡ１をローに転じて、コイルの短絡状態を形成する。
【０１０７】
一方、付加論理回路は、ＢＲＡＫＥ＿ＰＷＭ制御信号がロー状態のときには、コイル非通電時において、ＰＷＭ制御論理回路からのトランジスタ制御用信号をそのまま出力するので、非通電時におけるコイルはオープン状態となる。
【０１０８】
図１４には、ＰＷＭ制御により所定のデューティ比を持つＢＲＡＫＥ＿ＰＷＭ制御信号が入力されたときの付加論理回路の各トランジスタ制御用信号の出力特性を、コイル電流波形特性及びトルク出力特性とともに示している。
【０１０９】
コイル非通電時にコイルを短絡状態にすると、過渡応答により、コイル電流がゼロに戻るまでの時間が長くなるが、コイルをオープン状態にするとその時間は短くなる。コイル非通電時の過渡応答特性は、ＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比に従って、これらの特性が混合されたものとなる。
【０１１０】
したがって、同図に示すように、コイル通電とコイル短絡というスイッチング動作を繰り返した場合、コイル非通電時にコイル電流がゼロに戻る前に次の通電が開始される。このときのコイルの最大電流は、コイル通電及び非通電の動作の度に逐次上昇していくが、その上昇傾向はデューティ比すなわちＢＲＡＫＥ＿ＰＷＭ制御信号がハイ・レベルとなる比率にほぼ比例する。同様に、コイル電流の実効値は図示の通り徐々に増加していくことになるが、その上昇傾向はデューティ比すなわちＢＲＡＫＥ＿ＰＷＭ制御信号がハイ・レベルとなる比率にほぼ比例する。
【０１１１】
また、モータの出力トルクＴは、コイル電流にモータのトルク定数Ｋｔを乗じた値となるので（Ｔ＝Ｋｔ・Ｉ）、同図からも判るように、コイル通電及び非通電を繰り返したとき、コイル電流の増大に伴って、モータ・トルクの実効値は増大していく。このときの上昇傾向はＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比すなわち同制御信号がハイ・レベルとなる比率にほぼ比例する。モータ・トルクの出力が上昇していく特性が、モータの粘性係数に相当する。言い換えれば、ＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比によってモータの粘性抵抗を動的に制御することが可能である。その制御の関係を図２３に示す。
【０１１２】
このようにＰＷＭ制御論理回路が付加論理回路へ供給するＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比をＰＷＭ制御することにより、モータ・コイルの非通電時におけるコイルのオープン状態と短絡状態の期間の比率を、所望の機械的特性に応じて調整することができる。
【０１１３】
したがって、モータ・コイルがオープン状態となるタイミングにおけるモータ・コイルに通電された電流（厳密には電荷）が抜けてしまうことによるトルクのロスやコギングによるトルクむらの問題と、モータ・コイルの非通電時におけるコイル・ショートによるブレーキの影響のためコンプライアンス（機械的受動性）がなくなるという問題を、ともに解決することができる。
【０１１４】
なお、上記の説明ではＤＣモータを例にとって説明したが、３相モータやその他のコイルへの供給電流を制御して所定の磁束分布を形成することにより回転トルクを発生させるタイプのモータにおいても同様に、非通電時のモータ・コイルを間歇的にオープン状態及び短絡状態に切り替えることによって、モータの所望の粘性抵抗を得ることができる。
【０１１５】
Ｃ−３．脚式移動ロボットへの適用
次いで、本実施形態に係るアクチュエータのサーボ制御器の特性制御並びにアクチュエータ自体の特性制御のメカニズムを各関節部位に適用した２足歩行の脚式移動ロボットについて説明する。
【０１１６】
上述したように、アクチュエータのサーボ制御器において、比例ゲインと位相補償要素を調整することにより、ロボットの関節各部位において必要な位置決め精度、機械的受動性（コンプライアンス）、動作速度を任意に設定することができる。また、アクチュエータ・モータのコイルへの非通電時においてコイルを間歇的に短絡状態又はオープン状態に切り替えることによって、モータの粘性抵抗を調整し振動などの外乱に対するロバスト性を変更することができる。
【０１１７】
さらに、これらアクチュエータのサーボ制御器におけるゲイン及び位相補償制御とアクチュエータ・モータの粘性抵抗の制御とを組み合わせることによって、位置決め精度が重要な部分に適用することができるアクチュエータの周波数特性、あるいは速応性とコンプライアンスが重要となる部分に適用することができるアクチュエータの周波数特性を得ることができる。
【０１１８】
図１５には、位置決め精度が重要な部分に適用することができるアクチュエータの周波数特性を示している。
【０１１９】
この場合、サーボ制御器の比例ゲインを大きくとって、系全体のゲインを大きくし、低周波数帯域までゲインを取れるようにする。また、周波数特性を同図に示すように高域で位相進み量が小さくなるようにし、速応性にはあまり寄与しないが安定性を保証できるようにする。また、モータの粘性抵抗を大きくし、振動などの外乱にもロバストになるようにする。要言すれば、図示の特性は、位置決め精度を優先して振動などの外乱にもロバストな特性である。
【０１２０】
また、図１６には、速応性とコンプライアンスが重要となる部分に適用することができるアクチュエータの周波数特性を示している。
【０１２１】
この場合、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。要言すれば、図示の特性は、機械的受動性（コンプライアンス）と速応性を優先した特性である。
【０１２２】
図１〜３に示した脚式移動ロボットの関節自由度は、上述したサーボ制御器を備えたアクチュエータによって実現される。各関節部位において使用されるアクチュエータのゲイン・位相補償特性の基本的な制御例について、以下に詳解する。
【０１２３】
（１）首部分に適用されるアクチュエータの特性
首部分では、位置決め精度を優先させるため、比例ゲインを高く設定する。また、動作速度を保持しつつ、比例ゲインを上げた分の安定性を損なわないように、位相進み量を少なく設定する。また、胴体より下の部分の動作時に発生する振動外乱に対してロバスト性を得るため、関節の粘性抵抗を大きく設定する。
【０１２４】
（２）肩・肘部分に適用されるアクチュエータの特性
歩行やダンスなどの連続動作を行なうときは、位置決め特性よりも機械的受動性が高くなるような特性をアクチュエータに与える。動作に受動性を持たせるため、関節の粘性抵抗を小さくする。また、動作に受動性を持たせるとともに、エネルギ消費量を減らすため、比例ゲインを低く設定する。また、動作速度を大きくするため、位相進み補償を行なう周波数帯域を高く、位相進み量を大きく設定する。動作によっては振り子のように往復運動を行なうだけのときもある。そのときは、関節の粘性抵抗と比例ゲインを最小にして機械的受動性（コンプライアンス）を得るようにし、力学的なエネルギを動作のために用い易くする。
【０１２５】
一方、物を押したり引っ張ったりするなどの力を使う動作を行なうときには、負荷トルク値により、位置決め精度優先の特性と、機械的受動性の特性を動的に入れ替えるように制御する。負荷トルク値に対してさらに力を発生させたいときは比例ゲインを高く、関節の粘性抵抗を大きくする。また、負荷トルク値に対して定負荷となるように倣わせる動作をする場合には、上位からの位置指令値による調整に加え、アクチュエータ内部トルク・センサで検知した負荷トルクに応じて比例ゲインを低く、関節の粘性抵抗を小さくして、機械的受動性（コンプライアンス）を得るようにする。
【０１２６】
（３）体幹部分に適用されるアクチュエータの特性
自分自身の動作による振動外乱にロバスト性を得るため、関節の粘性抵抗を大きくする。あるいは、位置決め精度を優先させるため、比例ゲインを高く設定する。あるいは、動作速度を保持しつつ比例ゲインを上げた分の安定性を損なわないように、位相進み量を少なく設定する。
【０１２７】
（４）股関節部分に適用されるアクチュエータの特性
自分自身の動作による振動外乱にロバスト性を得るため、関節の粘性抵抗を大きくする。あるいは、位置決め精度を優先させるため、比例ゲインを高く設定する。あるいは、動作速度を保持しつつ比例ゲインを上げた分の安定性を損なわないように、位相進み量を少なく設定する。
【０１２８】
（５）膝部分に適用されるアクチュエータの特性
遊脚時及び着床瞬間時においては、位置決め精度よりも機械的受動性が高くなるような特性に制御する。動作に受動性を持たせるため、関節の粘性抵抗を小さくする。また、動作に受動性を持たせるとともにエネルギ消費量を減らすため、比例ゲインを低く設定する。また、動作速度を大きくするため、位相進み補償を行なう周波数領域を高く、位相進み量を大きく設定する。
【０１２９】
一方、支持脚時においては、機械的受動性よりも位置決め精度が高くなるような特性に制御する。自分自身の動作による振動外乱にロバスト性を得るため、関節の粘性抵抗を大きくする。あるいは、位置決め精度を優先させるため、比例ゲインを高く設定する。あるいは、動作速度を保持しつつ比例ゲインを上げた分の安定性を損なわないように、位相進み量を少なく設定する。
【０１３０】
（６）足首部分に適用されるアクチュエータの特性
遊脚時及び着床瞬間時においては、位置決め精度よりも機械的受動性が高くなるような特性に制御する。足首部分着床による衝撃を緩和するため、関節粘性を小さく設定し、機械的受動性（コンプライアンス）を得るようにする。また、足首部分着床による衝撃を緩和するため、比例ゲインを低く設定し、機械的受動性（コンプライアンス）を得るようにする。また、動作速度を大きくとるため、位相補償を行なう周波数領域を高く、位相進み量を大きく設定する。
【０１３１】
一方、支持脚時において、足首部分の発生トルクを大きくとり、且つ自分自身の動作による振動外乱にロバスト性を得るため、関節の粘性抵抗を大きくとる。また、足首部分の位置決め精度を向上させるため、比例ゲインを高く設定する。また、動作速度を保持しつつ、比例ゲインを上げた分の安定性を損なわないように位相進み量を少なく設定する。
【０１３２】
ここで、ロボットの動作段階に応じて関節アクチュエータの特性を切り替えることによる効果を、歩行動作を例にとって説明する。
【０１３３】
図１７には、脚式移動ロボットが歩行動作を行なう様子を段階毎に示している。同図に示す例では、歩行動作はＡ〜Ｇの７段階に区分され、歩行動作を継続するときは、この順番で歩容を繰り返し実行するようになっている。
【０１３４】
（１）肩〜腕の部分
Ａ〜Ｇで示すロボットの歩行動作中では、ロボットの基準座標のヨー軸周りの回転モーメントを補償するために、腕を振る動作を行なう。この腕を振る動作は、肩ピッチ軸を中心にした周期的な振り子運動になる。
【０１３５】
このような場合、動作初期に与えたトルクによって腕を振り上げるので、位置エネルギを得る。この位置エネルギは、腕を振り下ろすときには、エネルギ保存則により運動エネルギとなる。つまり、動作初期に与えたトルクで発生する位置エネルギは、振り子が降りる原理に従って、運動エネルギに変換されるというエネルギ変換が繰り返される。
【０１３６】
このような性質を積極的に利用すると、ロボットが位置制御に追従するために発生するトルク（すなわち、エネルギ消費）に力学的エネルギを加えることができるので、ロボット全体のエネルギ消費を節約することができる。
【０１３７】
具体的には、腕部分の運動エネルギが最大になるときに腕の主要部分（例えば、肩ピッチ軸、肘ピッチ軸など）が瞬間的にトルクを発生する。このときに関節の粘性抵抗が大きいと、動作中の損失が大きくなるのでよろしくない。また、粘性抵抗が小さくても、動作中の損失はゼロにはならないので、その損失分を補充する意味でも、瞬間的にトルクを発生させる必要がある。
【０１３８】
これらを１サーボ制御で実現するには、開ループ特性で低周波数帯域のゲインが低く、且つ、高周波数帯域での位相補償量を大きくしてゲインが高くなっている系が適している。これに加えて、粘性抵抗の制御により、モータの粘性係数を実現可能な最小値に設定することで、動作中のエネルギ損失を少なくすることが好ましい。
【０１３９】
図１６に示すアクチュエータの周波数特性は、このようなサーボ制御及びモータの粘性抵抗制御を実現するものである。したがって、歩行動作中の腕の動作に関わる関節部位のアクチュエータは、同図に示す特性に設定すればよい。
【０１４０】
（２）脚の部分
Ａ〜Ｇで示すロボットの歩行動作中では、ＺＭＰ規範の姿勢制御に則って脚の歩容を生成する。この脚の動作は、両脚支持期と、片足が支持脚で他の片足が遊脚となる片足支持期の繰り返しとなる。
【０１４１】
支持脚又は遊脚に関わらず、ロール軸方向はＺＭＰ軌道に追従するため、一サーボ制御系の高い位置決め精度が要求される。これはつまり、開ループ特性において、全周波数帯域において高ゲインであることが求められる。
【０１４２】
支持脚の各関節のピッチ軸は、ＺＭＰ軌道に追従するため、高い位置決め精度が要求される。同時に、振動などの外乱に対してロバストであることが求められる。したがって、これら２つの要求を満たすためには、支持脚の各関節のピッチ軸は、図１５に示す、サーボ制御器の比例ゲインを大きくとって、系全体のゲインを大きくし、低周波数帯域までゲインを取れるような特性が適している。また、モータの粘性抵抗を大きく設定することが適している。
【０１４３】
一方、遊脚時の膝ピッチ軸や足首ピッチ軸は、腕部と同様に、負利上げと振り下ろしの動作を交互に行なう。したがって、関節の粘性抵抗が小さいことが好ましい。同時に、開ループ特性において、低周波数帯域で定ゲイン、こう周波数帯域で位相補償量を大きくして高ゲインとなる、図１６に示す特性が適している。
【０１４４】
また、着床瞬間の足首ピッチ軸関節は、高い周波数の衝撃外乱が加わる。このときには、高周波数帯域での応答性が確保されていることが望ましい。また、このときには、低周波数帯域でのゲインが低いことが望ましい。同時に、関節粘性抵抗が小さいことが望ましい。したがって、着床瞬間の足首ピッチ軸関節は、図１６に示す特性が適している。
【０１４５】
Ｄ．床上姿勢からの起き上がりオペレーション
仰向け姿勢やうつ伏せ姿勢などの床上姿勢からの起動を行なうため、あるいは、転倒時に自立的に起き上がって作業を再開するという作業の自己完結性のために、脚式移動ロボット１００は、起き上がりオペレーションを実現することが必要である。
【０１４６】
このとき、無計画的な軌道により起き上がろうとすると、過大な外力モーメントが印加され、関節アクチュエータが高出力トルクを必要とする。この結果、モータの大型化が必要となり、その分駆動消費電力が増大してしまう。また、機体の重量が増すとともに製造コストが高騰してしまう。重量の増大によりさらに起き上がり動作が困難になる。あるいは、起き上がり動作の過程で発生する外力モーメントにより姿勢の安定性を維持することができず、そもそも起き上がることができない、という事態もあり得る。
【０１４７】
そこで、本実施形態では、脚式移動ロボット１００は、外力モーメントが最小となる動作パターンよりなる起き上がり動作を行なうこととした。これは、ＺＭＰ支持多角形が最小となるような姿勢を時系列的に組み合わせることによって、実現することができる。
【０１４８】
また、本実施形態に係る脚式移動ロボット１００は、肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４のように（図３を参照のこと）、高さ方向に複数のピッチ軸が直列的（但し横方向から眺めた場合）に連結されたリンク構造体である。そこで、これら複数の関節ピッチ軸４〜１４を所定のシーケンスで同期協調的に駆動して、ＺＭＰ支持多角形が最小となるような動作パターンによる起き上がり動作を実現することとした。
【０１４９】
Ｄ−１．基本仰向け姿勢からの起き上がりオペレーション
図１８には、本実施形態に係る脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて起き上がり動作を行なうための処理手順をフローチャートの形式で示している。このような処理手順は、実際には主制御部８１において所定の機体動作制御プログラムを実行して、各部を駆動制御することによって実現される。
【０１５０】
また、図１９には、本実施形態に係る脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて仰向け姿勢から起き上がり動作を行なう様子を、関節リンク・モデルで示している。但し、図示のリンク構造体において、体幹関節と股関節を連結するリンクに機体全体の重心位置が設定されており、このリンクを以下では「重心リンク」と呼ぶことにする。尚、「重心リンク」は狭義には上記のような定義で用いるが、広義には機体全体の重心位置が存在するリンクであればよい。例えば、体幹軸を持たないような機体においては、機体全体の重心が位置する体幹先端などを含むリンクがこれに該当する。また、図２０には、実機が仰向け姿勢から起き上がっていく様子を示している。
【０１５１】
以下、図１８に示したフローチャートを参照しながら、基本仰向け姿勢からの機体の起き上がりオペレーションについて説明する。
【０１５２】
まず、床上姿勢において、位置エネルギの最も小さい姿勢を探索する（ステップＳ１）。これは、基本仰向け姿勢に相当し、図１９（１）及び図２０（Ａ）に示すように、起き上がり動作に使用する肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４をそれぞれ連結するリンクはすべて接床している。このとき、位置エネルギの最も小さい姿勢をとることにより、路面の傾斜や形状を計測して、起き上がり動作が可能かどうかを確認することができる。
【０１５３】
この基本仰向け姿勢において、接床リンクが形成する接地多角形内で、最も狭い支持多角形を探索する（ステップＳ２）。このとき、機体の一端側から少なくとも２以上のリンクを離床させたときの、ＺＭＰ軌道が計画可能かどうかを判定する。ＺＭＰの計画可能性は、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断することができる。
【０１５４】
次いで、接地多角形のうち、最も狭い支持多角形に関与しない２以上のリンクを離床する（ステップＳ３）。
【０１５５】
ステップＳ３は、図１９（２）に相当する。実機上では、体幹関節と股関節を連結する重心リンクを含む下半身側が支持多角形として抽出され、それ以外の肩関節から体幹関節に至る２以上のリンクを支持多角形に関与しないリンクとして離床する。まず、図２０（Ｂ）に示すように左右の両腕部を持ち上げてから、体幹関節ピッチ軸アクチュエータＡ９の駆動により、図２０（Ｃ）に示すように上体起こしを行なっている。腕部を先に持ち上げておくことにより、モーメントを小さくして、必要な最大トルクを低減することができる。
【０１５６】
次いで、一端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する（ステップＳ４）。
【０１５７】
ステップＳ４は、図１９（３）及び図２０（Ｄ）に相当する。実機上では、肩関節を含む２以上のリンクが離床している状態で、肩関節ピッチ軸で屈曲させて、そのリンク端の端部である手先を接床させる。そして、手先を機体重心位置である体幹ピッチ軸側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成する。
【０１５８】
このときの実機では、左右の肩関節ロール軸Ａ５の駆動により、左右の腕部を真横に広げた後、上腕ヨー軸Ａ６の駆動により腕部の向きを一旦１８０度回転させてから、肩関節ピッチ軸Ａ４の駆動により、腕部を徐々に降下させていく。そして、手先を着床することによって、より狭い接地多角形を形成する。
【０１５９】
このように新しい接地多角形を形成すると、接地多角形にＺＭＰを設定することができるかどうかをチェックする（ステップＳ５）。これは、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。そして、ＺＭＰを接地多角形に移動して、新たな支持多角形を形成する（ステップＳ６）。
【０１６０】
ここで、支持多角形が充分狭くなったか否かを判断する（ステップＳ７）。この判断は、体幹ピッチ軸と股関節ピッチ軸を連結する重心リンクを離床可能であるか、若しくは、図２０（Ｅ）に示すように、足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させることができるかどうかを、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。
【０１６１】
まだ支持多角形が充分狭いとは言えない場合には、着床点を移動して支持多角形を小さくした後（ステップＳ１０）、ステップＳ２に戻って、より狭い支持多角形の形成を再試行する。そして、接床リンクが形成する接地多角形内で、最も狭い支持多角形を探索する（ステップＳ２）。今度は、機体の他端側から少なくとも２以上のリンクを離床させたときの、ＺＭＰが計画可能かどうかを判定する。ＺＭＰの計画可能性は、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断することができる。
【０１６２】
次いで、接床多角形のうち、最も狭い支持多角形に関与しない２以上のリンクを離床する（ステップＳ３）。これは、図１９（４）〜（５）に相当する。実機上では、膝関節ピッチ軸を含む他端側から連続する２以上のリンクを支持多角形に関与しないリンクとして離床する。そして、一端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する（ステップＳ４）。このとき、実機は、まず、右脚の股関節ピッチ軸Ａ１２の駆動により右脚を持ち上げてから、その膝関節アクチュエータＡ１４の駆動により右脚を屈曲させて、その足底を着床する。次いで、脚の股関節ピッチ軸Ａ１２の駆動により右脚を持ち上げてから、その膝関節アクチュエータＡ１４の駆動により左脚を屈曲させて、その足底を着床する。このようにして、足底を機体重心位置である股関節ピッチ軸１２側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成することができる。
【０１６３】
このように新しい接地多角形を形成すると、接地多角形にＺＭＰを設定することができるかどうかをチェックする（ステップＳ５）。これは、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。そして、ＺＭＰを接地多角形に移動して、新たな支持多角形を形成する（ステップＳ６）。
【０１６４】
ここで、支持多角形が充分狭くなったか否かを再び判断する（ステップＳ７）。この判断は、体幹ピッチ軸と股関節ピッチ軸を連結する重心リンクを離床可能であるか、若しくは足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させることができるかどうかを、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。図２０（Ｆ）に示す実機の姿勢では、充分狭い支持多角形が形成されていると判断される。支持多角形を縮小する際の腕の角度に関しては、肩の軸から床面方向に下ろした垂線と腕の中心軸がなす角度は、トルク量に基づく所定角度内であることが望ましい。
【０１６５】
そして、機体の支持多角形が充分に狭くなったことに応答して、支持多角形の両リンク端の端部を接床した状態で前記重心リンクを離床し、両リンク端の着床リンクによって形成される支持多角形内にＺＭＰを維持しながら、支持多角形を形成する両リンク端の端部の間隔を縮めて、ＺＭＰを前記リンク構造体の他端側に移動させていく（ステップＳ８）。これは、図１９（６）〜（７）に相当する。実機上では、図２０（Ｇ）〜（Ｈ）に示すように、接地多角形の両リンク端の端部としての手先及び足底を接床した状態で体幹ピッチ軸及び股関節ピッチ軸を連結した前記重心リンクを離床し、さらに、手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かって移動させていく。
【０１６６】
そして、前記リンク構造体の他端から第２の所定数以下の接床リンクのみで形成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま前記リンク構造体の一端側から第１の所定数以上のリンクを離床して、該離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる（ステップＳ９）。これは、図１９（８）に相当する。
【０１６７】
実機上では、図２０（Ｈ）〜（Ｉ）に示すように、足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、肩ピッチ軸４から膝ピッチ軸１４に至までのリンクを離床して、離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる。
【０１６８】
起き上がりの最終段階である、離床リンクを長さ方向に伸展する際には、質量操作量のより大きな膝関節ピッチ軸を積極的に使用して動作することが、機体動作上の効率がよい。
【０１６９】
なお、ステップＳ３において、最も小さい支持多角形に関与しない２以上のリンクを離床することができない場合には、最大の支持多角形より内側の２以上の着床リンクを離床することを試みる（ステップＳ１１）。
【０１７０】
ステップＳ１１を実行できない場合には、起き上がり動作を中止する。また、ステップＳ１１を成功裏に実行することができる場合には、さらに、着床点を移動させて、支持多角形をさらに小さくする（ステップＳ１２）。
【０１７１】
ステップＳ１２を実行できない場合には、起き上がり動作を中止する。また、ステップＳ１２を成功裏に実行することができる場合には、足部で形成できる安定領域にＺＭＰを移動することができるかどうかをチェックする（ステップＳ１３）。この安定領域内にＺＭＰを移動することができない場合には、ステップＳ１１に戻って、支持多角形を小さくするための同様の処理を繰り返し実行する。また、この安定領域内にＺＭＰを移動させることができた場合には、ステップＳ８に進んで、基本姿勢への復帰動作を行なう。
【０１７２】
図２０に示す実機動作例では、Ａ〜Ｉの９段階に分けて起き上がり動作状況を捉えることができる。
【０１７３】
（Ａ）仰向けの基本姿勢
姿勢制御されている状態であり、すべての関節部位のアクチュエータが図１５に示す周波数特性に設定されている。この場合、サーボ制御器の比例ゲインを大きくとって、系全体のゲインを大きくし、低周波数帯域までゲインを取れるようにする。また、周波数特性を同図に示すように高域で位相進み量が小さくなるようにし、速応性にはあまり寄与しないが安定性を保証できるようにする。また、モータの粘性抵抗を大きくし、振動などの外乱にもロバストになるようにする。この結果、機体全体として、位置決め精度を優先して振動などの外乱にもロバストとなる。
【０１７４】
（Ｂ）両腕を上方向に上げる
体幹関節と股関節を連結する重心リンクを含む下半身側が支持多角形として抽出され、それ以外の肩関節から体幹関節に至る２以上のリンクを支持多角形に関与しないリンクとして離床する。このとき、肩ヨー軸、肘ピッチ軸など離床動作に関わる関節部位では、より狭い接地多角形を形成するために接床するまでの期間中、速応性とコンプライアンスが重要となる。そこで、これらの関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０１７５】
（Ｃ）両腕と体幹の相対角度を保持しながら体幹を起こす
左右の両腕部を持ち上げてから、上体起こしを行なる。腕部を先に持ち上げておくことにより、モーメントを小さくして、必要な最大トルクを低減することができる。このとき、関節部位のアクチュエータ特性を特に変更する必要はない。
【０１７６】
（Ｄ）両腕を後方に移動させる
肩関節を含む２以上のリンクが離床している状態で、肩関節ピッチ軸で屈曲させて、そのリンク端の端部である手先を接床させる。そして、手先を機体重心位置である体幹ピッチ軸側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成する。
【０１７７】
このとき、肩ピッチ軸などの離床動作に関わる関節部位では、より狭い接地多角形を形成するために接床するまでの期間中、速応性とコンプライアンスが重要となるので、この関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０１７８】
そして、両腕を移動して後方で着床した後は、肩ピッチ軸、肩ヨー軸、肘ピッチ軸など、最も狭い支持多角形を探索する動作を行なう関節部位のアクチュエータを図１５に示す周波数特性に設定し、支持多角形の大きさの精度を確保するための位置決め精度を優先して、振動などの外乱にもロバストにする。
【０１７９】
（Ｅ）片足ずつ膝を曲げて脚底を体幹に近づける
支持多角形を十分狭くするために、足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させる。このとき、足首ロール軸及び足首ピッチ軸などの離床動作に関わる各関節部位では、より狭い接地多角形を形成するために接床するまでの期間中、速応性とコンプライアンスが重要となるので、これらの関節部位のアクチュエータを図１６に示す周波数特性に設定する。すなわち、これら比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０１８０】
（Ｆ）両足の脚底が体幹に近づいた５点支持の状態にする
充分狭い支持多角形が形成されている状態で、足首ロール軸及び足首ピッチ軸など最も狭い支持多角形を探索する動作を行なう関節部位のアクチュエータを図１５に示す周波数特性に戻し、支持多角形の大きさの精度を確保するための位置決め精度を優先して、振動などの外乱にもロバストにする。
【０１８１】
（Ｇ）脚・体幹・肩を使い、腕と脚の４点支持の状態になって起き上がる
接地多角形の両リンク端の端部としての手先及び足底を接床した状態で体幹ピッチ軸及び股関節ピッチ軸を連結した前記重心リンクを離床し、さらに、手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かって移動させていく。このとき、足首ピッチ軸などの離床した関節部位では、より狭い接地多角形を形成するために、速応性とコンプライアンスが重要となるので、この関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０１８２】
（Ｈ）腕を離床させ、脚で２点支持の状態にする
足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、肩ピッチ軸４から膝ピッチ軸１４に至までのリンクを離床して、離床リンクを長さ方向に伸展する。このとき、足首ピッチ軸を図１５に示す周波数特性に戻し、伸展動作と２点支持状態での姿勢安定制御を強化するために、位置決め精度を優先するとともに振動などの外乱にもロバストにする。
【０１８３】
（Ｉ）基本姿勢に移行する
基本的な立ち姿勢で姿勢制御されている状態であり、すべての関節部位のアクチュエータが図１５に示す周波数特性に設定される。すなわち、関節部位のアクチュエータを低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めを可能にし、直立姿勢に復帰したときの姿勢安定制御を実現することができる。
【０１８４】
以上説明してきたように、機体が仰向け姿勢から起き上がり動作を行なう際、アクチュエータの特性を図１５に示すように低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めが可能となる。したがって、（Ａ）〜（Ｉ）の全般で、動作制御の精度が向上するので、支持多角形の大きさの精度を確保することができる。
【０１８５】
また、アクチュエータの特性を図１６に示すように低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくするように設定することで、該当する関節部位に機械的受動性（コンプライアンス）と速応性を与えることができる。したがって、（Ｂ）〜（Ｄ）、（Ｅ）〜（Ｆ）、（Ｇ）〜（Ｈ）の状態遷移のときに、腕や脚の動作や着床動作が円滑になるとともにエネルギ消費を少なくすることができる。
【０１８６】
Ｄ−２．基本うつ伏せ姿勢からの起き上がりオペレーション
図２１には、本実施形態に係る脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて起き上がり動作を行なう様子を、関節リンク・モデルで示している。
【０１８７】
本実施形態に係る脚式移動ロボット１００は、基本的には、仰向け姿勢から起き上がる場合と同様に、図１８にフローチャートの形式で示した処理手順に従って、うつ伏せ姿勢からも起き上がることができる。以下、図１８に示したフローチャートを参照しながら、基本うつ伏せ姿勢からの機体の起き上がりオペレーションについて説明する。
【０１８８】
まず、床上姿勢において、位置エネルギの最も小さい姿勢をとる（ステップＳ１）。これは、基本うつ伏せ姿勢に相当し、図２１（１）及び図２２（Ａ）に示すように、起き上がり動作に使用する肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４をそれぞれ連結するリンクはすべて接床している。
【０１８９】
この基本うつ伏せ姿勢において、接床リンクが形成する接地多角形内で、最も狭い支持多角形を探索する（ステップＳ２）。このとき、機体の一端側から少なくとも２以上のリンクを離床させたときの、ＺＭＰが計画可能かどうかを判定する。ＺＭＰの計画可能性は、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断することができる。
【０１９０】
次いで、接地多角形のうち、最も狭い支持多角形に関与しない２以上のリンクを離床する（ステップＳ３）。ステップＳ３は、図２１（２）に相当する。実機上では、体幹関節と股関節を連結する重心リンクを含む下半身側が支持多角形として抽出され、それ以外の肩関節から体幹関節に至る２以上のリンクを支持多角形に関与しないリンクとして離床する。まず、左右の両腕部の肩ロール軸アクチュエータＡ５を作動させて、床面に摺って肩ロール軸回りに略９０度だけ旋回させ、次いで、上腕ヨー軸アクチュエータＡ６を作動させて、各腕部を上腕ヨー軸回りに略１８０度だけ回転させる。そして、図２２（Ｂ）に示すようにさらに肩ロール軸アクチュエータＡ５を作動させて、摺って肩ロール軸回りに略９０度だけ旋回させて、図２２（Ｃ）に示すように左右の腕部を頭部の側面まで移動する。
【０１９１】
次いで、一端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する（ステップＳ４）。ステップＳ４は、図２１（３）図２２（Ｄ）に相当する。
【０１９２】
そして、新しい接地多角形を形成すると、接地多角形にＺＭＰを設定することができるかどうかをチェックする（ステップＳ５）。これは、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。そして、ＺＭＰを接地多角形に移動して、新たな支持多角形を形成する（ステップＳ６）。実機上では、図２２（Ｄ）に示すように、肘ピッチ軸７を固定させて、左右の腕部を真直ぐ伸ばしたままの状態で、今度は肩ピッチ軸アクチュエータＡ４、体幹ピッチ軸アクチュエータＡ９、股関節ピッチ軸Ａ１２、並びに膝関節ピッチ軸アクチュエータＡ１４を作動させて、手先と左右の両膝が接地した閉リンク姿勢からなる支持多角形を形成する。
【０１９３】
まだ支持多角形が充分狭いとは言えない場合には、着床点を移動して支持多角形を小さくする（ステップＳ１０）。実機上では、図２２（Ｅ）に示すように、左右の腕部をまっすぐに保ったまま、手先を他方の着床点である足底側に徐々に近づけていくことによって、より狭い支持多角形を形成していく。
【０１９４】
ここで、支持多角形が充分狭くなったか否かを判断する（ステップＳ７）。この判断は、体幹ピッチ軸と股関節ピッチ軸を連結する重心リンクを離床可能であるか、若しくは、足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させることができるかどうかを、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。
【０１９５】
そして、機体の支持多角形が充分に狭くなったことに応答して両リンク端の着床リンクによって形成される支持多角形内にＺＭＰを維持しながら、支持多角形を形成する両リンク端の端部の間隔を縮めて、ＺＭＰを前記リンク構造体の他端側に移動させていく（ステップＳ８）。これは、図２１（６）〜（７）に相当する。実機上では、図２２（Ｇ）〜（Ｈ）に示すように、接地多角形の両リンク端の端部としての手先及び足底を接床した状態で、さらに手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かって移動させていく。
【０１９６】
そして、前記リンク構造体の他端から第２の所定数以下の接床リンクのみで形成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま前記リンク構造体の一端側から第１の所定数以上のリンクを離床して、該離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる（ステップＳ９）。これは、図１９（８）に相当する。
【０１９７】
実機上では、図２２（Ｈ）〜（Ｉ）に示すように、足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、肩ピッチ軸４から膝ピッチ軸１４に至までのリンクを離床して、離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる。
【０１９８】
起き上がりの最終段階である、離床リンクを長さ方向に伸展する際には、質量操作量のより大きな膝関節ピッチ軸を積極的に使用して動作することが、機体動作上の効率がよい。
【０１９９】
図２２に示す実機動作例では、Ａ〜Ｇの７段階に分けて起き上がり動作状況を捉えることができる。
【０２００】
（Ａ）うつ伏せの基本姿勢
姿勢制御されている状態であり、すべての関節部位のアクチュエータが図１５に示す周波数特性に設定されている。この場合、サーボ制御器の比例ゲインを大きくとって、系全体のゲインを大きくし、低周波数帯域までゲインを取れるようにする。また、周波数特性を同図に示すように高域で位相進み量が小さくなるようにし、速応性にはあまり寄与しないが安定性を保証できるようにする。また、モータの粘性抵抗を大きくし、振動などの外乱にもロバストになるようにする。この結果、機体全体として、位置決め精度を優先して振動などの外乱にもロバストとなる。
【０２０１】
（Ｂ）両腕を頭上方向に向けて横側から動かす
体幹関節と股関節を連結する重心リンクを含む下半身側が支持多角形として抽出され、それ以外の肩関節から体幹関節に至る２以上のリンクを支持多角形に関与しないリンクとして離床する。そして、肩ロール軸アクチュエータＡ５を作動させて、摺って肩ロール軸回りに略９０度だけ旋回させて、各腕部を頭部の側面まで移動する。このとき、肩ヨー軸、肩ピッチ軸など離床・旋回動作に関わる関節部位では、より狭い接地多角形を形成するために接床するまでの期間中、速応性とコンプライアンスが重要となる。そこで、これらの関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０２０２】
（Ｃ）両腕を頭上方向に上げる
左右の両腕部を頭部の側面まで移動する。このとき、関節部位のアクチュエータ特性を特に変更する必要はない。
【０２０３】
（Ｄ）両腕を使って４点支持の状態にし、ＺＭＰを足の接地面に近づける
肘ピッチ軸７を固定させて、左右の腕部を真直ぐ伸ばしたままの状態で、今度は肩ピッチ軸アクチュエータＡ４、体幹ピッチ軸アクチュエータＡ９、股関節ピッチ軸Ａ１２、並びに膝関節ピッチ軸アクチュエータＡ１４を作動させて、手先と左右の両膝が接地した閉リンク姿勢からなるより狭い接地多角形を形成する。このとき、肩ロール軸及び肩ピッチ軸など最も狭い支持多角形を探索する動作を行なう関節部位のアクチュエータを、図１５に示す周波数特性に戻し、支持多角形の大きさの精度を確保するための位置決め精度を優先して、振動などの外乱にもロバストにする。
【０２０４】
（Ｅ）ＺＭＰが足の接地面で構成される支持多角形内に入るように姿勢制御する右の腕部をまっすぐに保ったまま、手先を他方の着床点である足底側に徐々に近づけていくことによって、より狭い支持多角形を形成し、足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させることができるようにする。このとき、関節部位のアクチュエータ特性を特に変更する必要はない。
【０２０５】
（Ｆ）両腕を離床し２点支持の状態にする
接地多角形の両リンク端の端部としての手先及び足底を接床した状態で、さらに手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かって移動させていく。そして、足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、肩ピッチ軸４から膝ピッチ軸１４に至までのリンクを離床して、離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる。
【０２０６】
このとき、足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸では、より狭い接地多角形を形成するために、速応性とコンプライアンスが重要となるので、この関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０２０７】
そして、両腕を離床し２点支持の状態になった後は、足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸のアクチュエータを図１５に示す周波数特性に設定し、伸展動作と２点支持状態での姿勢安定制御を強化するために、位置決め精度を優先するとともに振動などの外乱にもロバストにする。
【０２０８】
（Ｇ）基本姿勢に移行する
基本的な立ち姿勢で姿勢制御されている状態であり、すべての関節部位のアクチュエータが図１５に示す周波数特性に設定される。すなわち、関節部位のアクチュエータを低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めを可能にし、直立姿勢に復帰したときの姿勢安定制御を実現することができる。
【０２０９】
以上説明してきたように、機体がうつ伏せ姿勢から起き上がり動作を行なう際、アクチュエータの特性を図１５に示すように低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めが可能となる。したがって、（Ａ）〜（Ｉ）の全般で、動作制御の精度が向上するので、支持多角形の大きさの精度を確保することができる。
【０２１０】
また、アクチュエータの特性を図１６に示すように低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくするように設定することで、該当する関節部位に機械的受動性（コンプライアンス）と速応性を与えることができる。したがって、（Ｂ）〜（Ｄ）、（Ｅ）〜（Ｆ）の状態遷移のときに、腕や脚の動作や着床動作が円滑になるとともにエネルギ消費を少なくすることができる。
【０２１１】
［追補］
以上、特定の実施例を参照しながら、本発明について詳解してきた。しかしながら、本発明の要旨を逸脱しない範囲で当業者が該実施例の修正や代用を成し得ることは自明である。
【０２１２】
本発明の要旨は、必ずしも「ロボット」と称される製品には限定されない。すなわち、電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置であるならば、例えば玩具等のような他の産業分野に属する製品であっても、同様に本発明を適用することができる。
【０２１３】
また、本明細書中では、モータ・コイルへのコイル電流のスイッチング制御にバイポーラ・トランジスタからなるスイッチング素子を用いて構成される回路例について説明したが、ＭＯＳ−ＦＥＴやその他の半導体素子を用いてこの種の制御回路を実装することができることは、当業者には自明である。
【０２１４】
要するに、例示という形態で本発明を開示してきたのであり、本明細書の記載内容を限定的に解釈するべきではない。本発明の要旨を判断するためには、冒頭に記載した特許請求の範囲の欄を参酌すべきである。
【０２１５】
【発明の効果】
以上詳記したように、本発明によれば、仰向けやうつ伏せなどの床上姿勢から自律的に立ち姿勢を回復することができる、優れた脚式移動ロボットを提供することができる。
【０２１６】
また、本発明によれば、うつ伏せ又は仰向けの姿勢からの起き上がり動作を始めとしてさまざまな動作の実行時においてアクチュエータそのものの特性とアクチュエータの制御器の特性の２つを動的又は静的に制御することにより安定且つ高効率な動作を実現することができる、優れた脚式移動ロボットを提供することができる。
【図面の簡単な説明】
【図１】本発明の実施に供される脚式移動ロボットが直立している様子を前方から眺望した様子を示した図である。
【図２】本発明の実施に供される脚式移動ロボットが直立している様子を後方から眺望した様子を示した図である。
【図３】脚式移動ロボットが具備する関節自由度構成を模式的に示した図である。
【図４】脚式移動ロボット１００の制御システム構成を模式的に示した図である。
【図５】アクチュエータのサーボ制御器の構成を示した図である。
【図６】図５に示したモータと減速機の伝達関数表現モデルゲイン及び位相の周波数特性を示した図である。
【図７】図５に示したサーボ制御器において、位相補償型制御の設計例として位相補償帯域を任意に選択する例を説明するための図である。
【図８】図５に示したサーボ制御器において、位相補償型制御の設計例として位相補償を施す量を任意に選択する例を説明するための図である。
【図９】図５に示したサーボ制御器において、Ｋで示した直列補償ゲインの大小を変更する制御器の設計例を説明するための図である。
【図１０】図７に示したように位相補償量が一定で周波数帯域を任意に選ぶようにアクチュエータのサーボ制御器を実装したときの開ループ特性を示した図である。
【図１１】図１０に示したうち高域でのみ位相進み補償を施した例Ｃ（ｓ）−３においてさらに直列補償ゲインの制御を採り入れた様子を示した図である。
【図１２】コイル電流の制御メカニズムを適用したＤＣモータのコイル電流供給用の電流制御回路の等価回路の構成例を示した図である。
【図１３】付加論理回路の具体的な回路構成を示した図である。
【図１４】ＰＷＭ制御により所定のデューティ比を持つＢＲＡＫＥ＿ＰＷＭ制御信号が入力されたときの付加論理回路の各トランジスタ制御用信号の出力特性を、コイル電流波形特性及びトルク出力特性とともに示した図である。
【図１５】位置決め精度が重要な部分に適用することができるアクチュエータの周波数特性を示した図である。
【図１６】速応性とコンプライアンスが重要となる部分に適用することができるアクチュエータの周波数特性を示した図である。
【図１７】脚式移動ロボットが歩行動作を行なう様子を段階毎に示した図である。
【図１８】脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて起き上がり動作を行なうための処理手順を示したフローチャートである。
【図１９】脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて仰向け姿勢から起き上がり動作を行なう様子を、関節リンク・モデルで示した図である。
【図２０】実機が仰向け姿勢から起き上がっていく様子を示した図である。
【図２１】脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて起き上がり動作を行なう様子を、関節リンク・モデルで示した図である。
【図２２】実機がうつ伏せ姿勢から起き上がっていく様子を示した図である。
【図２３】ＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比によってモータの粘性抵抗を動的に制御する制御の関係を示した図である。
【符号の説明】
１…首関節ヨー軸
２Ａ…第１の首関節ピッチ軸
２Ｂ…第２の首関節（頭）ピッチ軸
３…首関節ロール軸
４…肩関節ピッチ軸
５…肩関節ロール軸
６…上腕ヨー軸
７…肘関節ピッチ軸
８…手首関節ヨー軸
９…体幹ピッチ軸
１０…体幹ロール軸
１１…股関節ヨー軸
１２…股関節ピッチ軸
１３…股関節ロール軸
１４…膝関節ピッチ軸
１５…足首関節ピッチ軸
１６…足首関節ロール軸
３０…頭部ユニット，４０…体幹部ユニット
５０…腕部ユニット，５１…上腕ユニット
５２…肘関節ユニット，５３…前腕ユニット
６０…脚部ユニット，６１…大腿部ユニット
６２…膝関節ユニット，６３…脛部ユニット
８０…制御ユニット，８１…主制御部
８２…周辺回路
９１，９２…接地確認センサ
９３，９４…加速度センサ
９５…姿勢センサ
９６…加速度センサ
１００…脚式移動ロボット
【発明の属する技術分野】
本発明は、ロボットや汎用組立機器、ロボット・ハンド機器、その他の多軸制御装置などのような多軸駆動系の機械装置に係り、特に、直列補償の比例ゲイン、位相補償要素から成り立つ位置制御系を構成するアクチュエータのサーボ制御器によって各関節部位が構成されるロボットに関する。
【０００２】
さらに詳しくは、本発明は、高ゲインＰＤ制御で各軸リンクが制御される２足歩行の脚式移動ロボットに係り、特に、うつ伏せ又は仰向けの姿勢からの起き上がり動作を始めとしてさまざまな動作の実行時においてアクチュエータそのものの特性とアクチュエータの制御器の特性の２つを動的又は静的に制御することにより安定且つ高効率な動作を実現する脚式移動ロボットに関する。
【０００３】
【従来の技術】
電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置のことを「ロボット」という。ロボットの語源は、スラブ語の”ＲＯＢＯＴＡ（奴隷機械）”に由来すると言われている。わが国では、ロボットが普及し始めたのは１９６０年代末からであるが、その多くは、工場における生産作業の自動化・無人化などを目的としたマニピュレータや搬送ロボットなどの産業用ロボット（ｉｎｄｕｓｔｒｉａｌ ｒｏｂｏｔ）であった。
【０００４】
アーム式ロボットのように、ある特定の場所に植設して用いるような据置きタイプのロボットは、部品の組立・選別作業など固定的・局所的な作業空間でのみ活動する。これに対し、移動式のロボットは、作業空間は非限定的であり、所定の経路上または無経路上を自在に移動して、所定の若しくは任意の人的作業を代行したり、ヒトやイヌあるいはその他の生命体に置き換わる種々の幅広いサービスを提供したりすることができる。なかでも脚式の移動ロボットは、クローラ式やタイヤ式のロボットに比し不安定で姿勢制御や歩行制御が難しくなるが、階段や梯子の昇降や障害物の乗り越えや、整地・不整地の区別を問わない柔軟な歩行・走行動作を実現できるという点で優れている。
【０００５】
最近では、イヌやネコのように４足歩行の動物の身体メカニズムやその動作を模したペット型のロボット、あるいは、ヒトのような２足直立歩行を行う動物の身体メカニズムや動作をモデルにしてデザインされた「人間形」若しくは「人間型」と呼ばれるロボット（ｈｕｍａｎｏｉｄ ｒｏｂｏｔ）など、脚式移動ロボットに関する研究開発が進展し、実用化への期待も高まってきている。
【０００６】
ここで、直立歩行型の脚式移動ロボットの場合、歩行などの機体運動を考慮した場合における基準となる姿勢は、２足で立ち上がった立ち姿勢である。例えば、立ち姿勢の中では最も安定した状態（すなわち不安定性の極小点）を基本立ち姿勢にすることができる。
【０００７】
基本立ち姿勢は、その姿勢を安定に維持するためには、姿勢安定制御の実行、制御指示による脚部などの関節軸モータのトルク生成が必要である。無電源状態では立ち姿勢は決して安定ではないことから、ロボットは、仰向けやうつ伏せなどの物理的に最も安定した床上姿勢から起動を開始することが好ましいと思料される。しかしながら、これら床上姿勢のロボットの電源を投入しても、ロボットが自律的に起き上がることができなければ、オペレータが手を貸して機体を持ち上げるなどの作業を施してあげなければならず、煩わしい。
【０００８】
また、ロボットが一旦立ち姿勢となり、歩行やその他の自律的な脚式作業を行なう場合、基本的には転倒することなく、脚を使って移動するように最大限に努力するが、敢え無く転倒してしまうこともある。さまざまな障害物や不測の事態を包含する人間の住環境下でロボットが動作する上で、「転倒」は不可避である。そもそも人間自体が転倒する。このような場合も、オペレータが手を貸して機体を持ち上げなければならないのでは、やはり煩わしい。
【０００９】
ロボットが床上姿勢になる度に、ロボットが自分で起き上がることができなければ、結局のところ無人環境でロボットが作業できない、すなわち作業に自己完結性がないということになり、完全に自立化された環境に置くことはできない。
【００１０】
また、多軸駆動系の機械装置は、一般に、多数の関節自由度を備え、関節の動きをアクチュエータ・モータで実現する。この場合、各モータの回転位置、回転量などを取り出して、サーボ制御により、所望の動作パターンを再現するとともに、姿勢制御を行なうことができる。運動制御理論から見た関節各部位は、高ゲインＰＤ制御で各軸リンクが制御され、それらが一定の特性のまま動作するのが一般的である。
【００１１】
しかしながら、人間の動作研究の結果からも分かるように、安定且つ高効率な動作を実現するには局所的に力を増減させることや関節各部位のコンプライアンス（機械的受動性）を増減させることが重要である。
【００１２】
位置制御系として関節各軸の動作を捉えたときは高ゲイン且つ高帯域なサーボ制御器を使って、制御偏差が少なくなるように制御した方がよいが、力学モデルとして捉えたときはポテンシャル・エネルギーや運動エネルギの作用を考慮してゲインを低くしたり位相補償している周波数帯を上下させたりすることも同時に行なうとよい。
【００１３】
ところが、ロボットの機体上でそのような制御を実現するにはアクチュエータそのものの特性と、アクチュエータの制御器の特性の２つを動的・静的に制御する機能が必要になる。
【００１４】
例えば、既知乃至未知の歩行路面でも安定して歩行することができる脚式移動ロボットの歩行制御装置に関する提案がなされている。すなわち、２足歩行の脚式移動ロボットで上体に腕を備えた人体類似の構造を有するものにおいて、歩行路面で摩擦力が低下して安定性が低下したとき、状態を駆動して安定性を確保ないし回復する（例えば、特許文献１を参照のこと）。しかしながら、これはフィード・フォワード・ゲインを制御することによって実現するものであり、関節の粘性や周波数特性に対する言及はなく、また、コンプライアンスの有無といった概念もない。
【００１５】
【特許文献１】
特開平７−２０５０６９号公報
【００１６】
【発明が解決しようとする課題】
本発明の目的は、仰向けやうつ伏せなどの床上姿勢から自律的に立ち姿勢を回復することができる、優れた脚式移動ロボットを提供することにある。
【００１７】
本発明のさらなる目的は、うつ伏せ又は仰向けの姿勢からの起き上がり動作を始めとしてさまざまな動作の実行時においてアクチュエータそのものの特性とアクチュエータの制御器の特性の２つを動的又は静的に制御することにより安定且つ高効率な動作を実現することができる、優れた脚式移動ロボットを提供することにある。
【００１８】
【課題を解決するための手段及び作用】
本発明は、上記課題を参酌してなされたものであり、複数の可動脚を含む複数の関節部位で構成される脚式移動ロボットであって、
各関節部位におけるアクチュエータのサーボ制御器のゲイン及び位相補償制御とアクチュエータ・モータの粘性抵抗の制御とを組み合わせて行なうアクチュエータ特性制御手段と、
機体の寝姿勢からの起き上がり動作を制御する起き上がり動作制御手段とを備え、
前記アクチュエータ特性制御手段は、起き上がり動作の各段階毎に、各関節部位のアクチュエータを、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性と、低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくする第２のアクチュエータ特性との間で切り替える、
ことを特徴とする脚式移動ロボットである。
【００１９】
本発明によれば、脚式移動ロボットの各関節部位を構成するアクチュエータのサーボ制御器において、比例ゲインと位相補償要素を調整することにより、ロボットの関節各部位において必要な位置決め精度、機械的受動性（コンプライアンス）、動作速度を任意に設定することができる。
【００２０】
また、アクチュエータ・モータのコイルへの非通電時においてコイルを間歇的に短絡状態又はオープン状態に切り替えることによって、モータの粘性抵抗を調整し振動などの外乱に対するロバスト性を変更することができる。
【００２１】
さらに、これらアクチュエータのサーボ制御器におけるゲイン及び位相補償制御とアクチュエータ・モータの粘性抵抗の制御とを組み合わせることによって、位置決め精度が重要な部分に適用することができるアクチュエータの周波数特性、あるいは即応性とコンプライアンスが重要となる部分に適用することができるアクチュエータの周波数特性を得ることができる。
【００２２】
そして、前記アクチュエータ特性制御手段は、アクチュエータの特性を「低域ゲインを大きく」、「高い周波数領域で位相進み量を小さく」、「関節の粘性抵抗を大きく」する設定を行なうことで、高精度な位置決め制御が可能となり、姿勢の安定性が増す。
【００２３】
また、前記アクチュエータ特性制御手段は、アクチュエータの特性を「低域ゲインを小さく」、「位相進み量を大きく」、「関節の粘性抵抗を小さく」する設定を行なうことで、機械的受動性と速い応答性を持たせることができるので、着床の瞬間の衝撃力を緩和しつつ高い帯域の追従制御を行なうことができる。
【００２４】
ここで、前記脚式移動ロボットの機体は略平行な関節自由度を持つ複数の関節軸を長さ方向に連結したリンク構造体で構成される。前記リンク構造体は、少なくとも肩関節ピッチ軸、体幹ピッチ軸、股関節ピッチ軸、膝ピッチ軸が機体の高さ方向に連結されてなる。勿論、脚式移動ロボットの機体は、これら以外の関節ピッチ軸を備えていてもよいし、また、各関節部位において、ピッチ軸以外のロール軸並びにヨー軸回りの回転自由度を備えていてもよい。
【００２５】
また、前記起き上がり動作制御手段は、
機体の重心となる重心リンクを含む２以上のリンクが接床した床上姿勢において、接床リンクが形成する接地多角形内において最も少ないリンク数で形成される最も狭い支持多角形を探索する手段と、
接地多角形中の前記探索された支持多角形以外の接床リンクを離床させる手段と、
２以上の連続する離床リンクを屈曲させ、そのリンク端の端部を接床させて、より狭い接地多角形を形成する手段と、
支持多角形が充分狭くなったことに応答して、前記リンク構造体の一端側から第１の所定数以上のリンクを離床して機体を直立させる手段と、
で構成することができる。ここで、床面と接床する複数の機体の端部が形成する多角形のことを接地多角形という。また、ＺＭＰが存在する接地多角形のことを支持多角形という。ＺＭＰの安定領域は、支持多角形内においてロボットの姿勢などを安定に制御可能な領域である。
【００２６】
脚式移動ロボットは、仰向け又はうつ伏せなどの基本的な床上姿勢においては、これら関節ピッチ軸、体幹ピッチ軸、股関節ピッチ軸、膝ピッチ軸を連結するすべてのリンクは接床している。また、基本的な立ち姿勢や歩行姿勢においては、これら関節ピッチ軸、体幹ピッチ軸、股関節ピッチ軸、膝ピッチ軸を連結するすべてのリンクは離床し、略鉛直方向に整列している。
【００２７】
床上姿勢から立ち姿勢に移行する起き上がりの際には、通常の立ち姿勢を維持したり歩行動作を行なう場合に比し、関係する関節アクチュエータには高いトルク出力が必要とされる。このため、ＺＭＰ支持多角形が最小となる姿勢を利用して起き上がり動作を行なうことによって、より少ない駆動トルクで起き上がり動作を実現する。
【００２８】
まず、ほとんどすべてのリンクが接床している床上姿勢において、接床リンクが形成する接地多角形内で、最も狭い支持多角形を探索する。このとき、機体の一端側から少なくとも２以上のリンクを離床させたときの、ＺＭＰが計画可能かどうかを判定する。例えば、体幹ピッチ軸及び股関節ピッチ軸を連結するリンクを重心リンクとして接床状態に保ったままで、より狭い支持多角形を探索する。そして、肩関節ピッチ軸を含む一端側から連続する２以上のリンクを離床させることを試みる。
【００２９】
次いで、支持多角形となる接床リンクを残し、接地多角形の一端側から２以上の連続するリンクを離床する。そして、一端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する。例えば、リンク構造体の一端側から肩関節を含む２以上のリンクを支持多角形に関与しないリンクとして離床する。そして、肩関節を含む２以上のリンクが離床している状態で、肩関節ピッチ軸で屈曲させて、そのリンク端の端部である手先を接床させる。そして、手先を機体重心位置である体幹ピッチ軸側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成する。
【００３０】
さらに、この接地多角形において、最も狭い支持多角形を探索する。今度は他端から少なくとも２以上のリンクを離床させて、ＺＭＰが計画可能かどうかを判定する。例えば、体幹ピッチ軸及び股関節ピッチ軸を連結する重心リンクを接床状態に保ったままで、膝関節ピッチ軸を含む他端側から連続する２以上のリンクを離床させることを試みる。
【００３１】
次いで、支持多角形となる接床リンクを残し、接地多角形の他端側から２以上の連続するリンクを離床する。そして、他端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する。例えば、膝関節を含む２以上のリンクが離床している状態で、膝関節ピッチ軸で屈曲させて、そのリンク端の端部である足底を接床させる。そして、足底を機体重心位置である股関節ピッチ軸側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成する。
【００３２】
次いで、接地多角形の両リンク端の端部を接床した状態で前記重心リンクを離床可能か否かによって、支持多角形が充分狭くなったか否かを判断する。例えば、接地多角形の両リンク端の端部としての手先及び足底を接床した状態で、体幹ピッチ軸及び股関節ピッチ軸を連結した前記重心リンクを離床可能か否かによって支持多角形が充分狭くなったか否かを判断する。
【００３３】
そして、機体の支持多角形が充分に狭くなったことに応答して、支持多角形の両リンク端の端部を接床した状態で前記重心リンクを離床し、両リンク端の着床リンクによって形成される支持多角形内にＺＭＰを維持しながら、支持多角形の両リンク端の端部の間隔を縮めて、ＺＭＰを前記リンク構造体の他端側に移動させる。例えば、接地多角形の両リンク端の端部としての手先及び足底を接床した状態で体幹ピッチ軸及び股関節ピッチ軸を連結した前記重心リンクを離床し、手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かってに移動させていく。
【００３４】
そして、前記リンク構造体の他端から第２の所定数以下の接床リンクのみで形成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま前記リンク構造体の一端側から第１の所定数以上のリンクを離床して、該離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる。例えば、前記足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、前記肩ピッチ軸から前記膝ピッチ軸に至までのリンクを離床して、該離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させることができる。
【００３５】
また、前記アクチュエータ特性制御手段は、機体の起き上がり動作の各段階において、最も狭い支持多角形の探索に関与する接床リンクの各関節部位のアクチュエータの特性を、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に設定するようにしてもよい。
【００３６】
このように該当する関節部位のアクチュエータを低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めを可能にし、支持多角形の大きさの精度を確保することができる。
【００３７】
また、前記アクチュエータ特性制御手段は、機体の起き上がり動作の各段階において、支持多角形に関与しない離床リンクの各関節部位のアクチュエータの特性を、より狭い接地多角形を形成するために接床するまでの期間中、低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくした第２のアクチュエータ特性から、接床後は低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に切り替えるようにしてもよい。
【００３８】
このように該当する関節部位に機械的受動性（コンプライアンス）と速応性を与えることにより、起き上がりのためにより狭い接地多角形を逐次形成していく動作の過程で、腕や脚の動作や着床動作が円滑になるとともにエネルギ消費を少なくすることができる。
【００３９】
また、前記アクチュエータ特性制御手段は、支持多角形が充分狭くなったことに応答して機体を直立させる動作に関わる各関節部位のアクチュエータの特性を、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に設定するようにしてもよい。
【００４０】
このように該当する関節部位のアクチュエータを低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めを可能にし、直立姿勢に復帰したときの姿勢安定制御を実現することができる。
【００４１】
本発明のさらに他の目的、特徴や利点は、後述する本発明の実施形態や添付する図面に基づくより詳細な説明によって明らかになるであろう。
【００４２】
【発明の実施の形態】
以下、図面を参照しながら本発明の実施形態について詳解する。
【００４３】
Ａ．脚式移動ロボットの機械的構成
図１及び図２には本発明の実施に供される「人間形」又は「人間型」の脚式移動ロボットが直立している様子を前方及び後方の各々から眺望した様子を示している。図示の通り、脚式移動ロボットは、胴体部と、頭部と、左右の上肢部と、脚式移動を行う左右２足の下肢部とで構成され、例えば胴体に内蔵されている制御部（図示しない）により機体の動作を統括的にコントロールするようになっている。
【００４４】
左右各々の下肢は、大腿部と、膝関節と、脛部と、足首と、足平とで構成され、股関節によって体幹部の略最下端にて連結されている。また、左右各々の上肢は、上腕と、肘関節と、前腕とで構成され、肩関節によって体幹部の上方の左右各側縁にて連結されている。また、頭部は、首関節によって体幹部の略最上端中央に連結されている。
【００４５】
制御部は、この脚式移動ロボットを構成する各関節アクチュエータの駆動制御や各センサ（後述）などからの外部入力を処理するコントローラ（主制御部）や、電源回路その他の周辺機器類を搭載した筐体である。制御部は、その他、遠隔操作用の通信インターフェースや通信装置を含んでいてもよい。
【００４６】
このように構成された脚式移動ロボットは、制御部による全身協調的な動作制御により、２足歩行を実現することができる。かかる２足歩行は、一般に、以下に示す各動作期間に分割される歩行周期を繰り返すことによって行われる。すなわち、
（１）右脚を持ち上げた、左脚による単脚支持期
（２）右足が接地した両脚支持期
（３）左脚を持ち上げた、右脚による単脚支持期
（４）左足が接地した両脚支持期
【００４７】
脚式移動ロボットにおける歩行制御は、あらかじめ下肢の目標軌道を計画し、上記の各期間において計画軌道の修正を行なうことによって実現される。すなわち、両脚支持期では、下肢軌道の修正を停止して、計画軌道に対する総修正量を用いて腰の高さを一定値で修正する。また、単脚支持期では、修正を受けた脚の足首と腰との相対位置関係を計画軌道に復帰させるように修正軌道を生成する。
【００４８】
歩行動作の軌道修正を始めとして、機体の姿勢安定制御には、一般に、ＺＭＰに対する偏差を小さくするための位置、速度、及び加速度が連続となるように、５次多項式を用いた補間計算により行なう。ＺＭＰ（Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔ）を歩行の安定度判別の規範として用いている。ＺＭＰによる安定度判別規範は、歩行系から路面には重力と慣性力、並びにこれらのモーメントが路面から歩行系への反作用としての床反力並びに床反力モーメントとバランスするという「ダランベールの原理」に基づく。力学的推論の帰結として、足底接地点と路面の形成する支持多角形（すなわちＺＭＰ安定領域）の辺上あるいはその内側にピッチ軸及びロール軸モーメントがゼロとなる点、すなわち「ＺＭＰ（Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔ）」が存在する。
【００４９】
図３には、この脚式移動ロボットが具備する関節自由度構成を模式的に示している。同図に示すように、脚式移動ロボットは、２本の腕部と頭部１を含む上肢と、移動動作を実現する２本の脚部からなる下肢と、上肢と下肢とを連結する体幹部とで構成された、複数の肢を備えた構造体である。
【００５０】
頭部を支持する首関節（Ｎｅｃｋ）は、首関節ヨー軸１と、第１及び第２の首関節ピッチ軸２Ａ及び２Ｂと、首関節ロール軸３という４自由度を有している。
【００５１】
また、各腕部は、その自由度として、肩（Ｓｈｏｕｌｄｅｒ）における肩関節ピッチ軸４と、肩関節ロール軸５と、上腕ヨー軸６、肘（Ｅｌｂｏｗ）における肘関節ピッチ軸７と、手首（Ｗｒｉｓｔ）における手首関節ヨー軸８と、手部とで構成される。手部は、実際には、複数本の指を含む多関節・多自由度構造体である。
【００５２】
また、体幹部（Ｔｒｕｎｋ）は、体幹ピッチ軸９と、体幹ロール軸１０という２自由度を有する。
【００５３】
また、下肢を構成する各々の脚部は、股関節（Ｈｉｐ）における股関節ヨー軸１１と、股関節ピッチ軸１２と、股関節ロール軸１３と、膝（Ｋｎｅｅ）における膝関節ピッチ軸１４と、足首（Ａｎｋｌｅ）における足首関節ピッチ軸１５と、足首関節ロール軸１６と、足部とで構成される。
【００５４】
Ｂ．脚式移動ロボットの制御システム構成
図４には、脚式移動ロボット１００の制御システム構成を模式的に示している。同図に示すように、脚式移動ロボット１００は、ヒトの四肢を表現した各機構ユニット３０，４０，５０Ｒ／Ｌ，６０Ｒ／Ｌと、各機構ユニット間の協調動作を実現するための適応制御を行う制御ユニット８０とで構成される（但し、Ｒ及びＬの各々は、右及び左の各々を示す接尾辞である。以下同様）。
【００５５】
脚式移動ロボット１００全体の動作は、制御ユニット８０によって統括的に制御される。制御ユニット８０は、ＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）やメモリ等の主要回路コンポーネント（図示しない）で構成される主制御部８１と、電源回路やロボット１００の各構成要素とのデータやコマンドの授受を行うインターフェース（いずれも図示しない）などを含んだ周辺回路８２とで構成される。
【００５６】
本発明を実現する上で、この制御ユニット８０の設置場所は特に限定されない。図４では体幹部ユニット４０に搭載されているが、頭部ユニット３０に搭載してもよい。あるいは、脚式移動ロボット１００外に制御ユニット８０を配備して、脚式移動ロボット１００の機体とは有線若しくは無線で交信するようにしてもよい。
【００５７】
図３に示した脚式移動ロボット１００内の各関節自由度は、それぞれに対応するアクチュエータによって実現される。すなわち、頭部ユニット３０には、首関節ヨー軸１、第１及び第２の首関節ピッチ軸２Ａ及び２Ｂ、首関節ロール軸３の各々を表現する首関節ヨー軸アクチュエータＡ１、第１及び第２の首関節ピッチ軸アクチュエータＡ２Ａ、Ａ２Ｂ、首関節ロール軸アクチュエータＡ３がそれぞれ配設されている。
【００５８】
また、体幹部ユニット４０には、体幹ピッチ軸９、体幹ロール軸１０の各々を表現する体幹ピッチ軸アクチュエータＡ９、体幹ロール軸アクチュエータＡ１０が配備されている。
【００５９】
また、腕部ユニット５０Ｒ／Ｌは、上腕ユニット５１Ｒ／Ｌと、肘関節ユニット５２Ｒ／Ｌと、前腕ユニット５３Ｒ／Ｌに細分化されるが、肩関節ピッチ軸４、肩関節ロール軸５、上腕ヨー軸６、肘関節ピッチ軸７、手首関節ヨー軸８の各々を表現する肩関節ピッチ軸アクチュエータＡ４、肩関節ロール軸アクチュエータＡ５、上腕ヨー軸アクチュエータＡ６、肘関節ピッチ軸アクチュエータＡ７、手首関節ヨー軸アクチュエータＡ８が配設されている。
【００６０】
また、脚部ユニット６０Ｒ／Ｌは、大腿部ユニット６１Ｒ／Ｌと、膝ユニット６２Ｒ／Ｌと、脛部ユニット６３Ｒ／Ｌに細分化されるが、股関節ヨー軸１１、股関節ピッチ軸１２、股関節ロール軸１３、膝関節ピッチ軸１４、足首関節ピッチ軸１５、足首関節ロール軸１６の各々を表現する股関節ヨー軸アクチュエータＡ１１、股関節ピッチ軸アクチュエータＡ１２、股関節ロール軸アクチュエータＡ１３、膝関節ピッチ軸アクチュエータＡ１４、足首関節ピッチ軸アクチュエータＡ１５、足首関節ロール軸アクチュエータＡ１６が配設されている。
【００６１】
各関節に用いられるアクチュエータＡ１，Ａ２，Ａ３…は、より好ましくは、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニット内に搭載したタイプの小型ＡＣサーボ・アクチュエータで構成することができる。
【００６２】
頭部ユニット３０、体幹部ユニット４０、腕部ユニット５０、各脚部ユニット６０などの各機構ユニット毎に、アクチュエータ駆動制御用の副制御部３５，４５，５５，６５が配設されている。
【００６３】
機体の体幹部４０には、加速度センサ９５と姿勢センサ９６が配設されている。加速度センサ９５は、Ｘ，Ｙ，Ｚ各軸方向に配置する。機体の腰部に加速度センサ９５を配設することによって、質量操作量が大きな部位である腰部を制御目標点として設定して、その位置における姿勢や加速度を直接計測して、ＺＭＰに基づく姿勢安定制御を行なうことができる。
【００６４】
また、各脚部６０Ｒ，Ｌには、接地確認センサ９１及び９２と、加速度センサ９３，９４がそれぞれ配設されている。接地確認センサ９１及び９２は、例えば足底に圧力センサを装着することにより構成され、床反力の有無により足底が着床したか否かを検出することができる。また、加速度センサ９３，９４は、少なくともＸ及びＹの各軸方向に配置する。左右の足部に加速度センサ９３，９４を配設することにより、ＺＭＰ位置に最も近い足部で直接ＺＭＰ方程式を組み立てることができる。
【００６５】
主制御部８０は、各センサ９１〜９６の出力に応答して制御目標をダイナミックに補正することができる。より具体的には、副制御部３５，４５，５５，６５の各々に対して適応的な制御を行ない、脚式移動ロボット１００の上肢、体幹、及び下肢が協調して駆動する全身運動パターンを実現する。
【００６６】
ロボット１００の機体上での全身運動は、足部運動、ＺＭＰ（Ｚｅｒｏ Ｍｏｍｅｎｔ Ｐｏｉｎｔ）軌道、体幹運動、上肢運動、腰部高さなどを設定するとともに、これらの設定内容に従った動作を指示するコマンドを各副制御部３５，４５，５５，６５に転送する。そして、各々の副制御部３５，４５…では、主制御部８１からの受信コマンドを解釈して、各アクチュエータＡ１，Ａ２，Ａ３…に対して駆動制御信号を出力する。ここで言う「ＺＭＰ」とは、歩行中の床反力によるモーメントがゼロとなる床面上の点のことであり、また、「ＺＭＰ軌道」とは、例えばロボット１００の歩行動作期間中にＺＭＰが動く軌跡を意味する。
【００６７】
Ｃ．アクチュエータ特性の制御
Ｃ−１．アクチュエータの動作速度、機械的受動性
本出願人に既に譲渡されている特願２００１−２３３６９１号明細書には、外界や作業対象に対して、閉リンク状態と開リンク状態の繰り替え動作を高速に行なう脚式移動ロボットについて開示されている。すなわち、１以上の回転型関節（１関節当り２自由度以上備えていてもよい）で構成される肢を持つロボットにおいて、各肢に動的閉合誤差を除去するに最低限必要な受動自由度（減速機のバックラッシュなど）を配し、さらに各肢の可動範囲を適切に管理する。たとえ、関節部を駆動するアクチュエータがトルク情報を取得する手段を持たない場合であっても、閉リンク状態と開リンク状態の高速切替え動作を安定に実現する。
【００６８】
これは、２足歩行ロボットにおいて、腰部基準座標に近い部位にバックラッシュ量が少ないギアードモータを配置、手先・足先に近い部位にバックラッシュ量が多いギアードモータを配置し最適な特性を得るというものである。そして、ロボットを最適化する第２の方法として、各関節軸アクチュエータにおける位置サーボ補償器の開ループ・ゲインを任意に調整することで、位置エラー偏差量を制御する。すなわち、バックラッシュ量が均一の場合にはサーボゲインの大小によるサーボ偏差をバックラッシュ量に見立て、それを制御する。
【００６９】
本実施形態では、このような脚式移動ロボットの最適化方法をさらに拡張し、サーボ制御器の比例ゲインだけでなく位相補償要素も関節各部位で調整する。
【００７０】
図５には、アクチュエータのサーボ制御器の構成を示している。同図に示すように、サーボ制御器は、直列補償の比例ゲインＫと位相補償要素Ｃ（ｓ）という２つの制御要素を持ち、比例ゲインだけでなく位相補償要素も関節各部位で調整する。また、図６には、図５に示したモータと減速機の伝達関数表現モデルのゲイン及び位相の周波数特性を示している。
【００７１】
ここで、位相補償要素は以下の式で表される。但し、ｎ、ｍは任意の自然数であり、また、ａｉ、ｂｉは任意の実数であり、状態変数を表現した場合はフィードバック・ゲインに相当する。また、ｓはラプラス演算子である。
【００７２】
【数１】
また、モータと減速器の伝達関数表現モデルＧ（ｓ）は以下の式で表される。但し、Ｋはモータ・ゲインであり、Ｊはモータの慣性モーメントであり、Ｄはモータの粘性抵抗係数である。
【００７４】
【数２】
まず、図５に示したサーボ制御器において、位相補償型制御の設計例として位相補償帯域を任意に選択する例（位相補償量が一定で周波数帯域を任意に選ぶ）について、図７を参照しながら説明する。同図において、
【００７６】
▲１▼Ｃ（ｓ）−１：１．０〜１００Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与えている。
▲２▼Ｃ（ｓ）−２：０．１〜１０Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与えている。
▲３▼Ｃ（ｓ）−３：１０〜１ｋＨｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与えている。
【００７７】
このように、位相補償を施す周波数帯域を任意に選択することで、アクチュエータの周波数特性を自在に設定することができる。したがって、このようなアクチュエータで構成されるロボットの関節軸は、機体の姿勢や動作の局面に応じて、周波数特性を動的に調整することができる。
【００７８】
なお、図７に示す例では、位相進み補償の例を示したが、位相遅れ補償場合も同様に任意の周波数帯域で任意の位相遅れ量を設定することができる。
【００７９】
次いで、図５に示したサーボ制御器において、位相補償型制御の設計例として位相補償を施す量を任意に選択する例（周波数帯域が一定で位相補償量を任意に選ぶ）について、図８を参照しながら説明する。同図において、
【００８０】
▲４▼Ｃ（ｓ）−４：４．０〜７０Ｈｚの帯域で約＋３．５ｄＢのゲイン増幅、約＋１２ｄｅｇの位相進みを与えている。
▲５▼Ｃ（ｓ）−５：２．０〜７０Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与えている。
▲６▼Ｃ（ｓ）−６：１．０〜７０Ｈｚの帯域で約＋６．５ｄＢのゲイン増幅、約＋２１ｄｅｇの位相進みを与えている。
【００８１】
このように、位相補償を施す量を任意に選択することで、アクチュエータの周波数特性を自在に設定することができる。したがって、このようなアクチュエータで構成されるロボットの関節軸は、機体の姿勢や動作の局面に応じて、周波数特性を動的に調整することができる。
【００８２】
なお、図８に示す例では、位相進み補償の例を示したが、位相遅れ補償の場合も同様に任意の周波数帯域で任意の位相遅れ量を設定することができる。
【００８３】
次いで、図５に示したサーボ制御器において、Ｋで示した直列補償ゲインの大小を変更する制御器の設計例について、図９を参照しながら説明する。同図は、図９において、Ｋを±３ｄＢだけ上下させたことに相当する。図示の通り、直列補償ゲインの大小も任意に設定することができる。
【００８４】
図７〜図９に示した内容をロボットの関節軸駆動用のアクチュエータに適用するためには、これらの制御器を構成するパラメータを動的又は静的に変更するための通信プロトコルを実装する。これによって、ロボットの各関節軸にさまざまな特性を与えることができる。
【００８５】
次いで、これらの特性を備えたアクチュエータのサーボ制御器を実装したときのアクチュエータの特性について説明する。
【００８６】
図１０には、図７に示したように位相補償量が一定で周波数帯域を任意に選ぶようにアクチュエータのサーボ制御器を実装したときの開ループ特性を示している。
【００８７】
▲１▼Ｃ（ｓ）−１：１．０〜１００Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与える
→ 全体的にゲインが高めとなるので、位置決め精度と追従性がよくなるが、エネルギーロスとなり易い。また、負荷が大きくなると不安定になる可能性がある。
▲２▼Ｃ（ｓ）−２：０．１〜１０Ｈｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与える
→ Ｃ（ｓ）−１とＣ（ｓ）−２の中間的な特性を持つ。
▲３▼Ｃ（ｓ）−３：１０〜１ｋＨｚの帯域で約＋５．６ｄＢのゲイン増幅、約＋１８ｄｅｇの位相進みを与える
→ 高域でのみ位相進み補償をしていることになるので、ゆっくりした動作時にはあまり効果が見られないが、走る、飛ぶ、踊るといった速い動作には効果がある。
【００８８】
このように、位相補償を施す周波数帯域を任意に選択することで、アクチュエータの周波数特性を自在に設定することができる。したがって、このようなアクチュエータで構成されるロボットの関節軸は、機体の姿勢や動作の局面に応じて、周波数特性を動的に調整することができる。
【００８９】
また、図１１には、図１０に示したうち高域でのみ位相進み補償を施した例Ｃ（ｓ）−３においてさらに直列補償ゲインの制御を採り入れた様子を示している。この場合、図５に示した例と同様に、同位相においてゲインが上下する。
【００９０】
図１０に示した例では、位相補償例Ｃ（ｓ）−３ではゆっくりした動作時にはあまり効果が見られないが、図１１に示すように、低周波数帯域においてゲインを増やすことにより、低周波数帯域での制御偏差を少なくすることができる。この結果、ゆっくりした動作時でも指令値に対して少ない遅れで応答することが可能となる。
【００９１】
以上、アクチュエータのサーボ制御器においてサーボ制御器の比例ゲインだけでなく位相補償要素も関節各部位で調整するメカニズムについて説明してきた。これによって、安定且つ高効率な動作を実現するには局所的に力を増減させることや関節各部位のコンプライアンス（機械的受動性）を増減させることが可能となる。
【００９２】
例えば、位置制御系として関節各軸の動作を捉えたときは高ゲイン且つ高帯域なサーボ制御器を使って、制御偏差が少なくなるように制御した方がよいが、力学モデルとして捉えたときはポテンシャル・エネルギーや運動エネルギの作用を考慮してゲインを低くしたり位相補償している周波数帯を上下させたりすることも同時に行なうとよい。
【００９３】
Ｃ−２．アクチュエータ・モータの粘性抵抗
上記のＣ−１項で説明したようなアクチュエータの動作速度や動作時の機械的受動性という特性に加え、アクチュエータの粘性抵抗を可変に制御するという方式を採り入れることができる。
【００９４】
例えば、コイルへの供給電流を制御して所定の磁束分布を形成することにより回転トルクを発生させるタイプのモータは、一般に、コイル端子を電源電圧に接続する第１のトランジスタ・スイッチ群と、コイル端子を接地する第２のトランジスタ・スイッチ群からなるスイッチング動作回路をＰＷＭ制御により駆動することによって、コイル電流を制御し、所望のトルク又は回転位置、回転速度などを得るようになっている。
【００９５】
ここで、モータ・コイルが非通電の期間においてオープン状態となるタイミングにおいて、モータ・コイルに通電された電流（厳密には電荷）が抜けてしまうため、トルクのロスになる。またコギングによるトルクむらの影響を受け易くなる。
【００９６】
このような場合、モータ・コイルが非通電の期間においても、コイルがオープン状態とならない短絡（ショート）状態を形成することにより、モータ・コイルに通電された電流（厳密には電荷）が抜けないようにすることができる。このとき、モータのコイルには、永久磁石側からの磁束密度により逆起電力が発生する。この逆起電力により、モータの回転方向の逆方向に力が作用するので、外力による回転に対する粘性抵抗を作り出すことができ、ブレーキに類似した効果を得ることができる。このようなモータへの粘性抵抗により、トルク・ロスがなくコギングによるトルクむらの影響が軽減される。
【００９７】
一方、モータの非通電時において、このようなコイルの短絡状態を形成した場合、上述したように、モータに一種の粘性抵抗を与えることができるが、このようなモータをロボットに使用した場合、コイル・ショートによるブレーキの影響のため、コンプライアンス（機械的受動性）がなくなってしまうという問題を招来する。
【００９８】
そこで、モータ・コイルの非通電時におけるコイルのオープン状態と短絡状態の期間の比率を、所望の機械的特性に応じて調整することにより、モータ・コイルがオープン状態となるタイミングにおけるモータ・コイルに通電された電流（厳密には電荷）が抜けてしまうことによるトルクのロスやコギングによるトルクむらの問題と、モータ・コイルの非通電時におけるコイル・ショートによるブレーキの影響のためコンプライアンス（機械的受動性）がなくなるという問題を、ともに解決することができる。
【００９９】
ここで、モータ・コイルの通電及び非通電状態の比率はＰＷＭ制御により実現することができるが、モータ・コイルの非通電状態におけるコイルのオープン状態と短絡状態の期間の比率も同様にＰＷＭ制御を用いて実現することができる。
【０１００】
図１２には、コイル電流の制御メカニズムを適用したＤＣモータのコイル電流供給用の電流制御回路の等価回路の構成例を示している。
【０１０１】
同図に示す電流制御回路は、フルブリッジ構成であり、ｐｎｐ型のトランジスタＡ’とｎｐｎ型のトランジスタＡを順方向接続した回路と、同じくｐｎｐ型のトランジスタＢ’とｎｐｎ型のトランジスタＢを順方向接続した回路を電源電圧ＶｃｃとグランドＧＮＤの間に並列接続し、さらにトランジスタＡ’及びＡの中間点とトランジスタＢ’及びＢの中間点を固定子の単相コイルで接続している。
【０１０２】
トランジスタＡ’及びＢをオンにするとともに、トランジスタＡ及びＢ’をオフにすることによって、モータ・コイルには、図示の矢印方向の電流Ｉｍが流れる。また、トランジスタＡ’及びＢをオフにすることによって、コイルはオープン状態となって、電流Ｉｍは流れなくなる。また、トランジスタＡ’及びＢをオフにするとともに、トランジスタＡ’及びＢ’をオンにすることによって、モータ・コイルは短絡（ショート）状態となる。
【０１０３】
ＰＷＭ制御論理回路は、図示しない中央制御部からの電流軸電流指令（又はトルク指令）に基づいてコイルへの電流指令を生成し、これら電流指令に基づいて各トランジスタをＰＷＭ方式にてスイッチング制御する。すなわち、トランジスタＡ’及びＢをオンにするとともにトランジスタＡ及びＢ’をオフにしてコイル電流Ｉｍを流す通電期間と、トランジスタＡ’及びＢをオフにしてコイルを非通電にする非通電期間を交互に生成する。
【０１０４】
付加論理回路は、さらにＰＷＭ制御論理回路が出力する信号Ａ０及びＡ０’、並びＢ０及びＢ０’をオン／オフ動作を制御する制御論理を付加論理により切り替える。これによって、モータ・コイルの非通電状態におけるコイルのオープン状態と短絡状態の切替動作を行なう。図１３には、付加論理回路の具体的な回路構成を示している。
【０１０５】
ＰＷＭ制御論理回路からのトランジスタＡ’制御用の信号Ａ０’とトランジスタＢ０’制御用の信号Ｂ０’の論理積と、トランジスタＡ制御用の信号Ａ０とトランジスタＢ制御用の信号Ｂ０の排他的論理和がとられ、さらにこれらの論理演算値の論理積を反転したものがＢＲＡＫＥ＿ＰＷＭ制御信号の反転信号と論理和される。この論理和の結果を元の各トランジスタ制御用信号との間で論理積を取ったものが、最終的なそれぞれのトランジスタ制御用信号となる。
【０１０６】
付加論理回路は、ＢＲＡＫＥ＿ＰＷＭ制御信号がハイ・レベルが入力されると、コイル非通電時にコイルを短絡させるようにトランジスタ制御用信号を切り替える。通常のコイル非通電時において、ＰＷＭ制御論理回路からは、制御信号Ａ０’及びＡ０をハイ、Ｂ０’及びＢ０をローにするトランジスタ制御用信号が出力される。これに対し、付加論理回路は、ハイ・レベルのＢＲＡＫＥ＿ＰＷＭ制御信号が入力されると、ハイ状態のＡ１’及びＡ１をローに転じて、コイルの短絡状態を形成する。
【０１０７】
一方、付加論理回路は、ＢＲＡＫＥ＿ＰＷＭ制御信号がロー状態のときには、コイル非通電時において、ＰＷＭ制御論理回路からのトランジスタ制御用信号をそのまま出力するので、非通電時におけるコイルはオープン状態となる。
【０１０８】
図１４には、ＰＷＭ制御により所定のデューティ比を持つＢＲＡＫＥ＿ＰＷＭ制御信号が入力されたときの付加論理回路の各トランジスタ制御用信号の出力特性を、コイル電流波形特性及びトルク出力特性とともに示している。
【０１０９】
コイル非通電時にコイルを短絡状態にすると、過渡応答により、コイル電流がゼロに戻るまでの時間が長くなるが、コイルをオープン状態にするとその時間は短くなる。コイル非通電時の過渡応答特性は、ＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比に従って、これらの特性が混合されたものとなる。
【０１１０】
したがって、同図に示すように、コイル通電とコイル短絡というスイッチング動作を繰り返した場合、コイル非通電時にコイル電流がゼロに戻る前に次の通電が開始される。このときのコイルの最大電流は、コイル通電及び非通電の動作の度に逐次上昇していくが、その上昇傾向はデューティ比すなわちＢＲＡＫＥ＿ＰＷＭ制御信号がハイ・レベルとなる比率にほぼ比例する。同様に、コイル電流の実効値は図示の通り徐々に増加していくことになるが、その上昇傾向はデューティ比すなわちＢＲＡＫＥ＿ＰＷＭ制御信号がハイ・レベルとなる比率にほぼ比例する。
【０１１１】
また、モータの出力トルクＴは、コイル電流にモータのトルク定数Ｋｔを乗じた値となるので（Ｔ＝Ｋｔ・Ｉ）、同図からも判るように、コイル通電及び非通電を繰り返したとき、コイル電流の増大に伴って、モータ・トルクの実効値は増大していく。このときの上昇傾向はＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比すなわち同制御信号がハイ・レベルとなる比率にほぼ比例する。モータ・トルクの出力が上昇していく特性が、モータの粘性係数に相当する。言い換えれば、ＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比によってモータの粘性抵抗を動的に制御することが可能である。その制御の関係を図２３に示す。
【０１１２】
このようにＰＷＭ制御論理回路が付加論理回路へ供給するＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比をＰＷＭ制御することにより、モータ・コイルの非通電時におけるコイルのオープン状態と短絡状態の期間の比率を、所望の機械的特性に応じて調整することができる。
【０１１３】
したがって、モータ・コイルがオープン状態となるタイミングにおけるモータ・コイルに通電された電流（厳密には電荷）が抜けてしまうことによるトルクのロスやコギングによるトルクむらの問題と、モータ・コイルの非通電時におけるコイル・ショートによるブレーキの影響のためコンプライアンス（機械的受動性）がなくなるという問題を、ともに解決することができる。
【０１１４】
なお、上記の説明ではＤＣモータを例にとって説明したが、３相モータやその他のコイルへの供給電流を制御して所定の磁束分布を形成することにより回転トルクを発生させるタイプのモータにおいても同様に、非通電時のモータ・コイルを間歇的にオープン状態及び短絡状態に切り替えることによって、モータの所望の粘性抵抗を得ることができる。
【０１１５】
Ｃ−３．脚式移動ロボットへの適用
次いで、本実施形態に係るアクチュエータのサーボ制御器の特性制御並びにアクチュエータ自体の特性制御のメカニズムを各関節部位に適用した２足歩行の脚式移動ロボットについて説明する。
【０１１６】
上述したように、アクチュエータのサーボ制御器において、比例ゲインと位相補償要素を調整することにより、ロボットの関節各部位において必要な位置決め精度、機械的受動性（コンプライアンス）、動作速度を任意に設定することができる。また、アクチュエータ・モータのコイルへの非通電時においてコイルを間歇的に短絡状態又はオープン状態に切り替えることによって、モータの粘性抵抗を調整し振動などの外乱に対するロバスト性を変更することができる。
【０１１７】
さらに、これらアクチュエータのサーボ制御器におけるゲイン及び位相補償制御とアクチュエータ・モータの粘性抵抗の制御とを組み合わせることによって、位置決め精度が重要な部分に適用することができるアクチュエータの周波数特性、あるいは速応性とコンプライアンスが重要となる部分に適用することができるアクチュエータの周波数特性を得ることができる。
【０１１８】
図１５には、位置決め精度が重要な部分に適用することができるアクチュエータの周波数特性を示している。
【０１１９】
この場合、サーボ制御器の比例ゲインを大きくとって、系全体のゲインを大きくし、低周波数帯域までゲインを取れるようにする。また、周波数特性を同図に示すように高域で位相進み量が小さくなるようにし、速応性にはあまり寄与しないが安定性を保証できるようにする。また、モータの粘性抵抗を大きくし、振動などの外乱にもロバストになるようにする。要言すれば、図示の特性は、位置決め精度を優先して振動などの外乱にもロバストな特性である。
【０１２０】
また、図１６には、速応性とコンプライアンスが重要となる部分に適用することができるアクチュエータの周波数特性を示している。
【０１２１】
この場合、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。要言すれば、図示の特性は、機械的受動性（コンプライアンス）と速応性を優先した特性である。
【０１２２】
図１〜３に示した脚式移動ロボットの関節自由度は、上述したサーボ制御器を備えたアクチュエータによって実現される。各関節部位において使用されるアクチュエータのゲイン・位相補償特性の基本的な制御例について、以下に詳解する。
【０１２３】
（１）首部分に適用されるアクチュエータの特性
首部分では、位置決め精度を優先させるため、比例ゲインを高く設定する。また、動作速度を保持しつつ、比例ゲインを上げた分の安定性を損なわないように、位相進み量を少なく設定する。また、胴体より下の部分の動作時に発生する振動外乱に対してロバスト性を得るため、関節の粘性抵抗を大きく設定する。
【０１２４】
（２）肩・肘部分に適用されるアクチュエータの特性
歩行やダンスなどの連続動作を行なうときは、位置決め特性よりも機械的受動性が高くなるような特性をアクチュエータに与える。動作に受動性を持たせるため、関節の粘性抵抗を小さくする。また、動作に受動性を持たせるとともに、エネルギ消費量を減らすため、比例ゲインを低く設定する。また、動作速度を大きくするため、位相進み補償を行なう周波数帯域を高く、位相進み量を大きく設定する。動作によっては振り子のように往復運動を行なうだけのときもある。そのときは、関節の粘性抵抗と比例ゲインを最小にして機械的受動性（コンプライアンス）を得るようにし、力学的なエネルギを動作のために用い易くする。
【０１２５】
一方、物を押したり引っ張ったりするなどの力を使う動作を行なうときには、負荷トルク値により、位置決め精度優先の特性と、機械的受動性の特性を動的に入れ替えるように制御する。負荷トルク値に対してさらに力を発生させたいときは比例ゲインを高く、関節の粘性抵抗を大きくする。また、負荷トルク値に対して定負荷となるように倣わせる動作をする場合には、上位からの位置指令値による調整に加え、アクチュエータ内部トルク・センサで検知した負荷トルクに応じて比例ゲインを低く、関節の粘性抵抗を小さくして、機械的受動性（コンプライアンス）を得るようにする。
【０１２６】
（３）体幹部分に適用されるアクチュエータの特性
自分自身の動作による振動外乱にロバスト性を得るため、関節の粘性抵抗を大きくする。あるいは、位置決め精度を優先させるため、比例ゲインを高く設定する。あるいは、動作速度を保持しつつ比例ゲインを上げた分の安定性を損なわないように、位相進み量を少なく設定する。
【０１２７】
（４）股関節部分に適用されるアクチュエータの特性
自分自身の動作による振動外乱にロバスト性を得るため、関節の粘性抵抗を大きくする。あるいは、位置決め精度を優先させるため、比例ゲインを高く設定する。あるいは、動作速度を保持しつつ比例ゲインを上げた分の安定性を損なわないように、位相進み量を少なく設定する。
【０１２８】
（５）膝部分に適用されるアクチュエータの特性
遊脚時及び着床瞬間時においては、位置決め精度よりも機械的受動性が高くなるような特性に制御する。動作に受動性を持たせるため、関節の粘性抵抗を小さくする。また、動作に受動性を持たせるとともにエネルギ消費量を減らすため、比例ゲインを低く設定する。また、動作速度を大きくするため、位相進み補償を行なう周波数領域を高く、位相進み量を大きく設定する。
【０１２９】
一方、支持脚時においては、機械的受動性よりも位置決め精度が高くなるような特性に制御する。自分自身の動作による振動外乱にロバスト性を得るため、関節の粘性抵抗を大きくする。あるいは、位置決め精度を優先させるため、比例ゲインを高く設定する。あるいは、動作速度を保持しつつ比例ゲインを上げた分の安定性を損なわないように、位相進み量を少なく設定する。
【０１３０】
（６）足首部分に適用されるアクチュエータの特性
遊脚時及び着床瞬間時においては、位置決め精度よりも機械的受動性が高くなるような特性に制御する。足首部分着床による衝撃を緩和するため、関節粘性を小さく設定し、機械的受動性（コンプライアンス）を得るようにする。また、足首部分着床による衝撃を緩和するため、比例ゲインを低く設定し、機械的受動性（コンプライアンス）を得るようにする。また、動作速度を大きくとるため、位相補償を行なう周波数領域を高く、位相進み量を大きく設定する。
【０１３１】
一方、支持脚時において、足首部分の発生トルクを大きくとり、且つ自分自身の動作による振動外乱にロバスト性を得るため、関節の粘性抵抗を大きくとる。また、足首部分の位置決め精度を向上させるため、比例ゲインを高く設定する。また、動作速度を保持しつつ、比例ゲインを上げた分の安定性を損なわないように位相進み量を少なく設定する。
【０１３２】
ここで、ロボットの動作段階に応じて関節アクチュエータの特性を切り替えることによる効果を、歩行動作を例にとって説明する。
【０１３３】
図１７には、脚式移動ロボットが歩行動作を行なう様子を段階毎に示している。同図に示す例では、歩行動作はＡ〜Ｇの７段階に区分され、歩行動作を継続するときは、この順番で歩容を繰り返し実行するようになっている。
【０１３４】
（１）肩〜腕の部分
Ａ〜Ｇで示すロボットの歩行動作中では、ロボットの基準座標のヨー軸周りの回転モーメントを補償するために、腕を振る動作を行なう。この腕を振る動作は、肩ピッチ軸を中心にした周期的な振り子運動になる。
【０１３５】
このような場合、動作初期に与えたトルクによって腕を振り上げるので、位置エネルギを得る。この位置エネルギは、腕を振り下ろすときには、エネルギ保存則により運動エネルギとなる。つまり、動作初期に与えたトルクで発生する位置エネルギは、振り子が降りる原理に従って、運動エネルギに変換されるというエネルギ変換が繰り返される。
【０１３６】
このような性質を積極的に利用すると、ロボットが位置制御に追従するために発生するトルク（すなわち、エネルギ消費）に力学的エネルギを加えることができるので、ロボット全体のエネルギ消費を節約することができる。
【０１３７】
具体的には、腕部分の運動エネルギが最大になるときに腕の主要部分（例えば、肩ピッチ軸、肘ピッチ軸など）が瞬間的にトルクを発生する。このときに関節の粘性抵抗が大きいと、動作中の損失が大きくなるのでよろしくない。また、粘性抵抗が小さくても、動作中の損失はゼロにはならないので、その損失分を補充する意味でも、瞬間的にトルクを発生させる必要がある。
【０１３８】
これらを１サーボ制御で実現するには、開ループ特性で低周波数帯域のゲインが低く、且つ、高周波数帯域での位相補償量を大きくしてゲインが高くなっている系が適している。これに加えて、粘性抵抗の制御により、モータの粘性係数を実現可能な最小値に設定することで、動作中のエネルギ損失を少なくすることが好ましい。
【０１３９】
図１６に示すアクチュエータの周波数特性は、このようなサーボ制御及びモータの粘性抵抗制御を実現するものである。したがって、歩行動作中の腕の動作に関わる関節部位のアクチュエータは、同図に示す特性に設定すればよい。
【０１４０】
（２）脚の部分
Ａ〜Ｇで示すロボットの歩行動作中では、ＺＭＰ規範の姿勢制御に則って脚の歩容を生成する。この脚の動作は、両脚支持期と、片足が支持脚で他の片足が遊脚となる片足支持期の繰り返しとなる。
【０１４１】
支持脚又は遊脚に関わらず、ロール軸方向はＺＭＰ軌道に追従するため、一サーボ制御系の高い位置決め精度が要求される。これはつまり、開ループ特性において、全周波数帯域において高ゲインであることが求められる。
【０１４２】
支持脚の各関節のピッチ軸は、ＺＭＰ軌道に追従するため、高い位置決め精度が要求される。同時に、振動などの外乱に対してロバストであることが求められる。したがって、これら２つの要求を満たすためには、支持脚の各関節のピッチ軸は、図１５に示す、サーボ制御器の比例ゲインを大きくとって、系全体のゲインを大きくし、低周波数帯域までゲインを取れるような特性が適している。また、モータの粘性抵抗を大きく設定することが適している。
【０１４３】
一方、遊脚時の膝ピッチ軸や足首ピッチ軸は、腕部と同様に、負利上げと振り下ろしの動作を交互に行なう。したがって、関節の粘性抵抗が小さいことが好ましい。同時に、開ループ特性において、低周波数帯域で定ゲイン、こう周波数帯域で位相補償量を大きくして高ゲインとなる、図１６に示す特性が適している。
【０１４４】
また、着床瞬間の足首ピッチ軸関節は、高い周波数の衝撃外乱が加わる。このときには、高周波数帯域での応答性が確保されていることが望ましい。また、このときには、低周波数帯域でのゲインが低いことが望ましい。同時に、関節粘性抵抗が小さいことが望ましい。したがって、着床瞬間の足首ピッチ軸関節は、図１６に示す特性が適している。
【０１４５】
Ｄ．床上姿勢からの起き上がりオペレーション
仰向け姿勢やうつ伏せ姿勢などの床上姿勢からの起動を行なうため、あるいは、転倒時に自立的に起き上がって作業を再開するという作業の自己完結性のために、脚式移動ロボット１００は、起き上がりオペレーションを実現することが必要である。
【０１４６】
このとき、無計画的な軌道により起き上がろうとすると、過大な外力モーメントが印加され、関節アクチュエータが高出力トルクを必要とする。この結果、モータの大型化が必要となり、その分駆動消費電力が増大してしまう。また、機体の重量が増すとともに製造コストが高騰してしまう。重量の増大によりさらに起き上がり動作が困難になる。あるいは、起き上がり動作の過程で発生する外力モーメントにより姿勢の安定性を維持することができず、そもそも起き上がることができない、という事態もあり得る。
【０１４７】
そこで、本実施形態では、脚式移動ロボット１００は、外力モーメントが最小となる動作パターンよりなる起き上がり動作を行なうこととした。これは、ＺＭＰ支持多角形が最小となるような姿勢を時系列的に組み合わせることによって、実現することができる。
【０１４８】
また、本実施形態に係る脚式移動ロボット１００は、肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４のように（図３を参照のこと）、高さ方向に複数のピッチ軸が直列的（但し横方向から眺めた場合）に連結されたリンク構造体である。そこで、これら複数の関節ピッチ軸４〜１４を所定のシーケンスで同期協調的に駆動して、ＺＭＰ支持多角形が最小となるような動作パターンによる起き上がり動作を実現することとした。
【０１４９】
Ｄ−１．基本仰向け姿勢からの起き上がりオペレーション
図１８には、本実施形態に係る脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて起き上がり動作を行なうための処理手順をフローチャートの形式で示している。このような処理手順は、実際には主制御部８１において所定の機体動作制御プログラムを実行して、各部を駆動制御することによって実現される。
【０１５０】
また、図１９には、本実施形態に係る脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて仰向け姿勢から起き上がり動作を行なう様子を、関節リンク・モデルで示している。但し、図示のリンク構造体において、体幹関節と股関節を連結するリンクに機体全体の重心位置が設定されており、このリンクを以下では「重心リンク」と呼ぶことにする。尚、「重心リンク」は狭義には上記のような定義で用いるが、広義には機体全体の重心位置が存在するリンクであればよい。例えば、体幹軸を持たないような機体においては、機体全体の重心が位置する体幹先端などを含むリンクがこれに該当する。また、図２０には、実機が仰向け姿勢から起き上がっていく様子を示している。
【０１５１】
以下、図１８に示したフローチャートを参照しながら、基本仰向け姿勢からの機体の起き上がりオペレーションについて説明する。
【０１５２】
まず、床上姿勢において、位置エネルギの最も小さい姿勢を探索する（ステップＳ１）。これは、基本仰向け姿勢に相当し、図１９（１）及び図２０（Ａ）に示すように、起き上がり動作に使用する肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４をそれぞれ連結するリンクはすべて接床している。このとき、位置エネルギの最も小さい姿勢をとることにより、路面の傾斜や形状を計測して、起き上がり動作が可能かどうかを確認することができる。
【０１５３】
この基本仰向け姿勢において、接床リンクが形成する接地多角形内で、最も狭い支持多角形を探索する（ステップＳ２）。このとき、機体の一端側から少なくとも２以上のリンクを離床させたときの、ＺＭＰ軌道が計画可能かどうかを判定する。ＺＭＰの計画可能性は、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断することができる。
【０１５４】
次いで、接地多角形のうち、最も狭い支持多角形に関与しない２以上のリンクを離床する（ステップＳ３）。
【０１５５】
ステップＳ３は、図１９（２）に相当する。実機上では、体幹関節と股関節を連結する重心リンクを含む下半身側が支持多角形として抽出され、それ以外の肩関節から体幹関節に至る２以上のリンクを支持多角形に関与しないリンクとして離床する。まず、図２０（Ｂ）に示すように左右の両腕部を持ち上げてから、体幹関節ピッチ軸アクチュエータＡ９の駆動により、図２０（Ｃ）に示すように上体起こしを行なっている。腕部を先に持ち上げておくことにより、モーメントを小さくして、必要な最大トルクを低減することができる。
【０１５６】
次いで、一端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する（ステップＳ４）。
【０１５７】
ステップＳ４は、図１９（３）及び図２０（Ｄ）に相当する。実機上では、肩関節を含む２以上のリンクが離床している状態で、肩関節ピッチ軸で屈曲させて、そのリンク端の端部である手先を接床させる。そして、手先を機体重心位置である体幹ピッチ軸側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成する。
【０１５８】
このときの実機では、左右の肩関節ロール軸Ａ５の駆動により、左右の腕部を真横に広げた後、上腕ヨー軸Ａ６の駆動により腕部の向きを一旦１８０度回転させてから、肩関節ピッチ軸Ａ４の駆動により、腕部を徐々に降下させていく。そして、手先を着床することによって、より狭い接地多角形を形成する。
【０１５９】
このように新しい接地多角形を形成すると、接地多角形にＺＭＰを設定することができるかどうかをチェックする（ステップＳ５）。これは、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。そして、ＺＭＰを接地多角形に移動して、新たな支持多角形を形成する（ステップＳ６）。
【０１６０】
ここで、支持多角形が充分狭くなったか否かを判断する（ステップＳ７）。この判断は、体幹ピッチ軸と股関節ピッチ軸を連結する重心リンクを離床可能であるか、若しくは、図２０（Ｅ）に示すように、足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させることができるかどうかを、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。
【０１６１】
まだ支持多角形が充分狭いとは言えない場合には、着床点を移動して支持多角形を小さくした後（ステップＳ１０）、ステップＳ２に戻って、より狭い支持多角形の形成を再試行する。そして、接床リンクが形成する接地多角形内で、最も狭い支持多角形を探索する（ステップＳ２）。今度は、機体の他端側から少なくとも２以上のリンクを離床させたときの、ＺＭＰが計画可能かどうかを判定する。ＺＭＰの計画可能性は、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断することができる。
【０１６２】
次いで、接床多角形のうち、最も狭い支持多角形に関与しない２以上のリンクを離床する（ステップＳ３）。これは、図１９（４）〜（５）に相当する。実機上では、膝関節ピッチ軸を含む他端側から連続する２以上のリンクを支持多角形に関与しないリンクとして離床する。そして、一端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する（ステップＳ４）。このとき、実機は、まず、右脚の股関節ピッチ軸Ａ１２の駆動により右脚を持ち上げてから、その膝関節アクチュエータＡ１４の駆動により右脚を屈曲させて、その足底を着床する。次いで、脚の股関節ピッチ軸Ａ１２の駆動により右脚を持ち上げてから、その膝関節アクチュエータＡ１４の駆動により左脚を屈曲させて、その足底を着床する。このようにして、足底を機体重心位置である股関節ピッチ軸１２側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成することができる。
【０１６３】
このように新しい接地多角形を形成すると、接地多角形にＺＭＰを設定することができるかどうかをチェックする（ステップＳ５）。これは、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。そして、ＺＭＰを接地多角形に移動して、新たな支持多角形を形成する（ステップＳ６）。
【０１６４】
ここで、支持多角形が充分狭くなったか否かを再び判断する（ステップＳ７）。この判断は、体幹ピッチ軸と股関節ピッチ軸を連結する重心リンクを離床可能であるか、若しくは足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させることができるかどうかを、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。図２０（Ｆ）に示す実機の姿勢では、充分狭い支持多角形が形成されていると判断される。支持多角形を縮小する際の腕の角度に関しては、肩の軸から床面方向に下ろした垂線と腕の中心軸がなす角度は、トルク量に基づく所定角度内であることが望ましい。
【０１６５】
そして、機体の支持多角形が充分に狭くなったことに応答して、支持多角形の両リンク端の端部を接床した状態で前記重心リンクを離床し、両リンク端の着床リンクによって形成される支持多角形内にＺＭＰを維持しながら、支持多角形を形成する両リンク端の端部の間隔を縮めて、ＺＭＰを前記リンク構造体の他端側に移動させていく（ステップＳ８）。これは、図１９（６）〜（７）に相当する。実機上では、図２０（Ｇ）〜（Ｈ）に示すように、接地多角形の両リンク端の端部としての手先及び足底を接床した状態で体幹ピッチ軸及び股関節ピッチ軸を連結した前記重心リンクを離床し、さらに、手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かって移動させていく。
【０１６６】
そして、前記リンク構造体の他端から第２の所定数以下の接床リンクのみで形成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま前記リンク構造体の一端側から第１の所定数以上のリンクを離床して、該離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる（ステップＳ９）。これは、図１９（８）に相当する。
【０１６７】
実機上では、図２０（Ｈ）〜（Ｉ）に示すように、足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、肩ピッチ軸４から膝ピッチ軸１４に至までのリンクを離床して、離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる。
【０１６８】
起き上がりの最終段階である、離床リンクを長さ方向に伸展する際には、質量操作量のより大きな膝関節ピッチ軸を積極的に使用して動作することが、機体動作上の効率がよい。
【０１６９】
なお、ステップＳ３において、最も小さい支持多角形に関与しない２以上のリンクを離床することができない場合には、最大の支持多角形より内側の２以上の着床リンクを離床することを試みる（ステップＳ１１）。
【０１７０】
ステップＳ１１を実行できない場合には、起き上がり動作を中止する。また、ステップＳ１１を成功裏に実行することができる場合には、さらに、着床点を移動させて、支持多角形をさらに小さくする（ステップＳ１２）。
【０１７１】
ステップＳ１２を実行できない場合には、起き上がり動作を中止する。また、ステップＳ１２を成功裏に実行することができる場合には、足部で形成できる安定領域にＺＭＰを移動することができるかどうかをチェックする（ステップＳ１３）。この安定領域内にＺＭＰを移動することができない場合には、ステップＳ１１に戻って、支持多角形を小さくするための同様の処理を繰り返し実行する。また、この安定領域内にＺＭＰを移動させることができた場合には、ステップＳ８に進んで、基本姿勢への復帰動作を行なう。
【０１７２】
図２０に示す実機動作例では、Ａ〜Ｉの９段階に分けて起き上がり動作状況を捉えることができる。
【０１７３】
（Ａ）仰向けの基本姿勢
姿勢制御されている状態であり、すべての関節部位のアクチュエータが図１５に示す周波数特性に設定されている。この場合、サーボ制御器の比例ゲインを大きくとって、系全体のゲインを大きくし、低周波数帯域までゲインを取れるようにする。また、周波数特性を同図に示すように高域で位相進み量が小さくなるようにし、速応性にはあまり寄与しないが安定性を保証できるようにする。また、モータの粘性抵抗を大きくし、振動などの外乱にもロバストになるようにする。この結果、機体全体として、位置決め精度を優先して振動などの外乱にもロバストとなる。
【０１７４】
（Ｂ）両腕を上方向に上げる
体幹関節と股関節を連結する重心リンクを含む下半身側が支持多角形として抽出され、それ以外の肩関節から体幹関節に至る２以上のリンクを支持多角形に関与しないリンクとして離床する。このとき、肩ヨー軸、肘ピッチ軸など離床動作に関わる関節部位では、より狭い接地多角形を形成するために接床するまでの期間中、速応性とコンプライアンスが重要となる。そこで、これらの関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０１７５】
（Ｃ）両腕と体幹の相対角度を保持しながら体幹を起こす
左右の両腕部を持ち上げてから、上体起こしを行なる。腕部を先に持ち上げておくことにより、モーメントを小さくして、必要な最大トルクを低減することができる。このとき、関節部位のアクチュエータ特性を特に変更する必要はない。
【０１７６】
（Ｄ）両腕を後方に移動させる
肩関節を含む２以上のリンクが離床している状態で、肩関節ピッチ軸で屈曲させて、そのリンク端の端部である手先を接床させる。そして、手先を機体重心位置である体幹ピッチ軸側に徐々に近づけていくことによって、元の床上姿勢よりも狭い接地多角形を形成する。
【０１７７】
このとき、肩ピッチ軸などの離床動作に関わる関節部位では、より狭い接地多角形を形成するために接床するまでの期間中、速応性とコンプライアンスが重要となるので、この関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０１７８】
そして、両腕を移動して後方で着床した後は、肩ピッチ軸、肩ヨー軸、肘ピッチ軸など、最も狭い支持多角形を探索する動作を行なう関節部位のアクチュエータを図１５に示す周波数特性に設定し、支持多角形の大きさの精度を確保するための位置決め精度を優先して、振動などの外乱にもロバストにする。
【０１７９】
（Ｅ）片足ずつ膝を曲げて脚底を体幹に近づける
支持多角形を十分狭くするために、足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させる。このとき、足首ロール軸及び足首ピッチ軸などの離床動作に関わる各関節部位では、より狭い接地多角形を形成するために接床するまでの期間中、速応性とコンプライアンスが重要となるので、これらの関節部位のアクチュエータを図１６に示す周波数特性に設定する。すなわち、これら比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０１８０】
（Ｆ）両足の脚底が体幹に近づいた５点支持の状態にする
充分狭い支持多角形が形成されている状態で、足首ロール軸及び足首ピッチ軸など最も狭い支持多角形を探索する動作を行なう関節部位のアクチュエータを図１５に示す周波数特性に戻し、支持多角形の大きさの精度を確保するための位置決め精度を優先して、振動などの外乱にもロバストにする。
【０１８１】
（Ｇ）脚・体幹・肩を使い、腕と脚の４点支持の状態になって起き上がる
接地多角形の両リンク端の端部としての手先及び足底を接床した状態で体幹ピッチ軸及び股関節ピッチ軸を連結した前記重心リンクを離床し、さらに、手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かって移動させていく。このとき、足首ピッチ軸などの離床した関節部位では、より狭い接地多角形を形成するために、速応性とコンプライアンスが重要となるので、この関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０１８２】
（Ｈ）腕を離床させ、脚で２点支持の状態にする
足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、肩ピッチ軸４から膝ピッチ軸１４に至までのリンクを離床して、離床リンクを長さ方向に伸展する。このとき、足首ピッチ軸を図１５に示す周波数特性に戻し、伸展動作と２点支持状態での姿勢安定制御を強化するために、位置決め精度を優先するとともに振動などの外乱にもロバストにする。
【０１８３】
（Ｉ）基本姿勢に移行する
基本的な立ち姿勢で姿勢制御されている状態であり、すべての関節部位のアクチュエータが図１５に示す周波数特性に設定される。すなわち、関節部位のアクチュエータを低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めを可能にし、直立姿勢に復帰したときの姿勢安定制御を実現することができる。
【０１８４】
以上説明してきたように、機体が仰向け姿勢から起き上がり動作を行なう際、アクチュエータの特性を図１５に示すように低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めが可能となる。したがって、（Ａ）〜（Ｉ）の全般で、動作制御の精度が向上するので、支持多角形の大きさの精度を確保することができる。
【０１８５】
また、アクチュエータの特性を図１６に示すように低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくするように設定することで、該当する関節部位に機械的受動性（コンプライアンス）と速応性を与えることができる。したがって、（Ｂ）〜（Ｄ）、（Ｅ）〜（Ｆ）、（Ｇ）〜（Ｈ）の状態遷移のときに、腕や脚の動作や着床動作が円滑になるとともにエネルギ消費を少なくすることができる。
【０１８６】
Ｄ−２．基本うつ伏せ姿勢からの起き上がりオペレーション
図２１には、本実施形態に係る脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて起き上がり動作を行なう様子を、関節リンク・モデルで示している。
【０１８７】
本実施形態に係る脚式移動ロボット１００は、基本的には、仰向け姿勢から起き上がる場合と同様に、図１８にフローチャートの形式で示した処理手順に従って、うつ伏せ姿勢からも起き上がることができる。以下、図１８に示したフローチャートを参照しながら、基本うつ伏せ姿勢からの機体の起き上がりオペレーションについて説明する。
【０１８８】
まず、床上姿勢において、位置エネルギの最も小さい姿勢をとる（ステップＳ１）。これは、基本うつ伏せ姿勢に相当し、図２１（１）及び図２２（Ａ）に示すように、起き上がり動作に使用する肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４をそれぞれ連結するリンクはすべて接床している。
【０１８９】
この基本うつ伏せ姿勢において、接床リンクが形成する接地多角形内で、最も狭い支持多角形を探索する（ステップＳ２）。このとき、機体の一端側から少なくとも２以上のリンクを離床させたときの、ＺＭＰが計画可能かどうかを判定する。ＺＭＰの計画可能性は、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断することができる。
【０１９０】
次いで、接地多角形のうち、最も狭い支持多角形に関与しない２以上のリンクを離床する（ステップＳ３）。ステップＳ３は、図２１（２）に相当する。実機上では、体幹関節と股関節を連結する重心リンクを含む下半身側が支持多角形として抽出され、それ以外の肩関節から体幹関節に至る２以上のリンクを支持多角形に関与しないリンクとして離床する。まず、左右の両腕部の肩ロール軸アクチュエータＡ５を作動させて、床面に摺って肩ロール軸回りに略９０度だけ旋回させ、次いで、上腕ヨー軸アクチュエータＡ６を作動させて、各腕部を上腕ヨー軸回りに略１８０度だけ回転させる。そして、図２２（Ｂ）に示すようにさらに肩ロール軸アクチュエータＡ５を作動させて、摺って肩ロール軸回りに略９０度だけ旋回させて、図２２（Ｃ）に示すように左右の腕部を頭部の側面まで移動する。
【０１９１】
次いで、一端側から１以上の離床リンクを屈曲させてリンク端の端部を着床させて、より狭い接地多角形を形成する（ステップＳ４）。ステップＳ４は、図２１（３）図２２（Ｄ）に相当する。
【０１９２】
そして、新しい接地多角形を形成すると、接地多角形にＺＭＰを設定することができるかどうかをチェックする（ステップＳ５）。これは、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。そして、ＺＭＰを接地多角形に移動して、新たな支持多角形を形成する（ステップＳ６）。実機上では、図２２（Ｄ）に示すように、肘ピッチ軸７を固定させて、左右の腕部を真直ぐ伸ばしたままの状態で、今度は肩ピッチ軸アクチュエータＡ４、体幹ピッチ軸アクチュエータＡ９、股関節ピッチ軸Ａ１２、並びに膝関節ピッチ軸アクチュエータＡ１４を作動させて、手先と左右の両膝が接地した閉リンク姿勢からなる支持多角形を形成する。
【０１９３】
まだ支持多角形が充分狭いとは言えない場合には、着床点を移動して支持多角形を小さくする（ステップＳ１０）。実機上では、図２２（Ｅ）に示すように、左右の腕部をまっすぐに保ったまま、手先を他方の着床点である足底側に徐々に近づけていくことによって、より狭い支持多角形を形成していく。
【０１９４】
ここで、支持多角形が充分狭くなったか否かを判断する（ステップＳ７）。この判断は、体幹ピッチ軸と股関節ピッチ軸を連結する重心リンクを離床可能であるか、若しくは、足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させることができるかどうかを、リンク構造体の可動角、リンクを接続する各関節アクチュエータのトルク、関節力、角速度、角加速度などを考慮して判断する。
【０１９５】
そして、機体の支持多角形が充分に狭くなったことに応答して両リンク端の着床リンクによって形成される支持多角形内にＺＭＰを維持しながら、支持多角形を形成する両リンク端の端部の間隔を縮めて、ＺＭＰを前記リンク構造体の他端側に移動させていく（ステップＳ８）。これは、図２１（６）〜（７）に相当する。実機上では、図２２（Ｇ）〜（Ｈ）に示すように、接地多角形の両リンク端の端部としての手先及び足底を接床した状態で、さらに手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かって移動させていく。
【０１９６】
そして、前記リンク構造体の他端から第２の所定数以下の接床リンクのみで形成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま前記リンク構造体の一端側から第１の所定数以上のリンクを離床して、該離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる（ステップＳ９）。これは、図１９（８）に相当する。
【０１９７】
実機上では、図２２（Ｈ）〜（Ｉ）に示すように、足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、肩ピッチ軸４から膝ピッチ軸１４に至までのリンクを離床して、離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる。
【０１９８】
起き上がりの最終段階である、離床リンクを長さ方向に伸展する際には、質量操作量のより大きな膝関節ピッチ軸を積極的に使用して動作することが、機体動作上の効率がよい。
【０１９９】
図２２に示す実機動作例では、Ａ〜Ｇの７段階に分けて起き上がり動作状況を捉えることができる。
【０２００】
（Ａ）うつ伏せの基本姿勢
姿勢制御されている状態であり、すべての関節部位のアクチュエータが図１５に示す周波数特性に設定されている。この場合、サーボ制御器の比例ゲインを大きくとって、系全体のゲインを大きくし、低周波数帯域までゲインを取れるようにする。また、周波数特性を同図に示すように高域で位相進み量が小さくなるようにし、速応性にはあまり寄与しないが安定性を保証できるようにする。また、モータの粘性抵抗を大きくし、振動などの外乱にもロバストになるようにする。この結果、機体全体として、位置決め精度を優先して振動などの外乱にもロバストとなる。
【０２０１】
（Ｂ）両腕を頭上方向に向けて横側から動かす
体幹関節と股関節を連結する重心リンクを含む下半身側が支持多角形として抽出され、それ以外の肩関節から体幹関節に至る２以上のリンクを支持多角形に関与しないリンクとして離床する。そして、肩ロール軸アクチュエータＡ５を作動させて、摺って肩ロール軸回りに略９０度だけ旋回させて、各腕部を頭部の側面まで移動する。このとき、肩ヨー軸、肩ピッチ軸など離床・旋回動作に関わる関節部位では、より狭い接地多角形を形成するために接床するまでの期間中、速応性とコンプライアンスが重要となる。そこで、これらの関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０２０２】
（Ｃ）両腕を頭上方向に上げる
左右の両腕部を頭部の側面まで移動する。このとき、関節部位のアクチュエータ特性を特に変更する必要はない。
【０２０３】
（Ｄ）両腕を使って４点支持の状態にし、ＺＭＰを足の接地面に近づける
肘ピッチ軸７を固定させて、左右の腕部を真直ぐ伸ばしたままの状態で、今度は肩ピッチ軸アクチュエータＡ４、体幹ピッチ軸アクチュエータＡ９、股関節ピッチ軸Ａ１２、並びに膝関節ピッチ軸アクチュエータＡ１４を作動させて、手先と左右の両膝が接地した閉リンク姿勢からなるより狭い接地多角形を形成する。このとき、肩ロール軸及び肩ピッチ軸など最も狭い支持多角形を探索する動作を行なう関節部位のアクチュエータを、図１５に示す周波数特性に戻し、支持多角形の大きさの精度を確保するための位置決め精度を優先して、振動などの外乱にもロバストにする。
【０２０４】
（Ｅ）ＺＭＰが足の接地面で構成される支持多角形内に入るように姿勢制御する右の腕部をまっすぐに保ったまま、手先を他方の着床点である足底側に徐々に近づけていくことによって、より狭い支持多角形を形成し、足部だけで形成できるＺＭＰ安定領域内にＺＭＰを移動させることができるようにする。このとき、関節部位のアクチュエータ特性を特に変更する必要はない。
【０２０５】
（Ｆ）両腕を離床し２点支持の状態にする
接地多角形の両リンク端の端部としての手先及び足底を接床した状態で、さらに手先及び足底の間隔を徐々に縮めていき、ＺＭＰを足底に向かって移動させていく。そして、足底で構成される接地多角形内にＺＭＰが突入したことに応答して、ＺＭＰを該接地多角形内に収容したまま、肩ピッチ軸４から膝ピッチ軸１４に至までのリンクを離床して、離床リンクを長さ方向に伸展することによって、起き上がり動作を完結させる。
【０２０６】
このとき、足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸では、より狭い接地多角形を形成するために、速応性とコンプライアンスが重要となるので、この関節部位のアクチュエータを、図１６に示す周波数特性に設定する。すなわち、比例ゲインを小さくして、系全体のゲインを小さくすることで、低周波数帯域のゲインを小さくし、機械的受動性（コンプライアンス）を得易くする。また、周波数特性を同図に示すように中高域で位相進み量が大きくなるようにし、速応性を得るようにする。また、モータの粘性抵抗を小さくし、機械的受動性（コンプライアンス）を得易いようにする。
【０２０７】
そして、両腕を離床し２点支持の状態になった後は、足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸のアクチュエータを図１５に示す周波数特性に設定し、伸展動作と２点支持状態での姿勢安定制御を強化するために、位置決め精度を優先するとともに振動などの外乱にもロバストにする。
【０２０８】
（Ｇ）基本姿勢に移行する
基本的な立ち姿勢で姿勢制御されている状態であり、すべての関節部位のアクチュエータが図１５に示す周波数特性に設定される。すなわち、関節部位のアクチュエータを低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めを可能にし、直立姿勢に復帰したときの姿勢安定制御を実現することができる。
【０２０９】
以上説明してきたように、機体がうつ伏せ姿勢から起き上がり動作を行なう際、アクチュエータの特性を図１５に示すように低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくするように設定することで、高精度な位置決めが可能となる。したがって、（Ａ）〜（Ｉ）の全般で、動作制御の精度が向上するので、支持多角形の大きさの精度を確保することができる。
【０２１０】
また、アクチュエータの特性を図１６に示すように低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくするように設定することで、該当する関節部位に機械的受動性（コンプライアンス）と速応性を与えることができる。したがって、（Ｂ）〜（Ｄ）、（Ｅ）〜（Ｆ）の状態遷移のときに、腕や脚の動作や着床動作が円滑になるとともにエネルギ消費を少なくすることができる。
【０２１１】
［追補］
以上、特定の実施例を参照しながら、本発明について詳解してきた。しかしながら、本発明の要旨を逸脱しない範囲で当業者が該実施例の修正や代用を成し得ることは自明である。
【０２１２】
本発明の要旨は、必ずしも「ロボット」と称される製品には限定されない。すなわち、電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置であるならば、例えば玩具等のような他の産業分野に属する製品であっても、同様に本発明を適用することができる。
【０２１３】
また、本明細書中では、モータ・コイルへのコイル電流のスイッチング制御にバイポーラ・トランジスタからなるスイッチング素子を用いて構成される回路例について説明したが、ＭＯＳ−ＦＥＴやその他の半導体素子を用いてこの種の制御回路を実装することができることは、当業者には自明である。
【０２１４】
要するに、例示という形態で本発明を開示してきたのであり、本明細書の記載内容を限定的に解釈するべきではない。本発明の要旨を判断するためには、冒頭に記載した特許請求の範囲の欄を参酌すべきである。
【０２１５】
【発明の効果】
以上詳記したように、本発明によれば、仰向けやうつ伏せなどの床上姿勢から自律的に立ち姿勢を回復することができる、優れた脚式移動ロボットを提供することができる。
【０２１６】
また、本発明によれば、うつ伏せ又は仰向けの姿勢からの起き上がり動作を始めとしてさまざまな動作の実行時においてアクチュエータそのものの特性とアクチュエータの制御器の特性の２つを動的又は静的に制御することにより安定且つ高効率な動作を実現することができる、優れた脚式移動ロボットを提供することができる。
【図面の簡単な説明】
【図１】本発明の実施に供される脚式移動ロボットが直立している様子を前方から眺望した様子を示した図である。
【図２】本発明の実施に供される脚式移動ロボットが直立している様子を後方から眺望した様子を示した図である。
【図３】脚式移動ロボットが具備する関節自由度構成を模式的に示した図である。
【図４】脚式移動ロボット１００の制御システム構成を模式的に示した図である。
【図５】アクチュエータのサーボ制御器の構成を示した図である。
【図６】図５に示したモータと減速機の伝達関数表現モデルゲイン及び位相の周波数特性を示した図である。
【図７】図５に示したサーボ制御器において、位相補償型制御の設計例として位相補償帯域を任意に選択する例を説明するための図である。
【図８】図５に示したサーボ制御器において、位相補償型制御の設計例として位相補償を施す量を任意に選択する例を説明するための図である。
【図９】図５に示したサーボ制御器において、Ｋで示した直列補償ゲインの大小を変更する制御器の設計例を説明するための図である。
【図１０】図７に示したように位相補償量が一定で周波数帯域を任意に選ぶようにアクチュエータのサーボ制御器を実装したときの開ループ特性を示した図である。
【図１１】図１０に示したうち高域でのみ位相進み補償を施した例Ｃ（ｓ）−３においてさらに直列補償ゲインの制御を採り入れた様子を示した図である。
【図１２】コイル電流の制御メカニズムを適用したＤＣモータのコイル電流供給用の電流制御回路の等価回路の構成例を示した図である。
【図１３】付加論理回路の具体的な回路構成を示した図である。
【図１４】ＰＷＭ制御により所定のデューティ比を持つＢＲＡＫＥ＿ＰＷＭ制御信号が入力されたときの付加論理回路の各トランジスタ制御用信号の出力特性を、コイル電流波形特性及びトルク出力特性とともに示した図である。
【図１５】位置決め精度が重要な部分に適用することができるアクチュエータの周波数特性を示した図である。
【図１６】速応性とコンプライアンスが重要となる部分に適用することができるアクチュエータの周波数特性を示した図である。
【図１７】脚式移動ロボットが歩行動作を行なう様子を段階毎に示した図である。
【図１８】脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて起き上がり動作を行なうための処理手順を示したフローチャートである。
【図１９】脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて仰向け姿勢から起き上がり動作を行なう様子を、関節リンク・モデルで示した図である。
【図２０】実機が仰向け姿勢から起き上がっていく様子を示した図である。
【図２１】脚式移動ロボット１００が肩関節ピッチ軸４、体幹ピッチ軸９、股関節ピッチ軸１２、膝関節ピッチ軸１４を同期強調的に駆動させて起き上がり動作を行なう様子を、関節リンク・モデルで示した図である。
【図２２】実機がうつ伏せ姿勢から起き上がっていく様子を示した図である。
【図２３】ＢＲＡＫＥ＿ＰＷＭ制御信号のデューティ比によってモータの粘性抵抗を動的に制御する制御の関係を示した図である。
【符号の説明】
１…首関節ヨー軸
２Ａ…第１の首関節ピッチ軸
２Ｂ…第２の首関節（頭）ピッチ軸
３…首関節ロール軸
４…肩関節ピッチ軸
５…肩関節ロール軸
６…上腕ヨー軸
７…肘関節ピッチ軸
８…手首関節ヨー軸
９…体幹ピッチ軸
１０…体幹ロール軸
１１…股関節ヨー軸
１２…股関節ピッチ軸
１３…股関節ロール軸
１４…膝関節ピッチ軸
１５…足首関節ピッチ軸
１６…足首関節ロール軸
３０…頭部ユニット，４０…体幹部ユニット
５０…腕部ユニット，５１…上腕ユニット
５２…肘関節ユニット，５３…前腕ユニット
６０…脚部ユニット，６１…大腿部ユニット
６２…膝関節ユニット，６３…脛部ユニット
８０…制御ユニット，８１…主制御部
８２…周辺回路
９１，９２…接地確認センサ
９３，９４…加速度センサ
９５…姿勢センサ
９６…加速度センサ
１００…脚式移動ロボット
Claims (5)
- 複数の可動脚を含む複数の関節部位で構成される脚式移動ロボットであって、各関節部位におけるアクチュエータのサーボ制御器のゲイン及び位相補償制御とアクチュエータ・モータの粘性抵抗の制御とを組み合わせて行なうアクチュエータ特性制御手段と、
機体の寝姿勢からの起き上がり動作を制御する起き上がり動作制御手段とを備え、
前記アクチュエータ特性制御手段は、起き上がり動作の各段階毎に、各関節部位のアクチュエータを、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性と、低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくする第２のアクチュエータ特性との間で切り替える、
ことを特徴とする脚式移動ロボット。 - 前記脚式移動ロボットの機体は略平行な関節自由度を持つ複数の関節軸を長さ方向に連結したリンク構造体で構成され、
前記起き上がり動作制御手段は、
機体の重心となる重心リンクを含む２以上のリンクが接床した床上姿勢において、接床リンクが形成する接地多角形内において最も少ないリンク数で形成される最も狭い支持多角形を探索する手段と、
接地多角形中の前記探索された支持多角形以外の接床リンクを離床させる手段と、
２以上の連続する離床リンクを屈曲させ、そのリンク端の端部を接床させて、より狭い接地多角形を形成する手段と、
支持多角形が充分狭くなったことに応答して、前記リンク構造体の一端側から第１の所定数以上のリンクを離床して機体を直立させる手段と、
を備えることを特徴とする請求項１に記載の脚式移動ロボット。 - 前記アクチュエータ特性制御手段は、機体の起き上がり動作の各段階において、最も狭い支持多角形の探索に関与する接床リンクの各関節部位のアクチュエータの特性を、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に設定する、
ことを特徴とする請求項２に記載の脚式移動ロボット。 - 前記アクチュエータ特性制御手段は、機体の起き上がり動作の各段階において、支持多角形に関与しない離床リンクの各関節部位のアクチュエータの特性を、より狭い接地多角形を形成するために接床するまでの期間中、低域ゲインを小さく、位相進み量を大きく、関節の粘性抵抗を小さくした第２のアクチュエータ特性から、接床後は低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に切り替える、
ことを特徴とする請求項２に記載の脚式移動ロボット。 - 前記アクチュエータ特性制御手段は、支持多角形が充分狭くなったことに応答して機体を直立させる動作に関わる各関節部位のアクチュエータの特性を、低域ゲインを大きく、位相進み量を小さく、関節の粘性抵抗を大きくする第１のアクチュエータ特性に設定する、
ことを特徴とする請求項２に記載の脚式移動ロボット。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003039560A JP2004249374A (ja) | 2003-02-18 | 2003-02-18 | 脚式移動ロボット |
| US10/732,446 US7072740B2 (en) | 2002-12-16 | 2003-12-11 | Legged mobile robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003039560A JP2004249374A (ja) | 2003-02-18 | 2003-02-18 | 脚式移動ロボット |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2004249374A true JP2004249374A (ja) | 2004-09-09 |
Family
ID=33023706
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003039560A Pending JP2004249374A (ja) | 2002-12-16 | 2003-02-18 | 脚式移動ロボット |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2004249374A (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005144624A (ja) * | 2003-11-18 | 2005-06-09 | Sony Corp | 脚式移動ロボット |
| CN108042143A (zh) * | 2017-12-15 | 2018-05-18 | 西安交通大学 | 一种基于改进的zmp理论的人体失衡监测方法 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH05245780A (ja) * | 1992-03-04 | 1993-09-24 | Honda Motor Co Ltd | 脚式移動ロボットの制御装置 |
| JPH10309684A (ja) * | 1997-05-07 | 1998-11-24 | Yaskawa Electric Corp | マニピュレータのコンプライアンス制御方式 |
| JP2001198870A (ja) * | 2000-01-21 | 2001-07-24 | Yaskawa Electric Corp | ロボットの制御装置 |
| JP2002283276A (ja) * | 2001-03-21 | 2002-10-03 | Daihen Corp | 多関節ロボットにおける衝突検出・停止制御法 |
| JP2004174652A (ja) * | 2002-11-26 | 2004-06-24 | Toyota Motor Corp | Ｚｍｐ補償制御のゲインを変化させながら歩行するロボット |
| JP2004174653A (ja) * | 2002-11-26 | 2004-06-24 | Toyota Motor Corp | 倒立振子制御のゲインを静止時に下げる歩行ロボット |
-
2003
- 2003-02-18 JP JP2003039560A patent/JP2004249374A/ja active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH05245780A (ja) * | 1992-03-04 | 1993-09-24 | Honda Motor Co Ltd | 脚式移動ロボットの制御装置 |
| JPH10309684A (ja) * | 1997-05-07 | 1998-11-24 | Yaskawa Electric Corp | マニピュレータのコンプライアンス制御方式 |
| JP2001198870A (ja) * | 2000-01-21 | 2001-07-24 | Yaskawa Electric Corp | ロボットの制御装置 |
| JP2002283276A (ja) * | 2001-03-21 | 2002-10-03 | Daihen Corp | 多関節ロボットにおける衝突検出・停止制御法 |
| JP2004174652A (ja) * | 2002-11-26 | 2004-06-24 | Toyota Motor Corp | Ｚｍｐ補償制御のゲインを変化させながら歩行するロボット |
| JP2004174653A (ja) * | 2002-11-26 | 2004-06-24 | Toyota Motor Corp | 倒立振子制御のゲインを静止時に下げる歩行ロボット |
Non-Patent Citations (1)
| Title |
|---|
| 近藤直樹: "超音波モータを使用したダイレクトドライブマニピュレータの制御", 愛知工業大学研究報告 Ｂ 専門関係論文集, vol. 第３１号Ｂ, JPN4007018907, March 1996 (1996-03-01), JP, pages 29 - 34, ISSN: 0000896025 * |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005144624A (ja) * | 2003-11-18 | 2005-06-09 | Sony Corp | 脚式移動ロボット |
| CN108042143A (zh) * | 2017-12-15 | 2018-05-18 | 西安交通大学 | 一种基于改进的zmp理论的人体失衡监测方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US7366587B2 (en) | Legged mobile robot | |
| US7072740B2 (en) | Legged mobile robot | |
| JP3555107B2 (ja) | 脚式移動ロボット及び脚式移動ロボットの動作制御方法 | |
| JP3824608B2 (ja) | 脚式移動ロボット及びその動作制御方法 | |
| KR100687461B1 (ko) | 로보트 및 로보트용 관절 장치 | |
| KR101809972B1 (ko) | 보행 로봇 및 그 제어방법 | |
| WO2004041484A1 (ja) | ロボット装置、ロボット装置の運動制御装置及び運動制御方法 | |
| KR20010050543A (ko) | 로봇의 이동 제어 장치 및 이동 제어 방법 | |
| JP2004167666A (ja) | ロボット装置及びその動作制御方法 | |
| JP2004181600A (ja) | 脚式移動ロボット | |
| JP4086765B2 (ja) | ロボット装置 | |
| JP4289446B2 (ja) | 脚式移動ロボット | |
| JP3674779B2 (ja) | 脚式移動ロボットのための動作制御装置及び動作制御方法、並びにロボット装置 | |
| JP2004195554A (ja) | 脚式移動ロボット | |
| JP2004249374A (ja) | 脚式移動ロボット | |
| JP4115374B2 (ja) | ロボット装置 | |
| JP4587699B2 (ja) | ロボット装置及びその制御方法 | |
| JP4770990B2 (ja) | 脚式移動ロボット及びその制御方法 | |
| JP2001157972A (ja) | 脚式移動ロボット | |
| KR101607573B1 (ko) | 인간과 유사한 이족 보행을 위한 인간형 로봇의 하지 관절궤적 생성 방법 | |
| JP2004181613A (ja) | ロボット装置、脚式移動ロボットの動作制御装置及び動作制御方法、脚式移動ロボットのためのセンサ・システム、並びに移動体装置 | |
| JP2004181599A (ja) | 脚式移動ロボット | |
| JP3568527B2 (ja) | 移動体装置 | |
| JP4352774B2 (ja) | 脚式歩行ロボットの運動制御装置及び運動制御方法 | |
| JP3555947B2 (ja) | 移動ロボット装置、移動ロボット装置の制御方法、移動ロボット装置の運動パターン生成方法、並びに移動ロボット装置の運動制御プログラム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060220 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070918 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20080129 |