JP3672101B2 - 脚式移動ロボットの歩容生成装置 - Google Patents

脚式移動ロボットの歩容生成装置 Download PDF

Info

Publication number
JP3672101B2
JP3672101B2 JP2003557765A JP2003557765A JP3672101B2 JP 3672101 B2 JP3672101 B2 JP 3672101B2 JP 2003557765 A JP2003557765 A JP 2003557765A JP 2003557765 A JP2003557765 A JP 2003557765A JP 3672101 B2 JP3672101 B2 JP 3672101B2
Authority
JP
Japan
Prior art keywords
gait
reaction force
floor reaction
trajectory
target
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Lifetime
Application number
JP2003557765A
Other languages
English (en)
Other versions
JPWO2003057424A1 (ja
Inventor
透 竹中
隆志 松本
孝英 吉池
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Publication of JPWO2003057424A1 publication Critical patent/JPWO2003057424A1/ja
Application granted granted Critical
Publication of JP3672101B2 publication Critical patent/JP3672101B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00—Manipulators mounted on wheels or on carriages
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members

Description

【０００１】
【発明の属する技術分野】
本発明は、脚式移動ロボットの歩行のみならず、走行にも適した歩容生成装置に関する。
【０００２】
【従来の技術】
脚式移動ロボット、例えば２足移動ロボットの移動動作を行なわせるための歩容（目標歩容）の生成は、従来、主にロボットにスムーズな歩行動作を行なわせる歩容（歩行歩容）を生成することを主目的として行なわれてきた。しかし、近年では、脚式移動ロボットの開発が進むにつれて、該ロボットに歩行だけでなく、走行も行なわせることができる歩容を生成することが望まれている。さらには、十分な摩擦力を発生できない滑りやすい床（いわゆる低ミュー路）上でもロボットを支障なく移動させることができる歩容を生成することが望まれている。
【０００３】
なお、「歩容」という漢字に「歩」が入っているので歩行に限定されると誤解されやすいが、本来「歩容」とは、トロットなど、馬の走行形態を指す言葉として用いられているように、走行も含んだ概念である。
【０００４】
ここで、歩行と走行の特徴の違いを説明しておく。
同時に全脚が空中に存在する瞬間がある移動形態を走行と定義することが一般的ではある。しかし、この定義によって歩行と走行が明確に区別できるとは限らない。たとえば、速いジョギングでは、ほとんどの人間において、同時に全脚が空中に存在する瞬間があるが、遅いジョギングでは、かなりの人間において、常にいずれかの脚が接地している。速いジョギングは走行であるのに遅いジョギングは歩行である、と定義するのは、感覚的に少し無理がある。
【０００５】
図４８に、典型的な走行における上体鉛直位置と床反力鉛直成分（左右の脚に作用する床反力鉛直成分の和）のパターンを示し、図４９には、典型的な歩行における上体鉛直位置と床反力鉛直成分のパターンを示す。
【０００６】
なお、上体鉛直位置速度は、上体代表点の鉛直位置とその速度を意味する。上体水平位置速度は、上体代表点の水平位置とその速度を意味する。上体鉛直位置速度と上体水平位置速度を合わせて、上体位置速度と呼ぶ。
【０００７】
また、「床反力鉛直成分」は、厳密には、床反力の鉛直軸まわりのモーメント成分と区別するために、「並進床反力鉛直成分」と記述すべきであるが、言葉が長くなるので、ここでは「並進」を省略する。
【０００８】
まず上体の動きを見てみると、歩行においては、支持脚の上を上体が通過する瞬間に上体は最も高く、走行においては、この瞬間に最も低い。すなわち、歩行と走行では、上体の上下動パターンの位相が反転している。
【０００９】
一方、床反力に関しては、歩行では比較的一定であるのに対し、走行においては、大きく変動し、支持脚の上を上体が通過する瞬間に床反力は最も大きい。また、当然のことながら、同時に全脚が空中に存在する瞬間において床反力は０になっている。より詳しく観察すると、走行では、支持脚を縮めた量にほぼ比例した大きさの床反力が発生する。言い換えると、走行では、脚をばねのように使って跳ねながら移動していると言える。
【００１０】
遅いジョギングでは、典型的な走行と同じ上体上下動の位相を持つ。また、遅いジョギングでは、同時に全脚が空中に存在する瞬間がない場合が多いが、その場合でも、支持脚と遊脚の切り換えが行われる瞬間において、床反力は、完全には０にならないがほぼ０になっている。
【００１１】
従って、以上のように、上体の上下動や床反力のパターンの上記特徴から歩行と走行を区別した方が、遅いジョギングも走行とみなされ、感覚とも一致して、より適切と言えよう。
【００１２】
特に、最も特徴的な点で両者を区別するならば、走行とは、支持脚の切り換えが行われる瞬間において、床反力が０又はほぼ０になる移動形態であり、歩行は、それ以外の移動形態（床反力鉛直成分が比較的一定）であると言えよう。
【００１３】
一方、本出願人は先に、脚式移動ロボットの床反力を含む歩容を、動力学的平衡条件（目標歩容の重力と慣性力と床反力との釣り合い条件のことである。狭義では、目標歩容の運動による重力と慣性力の合力が目標ＺＭＰまわりに作用するモーメントが０であること。詳細は後述する。）をほぼ満足しながら、自在かつリアルタイムに生成する技術を先に提案した（例えば、特許文献１参照）。この場合、この技術では、所定期間分の目標歩容、具体的には１歩分の目標歩容である今回歩容を新たに生成するとき、この今回歩容を定常歩容に連続させ、若しくは近づけるように生成することで、歩容の継続的な安定性を確保するようにしている。なお、定常歩容は、詳細は後述するが仮想的な周期的歩容であり、上体の位置が脚体先端部（足平）の位置から水平方向に大きくずれるような発散を生じることのない歩容である。
【００１４】
この技術や、本出願人が提案してきた一連の脚式移動ロボットの制御装置は、歩行のみならず走行にも適用できるものである（例えば、特許文献２，３参照）。
【００１５】
【特許文献１】
国際公開ＷＯ０２／４０２２４号公報
【特許文献２】
特開平１０− ８６０８１号公報
【特許文献３】
特開平１０−２７７９６９号公報
【００１６】
【発明が解決しようとする課題】
しかしながら、これらの技術においては、目標歩容の床反力水平成分（厳密には、床反力の水平軸まわりのモーメント成分と区別するために、「並進床反力水平成分」と記述すべきであるが、「床反力鉛直成分」と同様、「並進」を省略する。）の大きさを考慮していなかったので、目標歩容の床反力水平成分が過大となって、摩擦の限界を超えて、スリップするおそれがあった。
【００１７】
より詳細には、前記特許文献１の実施形態においては、重力と慣性力との合力が元々の目標ＺＭＰまわりに発生するモーメントが０又はほぼ０になるように目標歩容の上体水平加速度を調整している。この結果、全体重心水平加速度は従属的に決定され、これに釣り合う床反力水平成分も従属的に決定される。この場合、摩擦係数の高い床面を歩行する場合（この場合、少なくとも１つの脚体は常時接地している）には、床反力鉛直成分が常にほぼ自重相当であるので、摩擦力（すなわち床反力水平成分）の限界が高い。このため、上記のごとく上体水平加速度を調整して歩容を生成してもスリップは発生しにくい。
【００１８】
しかるに、走行においては、床反力鉛直成分が０に近くなる時があるので、その時には、たとえ摩擦係数が高くとも、床面摩擦力若しくは床反力水平成分（詳しくは並進床反力水平成分）の限界が０に近くなる。従って、上記のごとく目標歩容の上体水平加速度を調整すると、目標歩容の床反力水平成分が限界を超え、スリップして転倒するおそれがあった。
【００１９】
また、歩行の場合でも、床の摩擦係数が低い場合には、スリップして転倒するおそれがあった。
【００２０】
さらに、走行においては、多くの場合、床反力鉛直成分が完全に０になる時があり、この時には、摩擦力（床反力水平成分）も０になるので、全体重心水平加速度は０（等速運動）とならざるを得なくなる。従って、目標歩容の上体水平加速度を調整することができないので、前記特許文献１の実施形態においては、重力と慣性力の合力が目標ＺＭＰまわりに発生するモーメントを０にすることもできない。つまり走行時に動力学的平衡条件を満足することができなかった。
【００２１】
従って、本発明の目的は、歩行、走行等の歩容形態や床面の摩擦状態によらずに、より一層好適にロボットの継続的に安定した移動を可能とする歩容を生成することができる歩容生成装置を提供することにある。
【００２２】
より具体的には、本発明は、摩擦力若しくは床反力水平成分の限界を考慮し、スリップ及びそれに起因する転倒を防止しつつ、ロボットの継続的に安定した移動を行なうことが可能な歩容を生成できる歩容生成装置を提供することを目的とする。そして、空中時、あるいは摩擦力若しくは床反力水平成分の限界が極めて低い時にでも、動力学的平衡条件を満足する歩容の運動パターンを生成できる歩容生成装置を提供することを目的とする。
【００２３】
【課題を解決するための手段】
本発明の脚式移動ロボットの歩容生成装置は、上体から延設された複数の脚体を運動させて移動する脚式移動ロボットの目標歩容を所定期間分の歩容ずつ生成すると共に、新たに生成しようとする所定期間分の目標歩容である今回歩容を生成するとき、その今回歩容に続く仮想的な周期的歩容としての定常歩容に該今回歩容を連続させ、又は近づけるように該今回歩容を生成する歩容生成装置において、前記今回歩容で前記ロボットに作用させる並進床反力の水平成分又は該並進床反力の床面平行成分又は該ロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分の許容範囲を設定する許容範囲設定手段と、前記今回歩容の仮目標床反力作用点軌道とその作用点回りに発生する床反力モーメントの水平成分の目標軌道である仮目標床反力モーメント軌道とを決定する仮目標床反力決定手段と、少なくとも並進床反力と床反力モーメントとの発生比率が互いに異なるロボットの２つの運動モードを合成してなる仮目標運動軌道を、該仮目標運動に応じて発生する並進床反力の水平成分又は該並進床反力の床面平行成分又は該ロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分が前記許容範囲を逸脱する可能性が高いものとしてあらかじめ定めた第１所定期間では、並進床反力の水平成分又は該並進床反力の床面平行成分又は該ロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分を前記許容範囲内に制限しつつ、前記仮目標運動に応じて生じるロボットの慣性力と重力との合力が前記仮目標床反力作用点回りに発生するモーメントの水平成分が前記仮目標床反力モーメントに一致するという動力学的平衡条件を満たすように決定すると共に、該並進床反力の水平成分又は該並進床反力の床面平行成分又は該ロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分が前記許容範囲を逸脱する可能性が低いものとしてあらかじめ定めた第２所定期間では、少なくとも前記２つの運動モードのうちの１つの運動モードの運動を調整することによって前記動力学的平衡条件を満たすように決定する仮目標運動決定手段と、前記今回歩容の終了時刻における前記仮目標運動軌道の状態に基づいて、該今回歩容の２つの運動モードの運動を前記定常歩容の運動に連続させ、又は近づけるように前記第２所定期間における仮目標運動と、前記仮目標床反力作用点及び仮目標床反力モーメントのうちの少なくともいずれかとを修正して、今回歩容における前記２つの運動モードの目標運動軌道と目標床反力作用点軌道と目標床反力モーメント軌道とを決定する歩容修正手段とを備えたことを特徴とする（第１発明）。
【００２４】
なお、本発明（第１発明以外の発明を含む）において、前記並進床反力の水平成分又は該並進床反力の床面平行成分（詳しくは床面に平行な成分）又はロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分は、いずれも摩擦力に比例若しくはほぼ比例するものである。そこで、以下の説明では、便宜上、これらを総称的に摩擦力成分ということがある。
【００２５】
かかる本発明（第１発明）では、前記第１所定期間、すなわち前記摩擦力成分が許容範囲を逸脱する可能性が高い期間（該許容範囲が小さい期間）では、該摩擦力成分を許容範囲内に制限しつつ、前記動力学的平衡条件を満たすように前記２つの運動モードの仮目標運動が決定される。この場合、摩擦力成分を許容範囲内に制限するということは、ロボットの水平方向若しくは床面に平行な方向の慣性力を発生させる運動（例えば上体等の水平加減速運動）を制限することを意味する。従って、上記仮目標運動は、このような運動を制限しつつ、前記仮目標床反力作用点回りのモーメントに関する前記動力学的平衡条件を満たすように決定されなければならない。この場合、前記２つの運動モードの運動は、並進床反力と床反力モーメントとの発生比率が互いに異なるので、それらの運動モードの仮運動を適切に調整して決定することで、上記の許容範囲の条件（ロボットの水平方向若しくは床面に平行な方向の慣性力を発生させる運動の制限）と、動力学的平衡条件とを満たすような仮目標運動を決定できる。なお、水平方向若しくは床面に平行な方向の慣性力を発生させる運動を制限した場合、例えばロボットの重心回りの角運動量変化率を変化させるような運動（例えば上体の姿勢変化運動）を調整することで、前記動力学的平衡条件を満たすようにすることが可能である。
【００２６】
そして、本発明（第１発明）では、前記第２所定期間、すなわち前記摩擦力成分が許容範囲を逸脱する可能性が低い期間（該許容範囲が十分に大きい期間）では、少なくとも前記２つの運動モードのうちの１つの運動モードの運動を調整することによって前記動力学的平衡条件を満たすように仮目標運動が決定される。なお、第２所定期間は、許容範囲が広い期間であるので、前記第１所定期間の同じアルゴリズムで、仮目標運動を決定するようにしても、基本的には前記摩擦力成分が許容範囲を越えることがない。従って、第２所定期間おいて、第１所定期間と同様に、摩擦力成分の許容範囲を考慮したアルゴリズム（第１所定期間での仮目標歩容の決定アルゴリズムと同様のアルゴリズム）によって、仮目標歩容を決定するようにしてもよい。
【００２７】
上記のように決定された仮目標運動では、前記第１所定期間において、前記許容範囲による運動制限が行なわれるため、一般には、定常歩容に連続し、又は近づくようなものとはならない。このため、本発明では、十分な摩擦力を確保できる前記第２所定期間において、前記今回歩容の終了時刻における前記仮目標運動軌道の状態に基づいて、前記仮目標運動と、前記仮目標床反力作用点及び仮目標床反力モーメントのうちの少なくともいずれかとを修正して、前記目標運動軌道、目標床反力作用点軌道及び目標床反力モーメント軌道を決定する。これにより、定常歩容に連続し、又は近づくような目標運動軌道を生成することができる。
【００２８】
かかる第１発明では、上記のように目標運動軌道等が決定されるため、動力学的平衡条件を満たしながら、前記摩擦力成分が許容範囲内に収まり、且つ、定常歩容に連続し又は近づくような今回歩容を生成できる。
【００２９】
この場合、本発明では、前記許容範囲は、任意に所望の許容範囲を設定できるので、歩容形態や床が発生し得る摩擦力を考慮して該許容範囲を設定すればよい。その許容範囲は０（許容範囲の上限値及び下限値が共に０）であってもよい。例えばロボットの全脚体が空中に存する時期を有する走行歩容では、その空中期における許容範囲は０に設定すればよい。
【００３０】
従って、本発明によれば、スリップ及びそれに起因する転倒を防止しつつ、ロボットを継続的に安定して移動させることが可能な歩容を生成できる。そして、空中時、あるいは摩擦力若しくは床反力水平成分の限界が極めて低い時にでも、動力学的平衡条件を満足し得る歩容の運動パターンを生成できる。ひいては、歩行、走行等の歩容形態や床面の摩擦状態によらずに、より一層好適に、ロボットの継続的な安定した移動を行なうことが可能な歩容を生成することができる。
【００３１】
かかる本発明（第１発明）では、前記仮目標床反力作用点軌道は、その作用点回りに発生する前記仮目標床反力モーメントの水平成分を零とする床反力作用点の軌道であることが好ましい（第２発明）。
【００３２】
これによれば、前記仮目標床反力モーメントを０として、前記仮目標運動軌道を決定できるので、仮目標運動軌道の決定処理が容易になる。なお、この場合、前記歩容修正手段による修正処理においては、目標床反力モーメントを仮目標床反力モーメントと同じ０にしてもよい（この場合、仮目標床反力作用点軌道が修正されて目標ＺＭＰ軌道が得られる）が、仮目標床反力モーメントを０と異なるものに修正したり、あるいは、仮目標床反力モーメントの修正と合わせて仮目標床反力作用点を修正してもよい。
【００３３】
上記第１、第２発明では、前記２つの運動モードは、例えばロボットの上体の姿勢変化運動の運動モードと、上体の並進運動の運動モードとからなることが好ましい。そして、この場合、前記仮目標運動決定手段は、前記第２所定期間では、上体の並進運動を調整することによって前記動力学的平衡条件を満たすように前記仮目標運動軌道を決定することが好ましい（第３発明）。
【００３４】
すなわち、上体の姿勢変化運動を調整したときには、並進床反力の変化に対して床反力モーメントを変化を大きくすることができ、上体の並進運動を調整したときには床反力モーメントの変化に対して並進床反力の変化を比較的大きくすることができる。従って、前記第１所定期間においては、前記許容範囲の条件と動力学的平衡条件との両者を満足するための仮目標運動を、ロボットの全体の急激な姿勢変化等を伴うことなく決定できる。そして、前記第２所定期間では、上体の並進運動を調整することで、上体の過剰な姿勢変化を抑えた仮目標運動を決定できる。その結果、定常歩容に連続し、又は近づくような目標運動を見出すことが容易になる。
【００３５】
この第３発明では、前記仮目標運動決定手段と前記歩容修正手段とのそれぞれの処理は、少なくとも前記上体の姿勢変化運動に対応するフライホイールの回転運動と前記上体の並進運動に対応する上体質点の並進運動と床反力との関係を表す動力学モデルを用いて実行されることが好ましい（第４発明）。
【００３６】
これによれば、上体の運動（姿勢変化運動（回転運動）及び並進運動）と床反力との関係は、フライホイールの回転運動と床反力との関係、並びに上体質点の並進運動と床反力との関係に分離でき、それらの関係の線形結合によって上体の運動と床反力との関係を表現することができる。その結果、前記仮目標運動決定手段及び歩容生成手段の処理に要する演算量を少なくできる。なお、上記動力学モデルには、例えば各脚体の運動に対応する脚体質点の並進運動と床反力との関係が含まれていてもよい。
【００３７】
また、上記第１〜第４発明では、前記歩容修正手段は、前記仮目標床反力作用点軌道及び仮目標床反力モーメント軌道のうち、修正対象の仮目標軌道の修正量パターンを規定する所定のパラメータの値を決定し、その決定したパラメータにより定まるパターンの修正量を前記修正対象の仮軌道に加えることにより該修正対象の目標軌道を決定することが好ましい（第５発明）。
【００３８】
これによれば、前記修正対象の仮目標軌道（仮目標床反力作用点軌道又は仮目標床反力モーメント軌道）を修正する際には、前記パラメータの値を決定することで前記修正量パターンを決定することができるので、その修正量の算出や、仮目標軌道の修正が容易になる。この場合、例えば前記修正量パターンの概略的な形状（台形状等）をあらかじめ定めておき、その高さや変曲点のタイミングを前記パラメータとして決定するようにすればよい。
【００３９】
前記第１〜第５発明では、前記目標歩容はロボットの少なくとも一つの脚体を着地させる着地期と、全ての脚体を空中に浮かせる空中期とを交互に繰り返す歩容であり、前記許容範囲は、少なくとも前記空中期では零に設定される（第６発明）。
【００４０】
これにより、今回歩容の着地期はもちろん、空中期における運動も適切に決定できる。
【００４１】
この第６発明では、前記仮目標床反力作用点軌道とこれを前記歩容修正手段により修正してなる目標床反力作用点軌道とは、前記着地期及び空中期を合わせた全期間で実質的に連続して変化するように決定することが好ましい（第７発明）。
【００４２】
これによれば、前記仮目標運動の決定や該仮目標運動の修正で必要となる動力学モデルによらずに、挙動の急変を生じない仮目標運動や目標運動を決定できる。
【００４３】
また、以上説明した第１〜第７発明では、前記許容範囲は、直交する２方向のそれぞれの許容範囲が互いに独立に設定されることが好ましい（第８発明）。
【００４４】
これによれば、上記２方向の各方向毎に、前記仮運動の修正を行なうことができ、その修正処理が容易になる。
【００４５】
【発明の実施の形態】
以下、添付図面を参照して本発明の一実施形態に係る脚式移動ロボットの歩容生成装置及び制御装置を説明する。なお、本発明の実施形態では、脚式移動ロボットとしては２足移動ロボットを例にとる。
【００４６】
図１は、本実施形態に係る歩容生成装置及び制御装置が適用される脚式移動ロボットとしての２足移動ロボットの全体的構成の概略を示す概略図である。
【００４７】
図示の如く、２足移動ロボット（以下、ロボットという）１は上体２４から下方に延設された左右一対の脚体（脚部リンク）２，２を備える。両脚体２，２は同一構造であり、それぞれ６個の関節を備える。その６個の関節は上体２４側から順に、股（腰部）の回旋（回転）用（上体２４に対するヨー方向の回転用）の関節１０Ｒ，１０Ｌ（符号Ｒ、Ｌはそれぞれ右側脚体、左側脚体に対応するものであることを意味する符号である。以下同じ）と、股（腰部）のロール方向（Ｘ軸まわり）の回転用の関節１２Ｒ，１２Ｌと、股（腰部）のピッチ方向（Ｙ軸まわり）の回転用の関節１４Ｒ，１４Ｌと、膝部のピッチ方向の回転用の関節１６Ｒ，１６Ｌと、足首のピッチ方向の回転用の関節１８Ｒ，１８Ｌと、足首のロール方向の回転用の関節２０Ｒ，２０Ｌとから構成される。
【００４８】
各脚体２の足首の２つの関節１８Ｒ（Ｌ），２０Ｒ（Ｌ）の下部には、各脚体２の先端部を構成する足平（足部）２２Ｒ（Ｌ）が取着されると共に、両脚体２，２の最上位には、各脚体２の股の３つの関節１０Ｒ（Ｌ），１２Ｒ（Ｌ），１４Ｒ（Ｌ）を介して前記上体（基体）２４が取り付けられている。上体２４の内部には、詳細を後述する制御ユニット２６などが格納されている。なお、図１では図示の便宜上、制御ユニット２６を上体２４の外部に記載している。
【００４９】
上記構成の各脚体２においては、股関節（あるいは腰関節）は関節１０Ｒ（Ｌ），１２Ｒ（Ｌ），１４Ｒ（Ｌ）から構成され、膝関節は関節１６Ｒ（Ｌ）から構成され、足関節（足首関節）は関節１８Ｒ（Ｌ），２０Ｒ（Ｌ）から構成される。また股関節と膝関節とは大腿リンク２８Ｒ（Ｌ）で連結され、膝関節と足関節とは下腿リンク３０Ｒ（Ｌ）で連結される。
【００５０】
なお、図示は省略するが、上体２４の上部の両側部には左右一対の腕体が取り付けられると共に、上体２４の上端部には頭部が配置される。これらの腕体及び頭部は、本発明の要旨と直接的な関連を有しないので詳細な説明は省略するが、各腕体は、それに備える複数の関節によって、該腕体を上体２４に対して前後に振る等の運動を行なうことが可能となっている。
【００５１】
各脚体２の上記構成により、各脚体２の足平２２Ｒ（Ｌ）は、上体２４に対して６つの自由度を与えられている。そして、ロボット１の移動に際して両脚体２，２を合わせて６*２＝１２個（この明細書で「*」はスカラに対する演算においては乗算を示し、ベクトルに対する演算においては外積を示す）の関節を適宜な角度で駆動することで、両足平２２Ｒ，２２Ｌの所望の運動を行なうことができる。これによりロボット１は任意に３次元空間を移動することができる。
【００５２】
なお、この明細書で後述する上体２４の位置及び速度は、上体２４の所定位置、具体的には上体２４のあらかじめ定めた代表点（例えば左右の股関節の間の中央点等）の位置及びその移動速度を意味する。同様に、各足平２２Ｒ，２２Ｌの位置及び速度は、各足平２２Ｒ，２２Ｌのあらかじめ定めた代表点の位置及びその移動速度を意味する。この場合、本実施形態では各足平２２Ｒ，２２Ｌの代表点は、例えば各足平２２Ｒ，２２Ｌの底面上（より具体的には各脚体２の足首関節の中心から各足平２２Ｒ，２２Ｌの底面への垂線が該底面と交わる点等）に設定される。
【００５３】
図１に示す如く、各脚体２の足首関節１８Ｒ（Ｌ），２０Ｒ（Ｌ）の下方には足平２２Ｒ（Ｌ）との間に公知の６軸力センサ３４が介装されている。該６軸力センサ３４は、各脚体２の足平２２Ｒ（Ｌ）の着地の有無、及び各脚体２に作用する床反力（接地荷重）などを検出するためのものであり、該床反力の並進力の３方向成分Ｆｘ，Ｆｙ，Ｆｚ並びにモーメントの３方向成分Ｍｘ，Ｍｙ，Ｍｚの検出信号を制御ユニット２６に出力する。また、上体２４には、Ｚ軸（鉛直方向（重力方向））に対する上体２４の傾き（姿勢角）とその角速度とを検出するための傾斜センサ３６が設置され、その検出信号が該傾斜センサ３６から制御ユニット２６に出力される。また、詳細構造の図示は省略するが、ロボット１の各関節には、それを駆動するために電動モータ３２（図３参照）と、その電動モータ３２の回転量（各関節の回転角）を検出するためのエンコーダ（ロータリエンコーダ）３３（図３参照）とが設けられ、該エンコーダ３３の検出信号が該エンコーダ３３から制御ユニット２６に出力される。
【００５４】
図２に示すように、各足平２２Ｒ（Ｌ）の上方には、前記６軸力センサ３４との間にばね機構３８が装備されると共に、足底（各足平２２Ｒ（Ｌ）の底面）にはゴムなどからなる足底弾性体４０が貼られている。これらのばね機構３８及び足底弾性体４０によりコンプライアンス機構４２が構成されている。ばね機構３８は具体的には、足平２２Ｒ（Ｌ）の上面部に取り付けられた方形状のガイド部材（図示せず）と、足首関節１８Ｒ（Ｌ）（図２では足首関節２０Ｒ（Ｌ）を省略している）及び６軸力センサ３４側に取り付けられ、前記ガイド部材内に弾性材（ゴムやばね）を介して微動自在に収納されるピストン状部材（図示せず）とから構成されている。
【００５５】
図２に実線で表示された足平２２Ｒ（Ｌ）は、床反力を受けていないときの状態を示している。各脚体２が床反力を受けると、コンプライアンス機構４２のばね機構３８と足底弾性体４０とがたわみ、足平２２Ｒ（Ｌ）は図中に点線で例示したような位置姿勢に移る。このコンプライアンス機構４２の構造は、着地衝撃を緩和するためだけでなく、ロボット１の制御性を高めるためにも重要なものである。なお、その詳細は本出願人に先に提案した特開平５−３０５５８４号に記載されているので、詳細な説明は省略する。
【００５６】
さらに、図１では図示を省略するが、ロボット１の外部には、該ロボット１の操縦用のジョイスティック（操作器）４４（図３参照）が設けられ、そのジョイスティック４４を操作することで、直進移動しているロボット１を旋回させるなど、ロボット１の歩容に対する要求を必要に応じて制御ユニット２６に入力できるように構成される。この場合、入力できる要求は、例えばロボット１の移動時の歩容形態（歩行、走行等）、遊脚の着地位置姿勢や着地時刻、あるいはこれらの着地位置姿勢や着地時刻を規定する指令データ（例えばロボット１の移動方向、移動速度等）である。
【００５７】
図３は制御ユニット２６の構成を示すブロック図である。該制御ユニット２６はマイクロコンピュータにより構成されており、ＣＰＵからなる第１の演算装置６０及び第２の演算装置６２、Ａ／Ｄ変換器５０、カウンタ５６、Ｄ／Ａ変換器６６、ＲＡＭ５４、ＲＯＭ６４、並びにこれらの間のデータ授受を行なうバスライン５２を備えている。この制御ユニット２６では、前記各脚体２の６軸力センサ３４、傾斜センサ３６、ジョイスティック４４等の出力信号はＡ／Ｄ変換器５０でデジタル値に変換された後、バスライン５２を介してＲＡＭ５４に入力される。また、ロボット１の各関節のエンコーダ３３（ロータリエンコーダ）の出力はカウンタ５６を介してＲＡＭ５４に入力される。
【００５８】
前記第１の演算装置６０は後述の如く、目標歩容を生成すると共に、関節角変位指令（各関節の変位角若しくは各電動モータ３２の回転角の指令値）を算出し、ＲＡＭ５４に送出する。また第２の演算装置６２はＲＡＭ５４から関節角変位指令と、前記エンコーダ３３の出力信号に基づいて検出された関節角の実測値とを読み出し、各関節の駆動に必要な操作量を算出してＤ／Ａ変換器６６とサーボアンプ３２ａとを介して各関節を駆動する電動モータ３２に出力する。
【００５９】
図４は、本実施形態におけるロボット１の歩容生成装置及び制御装置の機能的構成を全体的に示すブロック図である。この図４中の「実ロボット」の部分以外の部分が制御ユニット２６が実行する処理機能（主として第１の演算装置６０及び第２の演算装置６２の機能）によって構成されるものである。なお、以下の説明では、脚体２の左右を特に区別する必要がないときは、前記符号Ｒ，Ｌを省略する。
【００６０】
以下説明すると、制御ユニット２６は、後述の如く目標歩容を自在かつリアルタイムに生成して出力する歩容生成装置１００を備えている。該歩容生成装置１００は、その機能によって、本願発明の各手段を構成するものである。この歩容生成装置１００が出力する目標歩容は、目標上体位置姿勢軌道（上体２４の目標位置及び目標姿勢の軌道）、目標足平位置姿勢軌道（各足平２２の目標位置及び目標姿勢の軌道）、目標腕姿勢軌道（各腕体の目標姿勢の軌道）、目標全床反力中心点（目標ＺＭＰ）軌道、及び目標全床反力軌道から構成される。なお、脚体２や腕体以外に、上体２４に対して可動な部位を備える場合には、その可動部位の目標位置姿勢軌道が目標歩容に加えられる。
【００６１】
ここで、上記歩容における「軌道」は時間的変化のパターン（時系列パターン）を意味し、以下の説明では、「軌道」の代わりに「パターン」と称することもある。また、「姿勢」は空間的な向きを意味する。具体的には、例えば上体姿勢はＺ軸（鉛直軸）に対するロール方向（Ｘ軸まわり）の上体２４の傾斜角（姿勢角）とピッチ方向（Ｙ軸まわり）の上体２４の傾斜角（姿勢角）とで表され、足平姿勢は各足平２２に固定的に設定された２軸の空間的な方位角で表される。本明細書では、上体姿勢は上体姿勢角ということもある。
【００６２】
なお、以下の説明では、誤解を生じるおそれがない場合には、しばしば「目標」を省略する。また、歩容のうちの、床反力に係わる構成要素以外の構成要素、すなわち足平位置姿勢、上体位置姿勢等、ロボット１の運動に係わる歩容を総称的に「運動」という。また、各足平２２に作用する床反力（並進力及びモーメントからなる床反力）を「各足平床反力」と呼び、ロボット１の全て（２つ）の足平２２Ｒ，２２Ｌについての「各足平床反力」の合力を「全床反力」という。但し、以下の説明においては、各足平床反力はほとんど言及しないので、特に断らない限り、「床反力」は「全床反力」と同義として扱う。
【００６３】
目標床反力は、一般的には、作用点とその点に作用する並進力及びモーメントによって表現される。作用点はどこにとってもよいので、同一の目標床反力でも無数の表現が考えられるが、特に目標床反力中心点（全床反力の中心点の目標位置）を作用点にして目標床反力を表現すると、目標床反力のモーメント成分は、鉛直成分（鉛直軸（Ｚ軸）まわりのモーメント）を除いて零になる。換言すれば、目標床反力中心点まわりの目標床反力のモーメントの水平成分（水平軸（Ｘ軸及びＹ軸）回りのモーメント）は零になる。
【００６４】
なお、動力学的平衡条件を満足する歩容では、ロボット１の目標運動軌道から算出されるＺＭＰ（目標運動軌道から算出される慣性力と重力との合力がその点まわりに作用するモーメントが、鉛直成分を除いて零になる点）と目標床反力中心点は一致することから、目標床反力中心点軌道の代わりに目標ＺＭＰ軌道を与えると言っても同じことである（詳細は、本願出願人による前記特許文献１等を参照）。
【００６５】
このような背景から、前記特許文献１では目標歩容を、次のように定義していた。
ａ）広義の目標歩容とは、１歩ないしは複数歩の期間の目標運動軌道とその目標床反力軌道との組である。
ｂ）狭義の目標歩容とは、１歩の期間の目標運動軌道とそのＺＭＰ軌道との組である。
ｃ) 一連の歩容は、いくつかの歩容がつながったものとする。
【００６６】
歩行においては、本出願人が先に特開平１０−８６０８０号公報で提案した上体高さ決定手法によってロボット１の上体２４の鉛直位置（上体高さ）が決定されると、並進床反力鉛直成分は従属的に決定される。さらに、目標歩容の運動による慣性力と重力との合力が目標ＺＭＰまわりに発生するモーメントの水平成分が零になるようにロボット１の上体水平位置軌道を決定することで、並進床反力水平成分も決定される。このため、前記特許 文献１では、目標歩容の床反力に関して明示的に設定すべき物理量としては、目標ＺＭＰだけで十分であった。従って、狭義の目標歩容の定義としては、上記のｂ）で十分であった。それに対し、本実施形態で説明するロボット１の走行歩容（詳細は後述する）においては、床反力鉛直成分（並進床反力鉛直成分）も制御上重要である。このため本発明では、この床反力鉛直成分の目標軌道を明示的に設定した上で、ロボット１の目標上体鉛直位置等の軌道を決定する。
【００６７】
そこで、本明細書では、狭義の目標歩容の定義として、次のｂ’）を用いる。
ｂ’）狭義の目標歩容とは、１歩の期間の目標運動軌道とその目標ＺＭＰ軌道と目標並進床反力鉛直成分軌道との組である。
【００６８】
この明細書では以降、理解を容易にするために、特にことわらない限り、目標歩容は上記ｂ’）の狭義の目標歩容の意味で使用する。この場合、目標歩容の「１歩」は、ロボット１の片方の脚体２が着地してからもう一方の脚体２が着地するまでの意味で使用する。なお、以下の説明では、「床反力鉛直成分」は「並進床反力鉛直成分」を意味するものとし、床反力のうちのモーメントの鉛直成分（鉛直軸回り成分）は、「モーメント」という用語を用いて「床反力鉛直成分」と区別をする。同様に、「床反力水平成分」は「並進床反力水平成分」を意味するものとする。
【００６９】
また、歩容における両脚支持期とは言うまでもなく、ロボット１がその自重を両脚体２，２で支持する期間、片脚支持期とはいずれか一方のみの脚体２でロボット１の自重を支持する期間、空中期とは両脚体２，２が床から離れている（空中に浮いている）期間を言う。片脚支持期においてロボット１の自重を支持しない側の脚体２を「遊脚」と呼ぶ。なお、本実施形態で説明する走行歩容では、両脚支持期は無く、片脚支持期（着地期）と空中期とが交互に繰り返される。この場合、空中期では両脚２，２とも、ロボット１の自重を支持しないこととなるが、該空中期の直前の片脚支持期において遊脚であった脚体２、支持脚であった脚体２をそれぞれ該空中期においても遊脚、支持脚と呼ぶ。
【００７０】
図５に示す走行歩容を例にして、歩容生成装置１００が生成する目標歩容の概要を説明する。なお、歩容に関するその他の定義及び詳細は、先に本願出願人が提案した前記特許文献２にも記載されているので、以下では、前記特許文献２に記載されていない内容を主に説明する。
【００７１】
まず、図５に示す走行歩容を説明する。この走行歩容は、人間の通常的な走行歩容と同様の歩容である。この走行歩容では、ロボット１の左右いずれか一方のみの脚体２（支持脚）の足平２２が着地（接地）する片脚支持期と、両脚体２，２が空中に浮く空中期とが交互に繰り返される。図５の１番目の状態は片脚支持期の開始時（初期）の状態、２番目の状態は片脚支持期の中間時点の状態、３番目の状態は片脚支持期に続く空中期の開始時（片脚支持期の終了時）の状態、４番目の状態は空中期の中間時点の状態、５番目の状態は空中期の終了時（次の片脚支持期の開始時）の状態を示している。
【００７２】
この走行歩容では、ロボット１は、図５の１番目の状態で示すように、片脚支持期の開始時において支持脚（ロボット１の進行方向前側の脚体２）側の足平２２のかかとで着地する。続いて、図５の２番目の状態で示すように、ロボット１は、着地した足平２２（支持脚側の足平２２）の底面のほぼ全面を着地させた後、図５の３番目の状態で示すように、その支持脚側の足平２２（図５の３番目の状態におけるロボット１の進行方向後側の脚体２の足平２２）のつま先で床を蹴って空中に飛び上がる。これより片脚支持期が終了すると共に空中期が開始する。なお、片脚支持期における遊脚は、図５の１番目の状態で示すように、片脚支持期の開始時では、支持脚の後側に存在するが、図５の２番目及び３番目の状態で示すように次の着地予定位置に向かって支持脚の前側に振り出される。次いで、図５の４番目の状態で示す空中期を経た後、ロボット１は、遊脚（空中期の開始直前の片脚支持期で遊脚となっていた脚体２）の足平２２のかかとで着地し、次の片脚支持期が開始される。
【００７３】
図５の走行歩容を考慮しつつ、前記歩容生成装置１００が生成する目標歩容の基本的な概要を説明する。詳細は後述するが、歩容生成装置１００が目標歩容を生成するとき、遊脚側の足平２２の着地位置姿勢（着地予定位置姿勢）や着地時刻（着地予定時刻）等の目標歩容生成用の基本的な要求値（要求パラメータ）が、前記ジョイスティック４４の所要の操作等に応じて歩容生成装置１００に与えられる。そして、歩容生成装置１００は、その要求パラメータを用いて目標歩容を生成する。より詳しく言えば、歩容生成装置１００は、上記要求パラメータに応じて、目標歩容の目標足平位置姿勢軌道、目標床反力鉛直成分軌道等、目標歩容の一部の構成要素を規定するパラメータ（歩容パラメータという）を決定した上で、その歩容パラメータを用いて目標歩容の瞬時値を逐次決定し、該目標歩容の時系列パターンを生成する。
【００７４】
この場合、目標足平位置姿勢軌道（より詳しくは、足平の位置及び姿勢の空間的な各成分（Ｘ軸成分等）の目標軌道）は、例えば本出願人が特許第３２３３４５０号にて提案した有限時間整定フィルタを用いて各足平２２毎に生成される。この有限時間整定フィルタは、可変時定数の１次遅れフィルタ、すなわち、伝達関数が１／（１＋τｓ）の形で表されるフィルタ（τは可変の時定数。以下、このフィルタを単位フィルタという）を複数段（本実施形態では３段以上）、直列に接続したものであり、所望の指定時刻に指定値に到達するような軌道を生成・出力することができるものである。この場合、各段の単位フィルタの時定数τは、いずれも、有限時間整定フィルタの出力生成を開始してから、上記指定時刻までの残時間に応じて逐次可変的に設定される。より詳しくは、該残時間が短くなるに伴いτの値が所定の初期値（＞０）から減少されていき、最終的には、該残時間が０になる指定時刻にて、τの値が０になるように設定される。そして、有限時間整定フィルタには、前記指定値（より詳しくは、有限時間整定フィルタの出力の初期値から前記指定値への変化量）に応じた高さのステップ入力が与えられる。このような有限時間整定フィルタは、指定時刻にて指定値に達するような出力が生成されるだけでなく、指定時刻における有限時間整定フィルタの出力の変化速度を０若しくはほぼ０にすることができる。特に、単位フィルタを３段以上（３段でよい）、接続した場合には、有限時間整定フィルタの出力の変化加速度（変化速度の微分値）をも０若しくはほぼ０にすることができる。
【００７５】
このような有限時間整定フィルタを用いる足平位置姿勢軌道（足平２２が着地してから次に着地するまでの位置姿勢軌道）の生成は、例えば次のように行なわれる。例えばＸ軸方向（前後方向）の目標足平位置軌道は次のように生成される。すなわち、前記要求パラメータにより定まる各足平２２の次の着地予定位置のＸ軸方向位置（より詳しくは、次の着地予定位置のひとつ前の着地位置に対するＸ軸方向の変化量（移動量）。これは前記指定値に相当する）に応じて有限時間整定フィルタへのステップ入力の高さが決定されると共に前記時定数τが所定の初期値に初期化された後、その決定されたステップ入力が有限時間整定フィルタに与えられ、足平２２のＸ軸方向位置の軌道生成が開始される。そして、この軌道生成時には、前記時定数τは、足平２２の着地予定時刻（これは前記指定時刻に相当する）までに初期値から０まで減少していくように、逐次可変設定される。これにより、着地予定時刻で着地予定位置に達するような、足平２２のＸ軸方向の位置の軌道が生成される。
【００７６】
また、Ｚ軸方向（鉛直方向）の目標足平位置軌道は、例えば次のように生成される。すなわち、まず、足平２２の次の着地予定位置及び着地予定時刻に応じて、該足平２２の高さ（鉛直位置）が最大になるときの該足平２２のＺ軸方向位置（以下、最高点位置という）とその最高点位置への到達時刻とが決定される。そして、その最高点位置（これは前記指定値に相当する）に応じて有限時間整定フィルタへのステップ入力の高さが決定されると共に時定数τが初期化された後、その決定されたステップ入力が有限時間整定フィルタに与えられ、前記最高点位置までのＺ軸方向の足平位置軌道が逐次生成される。この際、時定数τは、最高点位置への到達時刻（前記指定時刻に相当）までに初期値から０まで減少するように逐次可変設定される。
【００７７】
さらに、最高点位置までのＺ軸方向位置の軌道の生成が終了したら、時定数τを初期化すると共にいままでのステップ入力と逆極性のステップ入力（より詳しくは、最高点位置から次の着地予定位置までのＺ軸方向の変化量（これは前記指定値に相当する）に応じた高さの逆極性のステップ入力）が有限時間整定フィルタに入力され、該最高点位置から着地予定位置までのＺ軸方向の足平位置の軌道が逐次生成される。この際、時定数τは足平２２の着地予定時刻までに初期値から０まで減少するように逐次可変設定される。
【００７８】
なお、Ｚ軸方向の足平位置軌道の生成においては、時定数τを軌道生成開始時刻から足平２２の着地予定時刻まで、初期値から０まで継続的に減少するように可変設定すると共に、最高点位置への到達時刻若しくはその近傍時刻で、ステップ入力の極性を逆極性に切り替えることで、Ｚ軸方向の足平位置軌道を生成するようにしてもよい。この場合には、足平２２を所望の最高点位置に精度よく到達させることはできないが、着地予定時刻での着地予定位置への到達は問題なく行なうことができる。
【００７９】
足平姿勢軌道についても、上述した足平位置軌道と同様に有限時間整定フィルタを用いて生成することができる。この場合、足平姿勢の空間的な各成分のうち、その姿勢の角度変化が単調的（単調増加若しくは単調減少）なものとなる成分については、前記したＸ軸方向の足平位置軌道の生成と同様に足平姿勢軌道を生成すればよい。また、姿勢の角度変化が極大値若しくは極小値をもつような成分については、前記したＺ軸方向の足平位置軌道の生成と同様に足平姿勢軌道を生成すればよい。
【００８０】
なお、上記のように有限時間整定フィルタにより生成される目標足平位置姿勢軌道は、床面に固定された後述の支持脚座標系での各足平２２の目標位置姿勢軌道である。
【００８１】
上述のように生成される目標足平位置姿勢軌道は、各足平２２の位置が、その初期接地状態（目標歩容の初期時刻の状態）から着地予定位置に向かって徐々に加速しながら移動を開始するように生成される。そして、該目標足平位置姿勢軌道は、最終的に着地予定時刻までに徐々に位置の変化速度を０又はほぼ０にまで減速し、着地予定時刻にて着地予定位置に到達して停止するように生成される。このため、各足平２２の着地瞬間における対地速度（床に固定された支持脚座標系での各足平２２の位置の変化速度）が０又はほぼ０になる。従って、走行歩容において同時に全脚体２，２が空中に存在する状態（空中期での状態）から着地しても、着地衝撃が小さくなる。
【００８２】
前記走行歩容においては、ロボット１に作用する重力によって空中期後半から上体２４の鉛直速度は下向きになり、着地時でも下向きのままである。従って、上記のように各足平２２の着地瞬間における対地速度が０又はほぼ０になるように目標足平位置姿勢軌道を生成すると共に、後述する如く動力学的平衡条件を満たすように上体２４の目標位置姿勢軌道を生成したとき、着地直前において、上体２４に対する遊脚側の足平２２の相対速度は、上向きになる。すなわち、走行歩容の着地瞬間では、ロボット１の目標歩容は遊脚側の脚体２を上体２４側に引っ込めながら着地するような歩容となる。言い換えれば、本実施例での目標歩容では、ロボット１は、着地瞬間において、遊脚側の足平２２の対地速度が０又はほぼ０になるように、上体２４から見て該足平２２を引き上げるようにして着地する。これによって、着地衝撃は小さくなり、着地衝撃が過大になるのを防止するようにしている。
【００８３】
また、本実施形態では、有限時間整定フィルタは、単位フィルタを３段以上（例えば３段）、直列に接続したものであるため、着地予定時刻までに各足平２２の速度（足平位置の変化速度）が０又はほぼ０になるだけでなく、各足平２２は、その加速度も着地予定時刻にて０又はほぼ０になって停止する。つまり、着地瞬間における対地加速度も０又はほぼ０になる。従って、着地衝撃がより一層小さくなる。特に、実際のロボット１の着地時刻が目標の着地時刻からずれても、衝撃があまり増大しなくなる。補足すると、着地予定時刻にて各足平２２の対地速度を０又はほぼ０にする上では、有限時間整定フィルタの単位フィルタの段数は２段でもよいが、この場合には、着地予定時刻での各足平２２の加速度は一般には０にならない。
【００８４】
なお、足平姿勢に関しては、各足平２２が着地予定時刻にてその踵で着地した後、該足平２２の底面のほぼ全面が床に接地するまで動き続ける。このため、該足平２２の底面のほぼ全面が床に接地する時刻を前記指定時刻に設定して、前記有限時間整定フィルタにより足平姿勢軌道が生成される。
【００８５】
また、本実施形態では、有限時間整定フィルタを用いて足平位置軌道を生成したが、着地予定時刻での足平位置の変化速度が０又はほぼ０になる（足平位置の時間微分値が０になる）ように、さらには、該着地予定時刻での足平位置の変化加速度（変化速度の時間微分値）が０又はほぼ０になるように設定された多項式などの関数を用いて目標足平位置軌道を生成するようにしてもよい。このことは、目標足平姿勢軌道の生成に関しても同様である。但し、該目標足平姿勢軌道の生成に関しては、上述の如く、各足平２２の底面のほぼ全面が床に設置する時刻にて、各足平２２の姿勢の変化速度、さらにはその変変化加速度が０又はほぼ０になるように多項式などの関数が設定される。
【００８６】
目標床反力鉛直成分軌道は、例えば図６のように設定される。本実施形態では、走行歩容における目標床反力鉛直成分軌道の形状（詳しくは片脚支持期での形状）は、台形状（床反力鉛直成分の増加側に凸の形状）に定められており、その台形の高さ、折れ点の時刻を目標床反力鉛直成分軌道を規定する歩容パラメータとして、それらの歩容パラメータ（床反力鉛直成分軌道パラメータ）が決定される。なお、走行歩容の空中期では、目標床反力鉛直成分は定常的に０に設定される。この例のように、目標床反力鉛直成分軌道は、実質的に連続になるように（値が不連続にならないように）設定するのがよい。これは床反力を制御する際のロボット１の関節の動作を滑らかにするためである。なお、「実質的に連続」というのは、アナログ的に連続な軌道（真の意味での連続な軌道）を離散時間系でデジタル表現したときに必然的に生じる値の飛びは、該軌道の連続性を失わせるものではないということを意味するものである。
【００８７】
目標ＺＭＰ軌道は次のように設定される。図５の走行歩容においては、前記したように支持脚側足平２２のかかとで着地し、次にその支持脚側足平２２のつま先で蹴って空中に飛び上がり、最後に遊脚側足平２２のかかとで着地する。従って、片脚支持期での目標ＺＭＰ軌道は、図７の上段図に示すように、支持脚側足平２２のかかとを初期位置として、次に支持脚側足平２２の底面のほぼ全面が接地する期間において該足平２２の前後方向の中央に移動し、その後、離床時までに支持脚側足平２２のつまさきに移動するように設定される。ここで、図７の上段図は、Ｘ軸方向（前後方向）の目標ＺＭＰ軌道を示すものであり、図７の下段図はＹ軸方向（左右方向）の目標ＺＭＰ軌道を示すものである。なお、片脚支持期におけるＹ軸方向の目標ＺＭＰ軌道は、図７の下段図に示すように、Ｙ軸方向での支持脚側脚体２の足首関節の中心位置と同じ位置に設定される。
【００８８】
走行歩容では、さらに片脚支持期の終了後、両脚体２，２が床から離れ、床反力鉛直成分が０になる。床反力鉛直成分が０の時、すなわち空中期には、ロボット１の全体重心は自由落下運動をし、全体重心まわりの角運動量変化は零である。この時、床の任意の点において、ロボット１に作用する重力と慣性力との合力のモーメントは０であるので、目標ＺＭＰは不定である。すなわち、床のいずれの点も、「重力と慣性力との合力が作用するモーメントの水平成分が０である作用点」というＺＭＰの条件を満たす。言いかえれば、任意の点に目標ＺＭＰを設定しても、上記合力が目標ＺＭＰ回りに作用するモーメントの水平成分が０であるという動力学的平衡条件を満足する。従って、目標ＺＭＰを不連続に設定しても構わない。
【００８９】
例えば、空中期では、目標ＺＭＰを、離床時（片脚支持期の終了時）の目標ＺＭＰ位置から移動しないように設定し、空中期終端において、着地時の目標ＺＭＰ位置に不連続（ステップ状）に移動するように該目標ＺＭＰ軌道を設定しても構わない。しかし本実施形態では、図７の上段図に示すように、空中期における目標ＺＭＰ軌道のＸ軸方向位置は、次の遊脚側脚体２の着地までに支持脚側足平２２のつまさきから遊脚側足平２２のかかとの着地位置まで連続的に移動するようにした。また、図７の下段図に示すように、空中期における目標ＺＭＰ軌道のＹ軸方向位置は、次の遊脚側脚体２の着地までに支持脚側脚体２の足首関節の中心のＹ軸方向位置から遊脚側脚体２の足首関節の中心のＹ軸方向位置まで連続的に移動するようにした。すなわち、歩容の全期間において目標ＺＭＰ軌道を連続（実質的に連続）にした。そして、後述するように、目標ＺＭＰまわりの重力と慣性力との合力のモーメント（鉛直成分を除く）が零になるように目標歩容を生成する（より具体的には目標上体位置姿勢軌道を調整する）ようにした。
【００９０】
以下に目標ＺＭＰ軌道を連続的にする理由を述べる。空中期においては、厳密動力学モデルを用いて、重力と慣性力との合力が目標ＺＭＰまわりに作用するモーメントが０になり、且つ目標床反力鉛直成分を０として目標歩容を生成すれば、生成された目標歩容による重力と慣性力との合力が、床に固定されたある座標系（これをグローバル座標系と呼ぶ）の原点まわりに作用するモーメントの真値（厳密動力学モデルによって算出される重力と慣性力との合力が前記座標系原点まわりに作用するモーメントのことであり、以降、原点まわり真モーメントと呼ぶ。）は０となる。
【００９１】
しかし、上記のごとく生成する時に用いる動力学モデルが厳密モデルでなく近似モデルの場合には、生成された歩容の原点まわり真モーメントは０とならない場合がある。しかも、近似モデルが、動力学を表現するのに一般的である微分（差分）方程式又は積分方程式で記述されているとすると、原点まわり真モーメントは目標ＺＭＰの位置に依存し、目標ＺＭＰの位置を微小量だけ変更すると、原点まわり真モーメントも微小量だけ移動する場合がある。従って、この場合に、目標ＺＭＰの位置を不連続に移動させると、原点まわり真モーメントも不連続に変化する。
【００９２】
これは、生成された歩容の真の慣性力（厳密モデルで算出された慣性力）が不連続になることを意味する。さらにこれは、ロボット１のいずれか又はすべての関節変位の加速度（角加速度）が不連続になることを意味する。
【００９３】
以上の理由により、モデルの近似誤差を考慮すると、生成された歩容が滑らかになるようにするために、空中期においても目標ＺＭＰ軌道を連続（実質的に連続）にしておくのが望ましい。但し、本実施形態で用いる後述の動力学モデルでは、目標ＺＭＰの位置によらずに、目標ＺＭＰ回りモーメントの水平成分を０にするような目標歩容を一義的に生成できるので、必ずしも目標ＺＭＰを連続にしておく必要はない。
【００９４】
なお、本実施形態では、図７に示したような目標ＺＭＰ軌道の折れ点の位置や時刻が、ＺＭＰ軌道パラメータ（目標ＺＭＰ軌道を規定するパラメータ）として設定される。また、上記したＺＭＰ軌道の「実質的に連続」の意味は、前記床反力鉛直成分軌道の場合と同様である。
【００９５】
ＺＭＰ軌道パラメータは、安定余裕が高く、かつ急激な変化をしないように決定される。ここで、ロボット１の接地面を含む最小の凸多角形（いわゆる支持多角形）の中央付近に目標ＺＭＰが存在する状態を安定余裕が高いと言う（詳細は前記特許文献２を参照）。図７の目標ＺＭＰ軌道はこのような条件を満たすように設定したものである。
【００９６】
また、目標腕姿勢は、上体２４に対する相対姿勢で表す。
【００９７】
また、目標上体位置姿勢、目標足平位置姿勢及び後述の基準上体姿勢はグローバル座標系で記述される。グローバル座標系は前述のごとく床に固定された座標系である。グローバル座標系としては、より具体的には、後述する支持脚座標系が用いられる。
【００９８】
本実施形態では、歩容生成装置１００は、目標上体姿勢だけでなく、基準上体姿勢も生成する。この基準上体姿勢は、歩容に対する要求（歩容生成装置１００に対する行動計画部などの装置又は外部（前記ジョイスティック４４等）からの要求）にそのまま従って生成される上体姿勢である。
【００９９】
目標上体姿勢（以降、「基準」が付いていない場合には、目標上体姿勢を表す）は、長期的には基準上体姿勢に追従するか又は一致するように生成される。
【０１００】
目標上体姿勢は、歩行においては、本願出願人による前記特許文献１に記載した実施形態のごとく通常、常に基準上体姿勢に一致させておけばよい。前記特許文献１では、基準上体姿勢という概念は記載されていないが、目標上体姿勢パターンを、明示的かつ優先的に与えていたので、基準上体姿勢に目標上体姿勢が常に一致していることと同じことである。
【０１０１】
しかし、走行など空中期がある歩容や低摩擦床面での歩行においては、単に上体水平加速度を調整するだけでは、目標歩容の床反力水平成分が許容範囲以内（あるいは摩擦限界以内）に存在するようにしつつ動力学的平衡条件を満足することができない。
【０１０２】
そこで、本実施形態においては、目標上体姿勢を必要に応じて基準上体姿勢から故意にずらすこととした。より具体的には、以下に説明するふたつの運動モードを複合的に発生させることにより、目標歩容の床反力水平成分が許容範囲以内（あるいは摩擦限界以内）に存在しつつ動力学的平衡条件を満足させるようにした。
【０１０３】
図８のように、ロボット１のある運動状態から、上体水平加速度だけを摂動（微小変化）させると、ロボット１の全体重心水平加速度と全体重心まわりの角運動量が摂動する。すなわち、上体水平加速度の摂動は、それによって発生するロボット１の慣性力と重力との合力に対して動力学的に釣り合う床反力鉛直成分を摂動させずに（ロボット１の全体重心鉛直加速度を摂動させずに）、目標ＺＭＰまわりの床反力モーメント成分（但し鉛直軸まわり成分を除く）と床反力水平成分とを摂動させる。このようにロボット１の上体水平加速度を摂動させる運動モードを上体並進モードと呼ぶ。
【０１０４】
言い換えると、床反力鉛直成分を変化させずに、目標ＺＭＰまわりの床反力モーメント成分（但し鉛直軸まわり成分を除く）と床反力水平成分とを変化させる運動を上体並進モードと呼ぶ。
【０１０５】
この時の単位加速度当たりの床反力モーメント成分の変化をΔMｐ、単位加速度当たりの床反力水平成分の変化をΔFpとする。図８に示す状況で上体２４を前方に水平加速すると、ΔMｐとΔFpは図８に示す矢印の向きに作用する。
【０１０６】
感覚的に判り易くするために、運動によって発生する慣性力と重力との合力に釣り合う床反力を用いて表現したが、慣性力と重力との合力を用いて表現した方が、理論的には的確である。なお、上記合力と床反力とは、互いに大きさが同じで向きが逆になっている。
【０１０７】
それに対し、図９のように、ロボット１のある運動状態から、ある点Pｒまわりに上体姿勢角加速度（上体２４の姿勢角の角加速度）を摂動させると、ロボット１の全体重心は摂動せずに、全体重心まわりの角運動量が摂動する。すなわち、点Pｒまわりの上体姿勢角加速度の摂動は、床反力鉛直成分と床反力水平成分とを摂動させずに、目標ＺＭＰまわりの床反力モーメント成分（鉛直軸まわり成分を除く）を摂動させる。このようにロボット１の上体姿勢角加速度を摂動させる運動モードを上体回転モードと呼ぶ。
【０１０８】
言い換えると、床反力鉛直成分と床反力水平成分を変化させずに、目標ＺＭＰまわりの床反力モーメント成分（鉛直軸まわり成分を除く）を変化させる運動を上体回転モードと呼ぶ。
【０１０９】
この時の単位角加速度当たりの床反力モーメント成分の変化をΔMｒ、単位角加速度当たりの床反力水平成分の変化をΔFｒとする。ΔFｒは零である。図９に示す状況で上体２４が前傾するように上体姿勢角の角加速度を発生させると、ΔMｒは図９に示す矢印の向きに作用する。
【０１１０】
次に、本実施形態に用いられるロボット動力学モデルについて説明する。本実施形態では単純化された（近似された）以下に示す動力学モデルを用いる。但し、以下に示す動力学モデルに関しては、キネマティクスモデル（関節、リンクの構造や寸法を表すモデルであり、言い換えると、関節変位とリンクの位置姿勢との関係を表すモデルである。）も必要である。
【０１１１】
図１０は、本実施形態に用いられるロボット動力学モデルである。図示の如く、この動力学モデルは、ロボット１の各脚体２にそれぞれ対応する２つの質点２ｍ，２ｍ、及び上体２４に対応する質点２４ｍからなる合計３質点と、イナーシャがあって質量のないフライホイールＦＨとから構成されるモデルである。この動力学モデルでは、デカップルド、即ち、脚体２，２の動力学（各質点２ｍ，２ｍの動力学）と上体２４の動力学（質点２４ｍ及びフライホイールＦＨの動力学）とが相互に非干渉に構成されると共に、ロボット１全体の動力学は、それらの線形結合で表される。また、さらに、上体２４の運動と床反力との関係も、上体２４の並進運動（上体並進モード）と床反力との関係、並びに上体２４の回転運動（上体回転モード）と床反力との関係に分離される。具体的には、上体質点２４ｍの水平運動によって発生する床反力は、上体２４の水平方向並進運動（上体並進モード）によって発生する床反力に対応し、フライホイールの回転運動によって発生する床反力は、上体２４の姿勢角の回転運動（上体回転モード）によって発生する床反力に対応する。
【０１１２】
なお、ロボット１の腕体の質量は上体２４に含まれるものとし、上体質点２４ｍは腕体の質量を含む質量をもつ。本実施形態では、目標歩容における腕体の運動（腕振り運動）は、後述するように、ロボット１の腕振り以外の運動によってロボット１に発生する鉛直軸まわりの慣性力のモーメントを打ち消しつつも、上体２４に対する両腕体の全体の重心の相対位置が動かないように行なわれるので、腕体の腕振り運動による（鉛直軸まわり成分を除く）床反力モーメントへの影響と床反力水平成分への影響とは無視する。
【０１１３】
以下に上記単純化モデルを数式化する。但し、説明を簡単にするために、サジタルプレーン（前後軸（Ｘ軸）と鉛直軸（Ｚ軸）を含む平面）での運動方程式のみを記述し、ラテラルプレーン（左右軸（Ｙ軸）と鉛直軸（Ｚ軸）を含む平面）での運動方程式を省略した。
【０１１４】
説明の便宜上、動力学モデルに関する変数及びパラメータを以下のように定義する。なお、各質点２ｍ，２ｍ，２４ｍはそれが対応する部位の代表点であるか、あるいはその部位の位置姿勢から幾何学的に一義的に決定される点に相当する。例えば、支持脚側脚体２の質点２ｍの位置は、該脚体２の足平２２の底面の前記代表点から所定の距離だけ上方の点とする。
Ｚsup：支持脚質点鉛直位置
Ｚswg：遊脚質点鉛直位置
Ｚb：上体質点鉛直位置（上体鉛直位置とは一般的には異なる。）
ＺGtotal：全体重心鉛直位置
Ｘsup：支持脚質点水平位置
Ｘswg：遊脚質点水平位置
Ｘb：上体質点水平位置（前記点Pｒから前後にある所定の距離だけオフセットした点である。オフセットは、直立時などにおいて、厳密モデルの重心位置と、本動力学モデルの重心位置がなるべく一致するように、決定される。上体水平位置とは一般的には異なる。）
ＸGtotal：全体重心水平位置
θby：鉛直方向に対するＹ軸回りの上体姿勢角（傾斜角）
mb：上体質点質量
msup：支持脚質点質量
mswg：遊脚質点質量
mtotal：ロボット総質量（＝mtotal＋msup＋mswg）
Ｊ：上体慣性モーメント（上体回転モードにおける等価慣性モーメントである。実ロボット１の上体２４部位の慣性モーメントとは一般的には一致しない。）
Fx：床反力水平成分（詳しくは並進床反力の前後方向（Ｘ軸）成分）
Fz：床反力鉛直成分（詳しくは並進床反力の鉛直方向（Ｚ軸）成分。本実施形態では、これは目標並進床反力鉛直成分に等しい）
My：目標ＺＭＰまわりの床反力モーメント（詳しくは床反力モーメントの左右軸（Y軸）まわり成分）
【０１１５】
なお、本実施形態では、各脚体２の質点２ｍの位置と、その脚体２の足平２２の位置（足平２２のあらかじめ定めた代表点の位置）との位置関係はあらかじめ定められており、一方の位置が決まれば、他方の位置は一義的に定まるものとされている。また、上体質点２４ｍと、上体２４の位置（上体２４のあらかじめ定められた代表点の位置）との位置関係は、上体２４の姿勢角に応じてあらかじめ定められており、一方の位置と姿勢角とが決まれば、他方の位置は一義的に定まるものとされている。
【０１１６】
また、任意の変数Ｘに対して、dX/dtはＸの１階微分を表わし、d2X/dt2はＸの２階微分を表わす。従って、変数Ｘが変位ならば、dX/dtは速度、d2X/dt2は加速度を意味する。ｇは重力加速度定数を示す。ここでは、ｇは正の値とする。
【０１１７】
上記動力学モデルの運動方程式（動力学的平衡条件を表す式）は、式０１、式０２、式０３で表される。
Figure 0003672101
【０１１８】
また、ロボット全体重心位置には次の関係式が成立する。
ＺGtotal＝(mb*Zb + msup*Zsup + mswg*Zswg)/mtotal ……式０４
ＸGtotal＝(mb*Xb + msup*Xsup + mswg*Xswg)/mtotal ……式０５
【０１１９】
以下に上記動力学モデルと前記ΔFp、ΔMp、ΔFｒ、ΔMｒの関係を示す。
【０１２０】
前記ΔFpは、式０２において、d2Xb/dt2を単位量だけ摂動させたときのFxの摂動量であるから、次式によって求められる。
ΔFp＝mb …式０６
【０１２１】
すなわち、上体並進モードの単位加速度当たりの床反力の水平成分の変化ΔFpは、上記動力学モデルの上体質点２４ｍの質量に相当する。
【０１２２】
前記ΔMpは、式０３において、d2Xb/dt2を単位量だけ摂動させたときのMyの摂動量であるから、次式によって求められる。
ΔMp＝mb*(Zb−Zzmp) …式０７
【０１２３】
すなわち、上体並進モードの単位加速度当たりの床反力モーメント成分の変化ΔMｐは、上記動力学モデルの上体質点質量に、上体質点２４ｍの目標ＺＭＰからの高さ（鉛直位置）を乗じたものになる。このときの上体質点２４ｍ及び目標ＺＭＰの位置と、上体質点２４ｍの運動との関係は、上体質点２４ｍを倒立振子質点、目標ＺＭＰを倒立振子支点に対応づけたときの倒立振子の挙動に相当する。
【０１２４】
前記ΔFｒは、式０２において、d2θby/dt2を単位量だけ摂動させたときのFxの摂動量であるから、次式によって求められる。
ΔFｒ＝0 …式０８
【０１２５】
すなわち、上体回転モードの単位加速度当たりの並進床反力水平成分の変化ΔFrは、０である。
【０１２６】
前記ΔMｒは、式０３において、d2θby/dt2を単位量だけ摂動させたときのMyの摂動量であるから、次式によって求められる。
ΔMｒ＝Ｊ …式０９
【０１２７】
すなわち、上体回転モードの単位加速度当たりの床反力モーメント成分の変化ΔMrは、フライホイールの慣性モーメントに相当する。
【０１２８】
本実施形態における歩容生成装置１００は、ロボット１の片方の脚体２が着地してから他方の脚体２が着地するまでの１歩分の目標歩容（前記狭義の意味での目標歩容）を単位として、その１歩分の目標歩容を順番に生成する。従って、本実施形態で生成する図５の走行歩容では、該目標歩容は片脚支持期の開始時から、これに続く空中期の終了時（次の片脚支持期の開始時）までの目標歩容が順番に生成される。ここで、新たに生成しようとしている目標歩容を「今回歩容」、その次の目標歩容を「次回歩容」、さらにその次の目標歩容を「次次回歩容」、というように呼ぶ。また、「今回歩容」の一つ前に生成した目標歩容を「前回歩容」と呼ぶ。
【０１２９】
また、歩容生成装置１００が今回歩容を新たに生成するとき、該歩容生成装置１００には、ロボット１の２歩先までの遊脚側足平２２の着地予定位置姿勢、着地予定時刻の要求値（要求）が歩容に対する要求パラメータとして入力される（あるいは歩容生成装置１００が記憶装置から要求パラメータを読み込む）。そして、歩容生成装置１００は、これらの要求パラメータを用いて、目標上体位置姿勢軌道、目標足平位置姿勢軌道、目標ＺＭＰ軌道、目標床反力鉛直成分軌道、目標腕姿勢軌道等を生成する。このとき、これらの軌道を規定する歩容パラメータの一部は、歩行の継続性を確保するように適宜修正される。
【０１３０】
以下に図５の走行歩容を生成することを例にして、歩容生成装置１００の歩容生成処理の詳細を図１２〜図３８を参照しつつ説明する。図１２は、その歩容生成装置１００が実行する歩容生成処理を示すフローチャート（構造化フローチャート）である。
【０１３１】
まずＳ０１０において時刻ｔを０に初期化するなど種々の初期化作業が行なわれる。この処理は、歩容生成装置１００の起動時等に行なわれる。次いで、Ｓ０１２を経てＳ０１４に進み、歩容生成装置１００は、制御周期（図１２のフローチャートの演算処理周期）毎のタイマ割り込みを待つ。制御周期はΔｔである。
【０１３２】
次いで、Ｓ０１６に進み、歩容の切り替わり目であるか否かが判断され、歩容の切り替わり目であるときはＳ０１８に進むと共に、切り替わり目でないときはＳ０３０に進む。ここで、上記「歩容の切り替わり目」は、前回歩容の生成が完了し、今回歩容の生成を開始するタイミングを意味し、例えば前回歩容の生成を完了した制御周期の次の制御周期が歩容の切り替わり目になる。
【０１３３】
Ｓ０１８に進むときは時刻ｔが０に初期化され、次いでＳ０２０に進み、次回歩容支持脚座標系、次次回歩容支持脚座標系、今回歩容周期及び次回歩容周期が読み込まれる。これらの支持脚座標系及び歩容周期は、前記要求パラメータにより定まるものである。すなわち、本実施形態では、歩容生成装置１００にジョイスティック４４等から与えらる要求パラメータは、２歩先までの遊脚側足平２２の着地予定位置姿勢（足平２２が着地してから足底を床面にほぼ全面的に接触させるように、滑らさずに回転させた状態での足平位置姿勢）、着地予定時刻の要求値を含んでおり、その１歩目の要求値、２歩目の要求値がそれぞれ、今回歩容、次回歩容に対応するものとして、今回歩容の生成開始時（前記Ｓ０１６の歩容の切り替わり目）以前に歩容生成装置１００に与えられたものである。なお、これらの要求値は今回歩容の生成途中でも変更することは可能である。
【０１３４】
そして、上記要求パラメータにおける１歩目の遊脚側足平２２（今回歩容での遊脚側足平２２）の着地予定位置姿勢の要求値に対応して次回歩容支持脚座標系が定まる。
【０１３５】
例えば図１５を参照して、今回歩容（１歩目）に係わる遊脚側足平２２（図では２２Ｌ）の着地予定位置姿勢の要求値が、今回歩容の支持脚側足平２２（図では２２Ｒ）の着地位置姿勢に対して、今回歩容支持脚座標系のＸ軸方向（今回歩容の支持脚側足平２２Ｒの前後方向）及びＹ軸方向（今回歩容の支持脚側足平２２Ｒの左右方向）に、それぞれxnext、ynextだけ移動し、且つＺ軸回り（鉛直軸回り）にθznextだけ回転させた位置姿勢であるとする。ここで、支持脚座標系は、支持脚側足平２２を水平姿勢（より一般的には床面に平行な姿勢）にして該支持脚側足平２２の底面のほぼ全面を床面に接触（密着）させた状態において、該支持脚側脚体２の足首中心から床面に延ばした垂線が該床面と交わる点（この点は、本実施形態の例では支持脚側足平２２の底面のほぼ全面を床面に接触させた状態では、該足平２２の代表点と合致する）を原点とし、その原点を通る水平面をＸＹ平面とするグローバル座標系（床に固定された座標系）である。この場合、Ｘ軸方向、Ｙ軸方向は、それぞれ支持脚側足平２２の前後方向、左右方向である。なお、支持脚座標系の原点は、必ずしも支持脚側足平２２の底面のほぼ全面を床面に接触させた状態での該足平２２の代表点（足平２２の位置を代表する点）に合致する必要はなく、該代表点と異なる床面上の点に設定されてもよい。
【０１３６】
このとき、次回歩容支持脚座標系は、図示のように今回歩容の遊脚側足平２２Ｌの着地予定位置姿勢の要求値に従って該足平２２を着地させた場合（足平２２の代表点を着地予定位置の要求値に一致させ、且つ、足平２２の姿勢（向き）を着地予定姿勢の要求値に一致させた場合）における該足平２２Ｌの代表点（より詳しくは該代表点に合致する床上の点）を原点とし、該原点を通る水平面内における該足平２２Ｌの前後方向、左右方向をそれぞれＸ’軸方向、Ｙ’軸方向とする座標系である。
【０１３７】
上記と同様に、２歩目の遊脚側足平２２の着地予定位置姿勢の要求値に応じて次々回歩容支持脚座標系（図１５のＸ”Ｙ”座標を参照）が定まる。また、今回歩容周期は、今回歩容の支持脚側足平２２の着地予定時刻（要求値）から、１歩目（今回歩容）の遊脚側足平２２の着地予定時刻（要求値）までの時間として定まり、次回歩容周期は、１歩目の遊脚側足平２２の着地予定時刻（要求値）から２歩目の遊脚側足平２２の着地予定時刻（要求値）までの時間として定まる。
【０１３８】
なお、前記要求パラメータは、本実施形態ではジョイスティック４４の所要の操作によって歩容生成装置１００に入力されるものであるが、あらかじめ該要求パラメータあるいはこれに対応する上記の支持脚座標系の位置姿勢及び歩容周期をロボット１の移動スケジュールとして記憶しておいてもよい。あるいは、ジョイスティック４４などの操縦装置からの指令（要求）とそのときまでのロボットの１の移動履歴とを基に前記次回及び次次回歩容支持脚座標系、並びに今回及び次回歩容周期を決定してもよい。
【０１３９】
次いでＳ０２２に進み、歩容生成装置１００は、今回歩容に続く仮想的な周期的歩容としての定常旋回歩容の歩容パラメータを決定する。該歩容パラメータは、定常旋回歩容における目標足平位置姿勢軌道を規定する足平軌道パラメータ、基準とする上体姿勢軌道を規定する基準上体姿勢軌道パラメータ、目標腕姿勢軌道を規定する腕軌道パラメータ、目標ＺＭＰ軌道を規定するＺＭＰ軌道パラメータ、目標床反力鉛直成分軌道を規定する床反力鉛直成分軌道パラメータを含む。さらに、目標床反力水平成分許容範囲を規定するパラメータも歩容パラメータに含まれる。
【０１４０】
なお、この明細書で「定常旋回歩容」は、その歩容を繰り返したときに歩容の境界（本実施形態では１歩毎の歩容の境界）においてロボット１の運動状態（足平位置姿勢、上体位置姿勢等の状態）に不連続が生じないような周期的歩容を意味するものとして使用する。以降、「定常旋回歩容」を「定常歩容」と略す場合もある。
【０１４１】
周期的歩容である定常旋回歩容は、本実施形態では、ロボット１の２歩分の歩容、すなわち今回歩容に続く第１旋回歩容と該第１旋回歩容に続く第２旋回歩容とからなる歩容を該定常旋回歩容の１周期分の歩容として、その１周期分の歩容を繰り返す歩容である。なお、ここで「旋回」なる用語を用いたのは、旋回率を零とするときは直進を意味するので、直進も広義の意味で旋回に含ませることができるからである。また、生成する目標歩容が前記図５の走行歩容であると、その目標歩容の今回歩容は、片脚支持期及び空中期を有する走行歩容であるので、定常旋回歩容の第１旋回歩容及び第２旋回歩容は、いずれも今回歩容と同様に片脚支持期と空中期とを有する歩容である。つまり、第１旋回歩容及び第２旋回歩容の基本的な歩容形態は今回歩容と同一である。
【０１４２】
定常旋回歩容について補足すると、２足移動ロボットでは、定常旋回歩容の１周期分は、前記した狭義の意味での歩容が、少なくとも２歩分、必要である。そして、３歩以上の歩容を１周期分の歩容とする複雑な定常旋回歩容を設定することも可能である。但し、定常旋回歩容は、後述の如く、今回歩容の終端（終了時刻）における発散成分（詳細は後述する）を決定するためだけに用いられる。このため、３歩以上の歩容を１周期とする定常旋回歩容を用いることは、歩容生成の処理が煩雑となるにも関わらず、効果は少ない。そこで、本実施形態での定常旋回歩容の１周期分の歩容を２歩分の歩容（第１及び第２旋回歩容）により構成するようにしている。なお、３足以上の脚式移動ロボットにあっては、それに応じて定常旋回歩容を定義するに足る歩容数が増加する。以下では、説明の便宜上、複数の狭義の歩容（本実施形態では２歩分の歩容）から成る定常旋回歩容を１歩の歩容とみなす。
【０１４３】
定常旋回歩容は、歩容生成装置１００で今回歩容の終端における発散成分や上体鉛直位置速度、上体姿勢角及びその角速度等のロボット１の運動状態を決定するために暫定的に作成されるものであり、歩容生成装置１００からそのまま出力されるものではない。
【０１４４】
なお、「発散」とは、図１３に示すように、２足移動ロボット１の上体２４の位置が両足平２２，２２の位置からかけ離れた位置にずれてしまうことを意味する。発散成分の値とは、２足移動ロボット１の上体２４の位置が両足平２２，２２の位置（より具体的には、支持脚側足平２２の接地面に設定されたグローバル座標系（支持脚座標系）の原点）からかけ離れていく具合を表す数値である。
【０１４５】
本実施形態では、目標歩容が、前記発散を生じることなく、継続的に生成されるように、発散成分を指標にして歩容を生成するようにした。但し、継続的な歩容の代表例である定常歩容（歩容の軌道の不連続を発生することなく、同じパターンの歩容を繰り返すことができる周期的歩容であり、原理上、無限回繰り返しても発散しない歩容）の初期発散成分（定常歩容の初期時刻での発散成分）であっても、単純に０ではなく、定常歩容のパラメータが変われば、その初期発散成分も変わる。すなわち、歩き方あるいは走り方等の歩容形態によって、適切な発散成分が変わる。そこで、本実施形態では、これから生成しようとする今回歩容の後に続く定常歩容が前記今回歩容に係わる要求パラメータに応じて設定され、定常歩容の初期発散成分を求めてから、今回歩容の終端発散成分を定常歩容の初期発散成分に一致させる（より一般的には、今回歩容を定常歩容に連続させ若しくは近づける）ように、今回歩容を生成する。これのような歩容生成の基本的な指針は本出願人が先に提案した前記特許文献１のものと同様である。
【０１４６】
本発明の実施形態では、前記特許文献１の第１実施形態で用いたような線形な３質点動力学モデルを用いていないが、次式で定義される発散成分及び収束成分の概念は、図１０に示したモデルのような非線形な動力学モデルの挙動の摂動分に対しても、近似的に十分な精度で適用することができる。
Figure 0003672101
【０１４７】
但し、ここでの上体質点水平位置は、図１０に示す前記動力学モデルにおいては、上体質点水平位置Xbを表す。また、ω0はある所定の値であり、走行時では、前記特許文献１の歩行歩容生成時の値に対して若干変更する必要がある。
【０１４８】
発散成分及び収束成分に関するその他の詳細は、前記特許文献１に記述されているので、ここではこれ以上言及しない。
【０１４９】
本実施形態においては、前記特許文献１に示した方式に加え、さらに、後述するように、目標床反力鉛直成分軌道を規定する歩容パラメータを設定し、この目標床反力鉛直成分を動力学的に満足するようにロボット１の全体重心鉛直位置を決定する。この場合、床反力鉛直成分の２階積分値がロボット１の全体重心鉛直位置を規定するものになるので、目標床反力鉛直成分の設定が悪いと、ロボット１の全体重心鉛直位置若しくは上体鉛直位置が高くなり過ぎたり低くなり過ぎたりする。従って、目標床反力鉛直成分の設定方法も重要な課題である。しかし、床反力鉛直成分と上体鉛直位置との関係は、ＺＭＰと上体水平位置との関係に似ているので、上体水平位置速度を適切にするための目標ＺＭＰ決定手法の一部を、以下の本実施形態に示すように、少し変更するだけで、上体鉛直位置速度を適切にするための目標床反力鉛直成分の決定手法に適用することができる。
【０１５０】
本題に戻り、Ｓ０２２では、図１４に示すフローチャートに従って、以下の処理が行われる。
【０１５１】
まず、Ｓ１００において、今回歩容、第１旋回歩容、第２旋回歩容の順に足平位置姿勢軌道がつながるように、定常歩容の歩容パラメータのうちの足平軌道パラメータが決定される。以下に具体的な設定方法を図１５を参照して説明する。なお、以降の説明では、支持脚側の脚体２の足平２２を支持脚足平と称し、遊脚側の脚体２の足平２２を遊脚足平と称する。また、歩容の「初期」、「終端」はそれぞれ歩容の開始時刻、終了時刻若しくはそれらの時刻における瞬時歩容を意味する。
【０１５２】
足平軌道パラメータは、第１旋回歩容及び第２旋回歩容の初期及び終端のそれぞれにおける支持脚足平及び遊脚足平のそれぞれの位置姿勢、各旋回歩容の歩容周期等から構成される。この足平軌道パラメータのうち、第１旋回歩容初期遊脚足平位置姿勢は、次回歩容支持脚座標系から見た今回歩容終端支持脚足平位置姿勢とされる。この場合、走行歩容では、今回歩容終端における支持脚足平２２は、空中に移動している。そして、今回歩容終端支持脚足平位置姿勢は、今回歩容初期支持脚足平位置姿勢（＝前回歩容終端遊脚足平位置姿勢）から、前記要求パラメータにおける２歩目の遊脚側足平２２の着地予定位置姿勢の要求値（今回歩容の支持脚足平２２の次回歩容における着地予定位置姿勢の要求値）若しくは該要求値に対応する次次回歩容支持脚座標系に応じて定まる次回歩容終端遊脚足平位置姿勢に至る足平位置姿勢軌道（詳しくは次回歩容支持脚座標系から見た軌道）を、今回歩容終端まで前記有限時間整定フィルタを用いて生成することにより求められる。
【０１５３】
なお、次回歩容終端遊脚足平位置姿勢は、その位置姿勢から足平２２を接地させたまま、つま先を下げるように該足平２２を水平姿勢までピッチ方向に所定角度回転させたときの該足平の位置姿勢が次次回歩容支持脚座標系の位置姿勢に合致するように決定される。換言すれば、次回歩容終端遊脚足平位置姿勢は、前記要求パラメータにおける２歩目の遊脚側足平２２の着地位置姿勢の要求値から、該足平２２をすべらないように接地させたまま、つま先を持ち上げるように該足平２２をピッチ方向に所定角度回転させた状態（つま先を上げてかかとを着地させた状態）での該足平２２の位置姿勢である。
【０１５４】
また、第１旋回歩容初期支持脚足平位置姿勢は、次回歩容支持脚座標系から見た今回歩容終端遊脚足平位置姿勢とされる。この場合、今回歩容終端遊脚足平位置姿勢は、前記次回歩容終端遊脚足平位置姿勢の場合と同様、前記次回歩容支持脚座標系若しくはこれに対応する前記要求パラメータの１歩目（今回歩容）の遊脚着地予定位置姿勢の要求値に応じて定まるものである。すなわち、該今回歩容終端遊脚足平位置姿勢は、その位置姿勢から、足平２２を接地させたまま、つま先を下げるように該足平２２を回転させて該足平２２の底面のほぼ全面を床面に接地させたときの該足平の代表点が次回歩容支持脚座標系の原点に合致するように決定される。
【０１５５】
第１旋回歩容終端遊脚足平位置姿勢は、今回歩容終端遊脚足平位置姿勢や次回歩容終端遊脚足平位置姿勢の決定手法と同様に、次回歩容支持脚座標系から見た次次回歩容支持脚座標系の位置姿勢に基づいて決定される。より具体的には、第１旋回歩容終端遊脚足平位置姿勢は、その位置姿勢から足平２２を接地させたまま、すべらないように該足平２２を水平姿勢まで所定角度回転させたときの足平位置姿勢が、次回歩容支持脚座標系から見た次次回歩容支持脚座標系の位置姿勢に合致するように設定される。
【０１５６】
第１旋回歩容終端では、支持脚足平２２は離床して空中にある。支持脚足平２２が離床してから後の軌道を決定するために、第１旋回歩容支持脚足平着地予定位置姿勢が設定される。第１旋回歩容支持脚足平着地予定位置姿勢は、次回歩容支持脚座標系から見た次次次回歩容支持脚座標系の位置姿勢に基づいて設定される。より具体的には、第１旋回歩容支持脚足平着地予定位置姿勢は、次回歩容支持脚座標系から見た次次次回歩容支持脚座標系の位置姿勢である。なお、次次次回歩容支持脚座標系は、次次回歩容支持脚座標系と次次次回歩容支持脚座標系との相対的位置姿勢関係が、今回歩容支持脚座標系と次回歩容支持脚座標系との相対的位置姿勢関係と一致するように設定される。
【０１５７】
第１旋回歩容終端支持脚足平位置姿勢は、第１旋回歩容初期支持脚足平位置姿勢を求めた場合と同様に、第１旋回歩容初期支持脚足平位置姿勢から、前記第１旋回歩容支持脚足平着地予定位置姿勢に至る足平位置姿勢軌道（より詳しくは次回歩容支持脚座標系から見た軌道）を、第１旋回歩容終端まで前記有限時間整定フィルタを用いて生成することにより求められる。
【０１５８】
第２旋回歩容初期遊脚足平位置姿勢は、次次回歩容支持脚座標系から見た第１旋回歩容終端支持脚足平位置姿勢とされる。第２旋回歩容初期支持脚足平位置姿勢は、次次回歩容支持脚座標系から見た第１旋回歩容終端遊脚足平位置姿勢とされる。
【０１５９】
第２旋回歩容終端遊脚足平位置姿勢は、今回歩容支持脚座標系から見た今回歩容終端遊脚足平位置姿勢とされる。第２旋回歩容終端支持脚足平位置姿勢は、今回歩容支持脚座標系から見た今回歩容終端支持脚足平位置姿勢とされる。
【０１６０】
第１旋回歩容及び第２旋回歩容の歩容周期は、次回歩容周期と同一に設定される。これらの第１旋回歩容及び第２旋回歩容の歩容周期は、互いに同一にすることは必ずしも必要ではないが、いずれの周期も、少なくとも次回歩容周期に応じて決定するのが好ましい。なお、今回歩容、第１旋回歩容及び第２旋回歩容の上記以外の運動パラメータ（両脚支持期時間などの時間パラメータを含む）は、上記決定されたパラメータに応じて、歩容の条件（アクチュエータの速度が許容範囲に入っているか、可動角を超えていないか、床などと干渉していないかなど）を満足するように適宜決定する。
【０１６１】
次に、Ｓ１０２に進み、目標上体姿勢が追従すべき基準上体姿勢軌道を規定する基準上体姿勢軌道パラメータが決定される。基準上体姿勢は、定常歩容の初期（第１旋回歩容の初期）と終端（第２旋回歩容の終端）とでつながるように（定常歩容の初期、終端での基準上体姿勢の姿勢角及びその角速度が一致するように）に設定されている限り、一定姿勢である必要はないが、本実施形態では理解を容易にするため、基準上体姿勢は、直立姿勢（鉛直姿勢）に設定される。つまり、本実施形態では、基準上体姿勢は、定常歩容の全期間において直立姿勢に設定される。従って、本実施形態では、基準上体姿勢の姿勢角の角速度及び角加速度は０である。
【０１６２】
次に、Ｓ１０４に進み、腕姿勢軌道パラメータ、より詳しくは鉛直軸（あるいは上体体幹軸）まわりの両腕体の角運動量変化に関すること以外の腕姿勢軌道パラメータが決定される。たとえば、上体２４に対する腕体の手先の相対高さや腕全体の相対重心位置などの腕姿勢軌道パラメータが決定される。なお、本実施形態では、腕全体の相対重心位置は、上体に対して一定に維持されるように設定される。
【０１６３】
次に、Ｓ１０６に進み、床反力鉛直成分軌道パラメータが設定される。この場合、該パラメータにより規定される床反力鉛直成分軌道が、第１旋回歩容及び第２旋回歩容のいずれにおいても図６のように実質的に連続な（値がステップ状に飛ばない）ものとなるように床反力鉛直成分軌道パラメータが設定される。すなわち、定常旋回歩容の目標床反力鉛直成分軌道は図１６のようなパターンで設定される。そのパターンでは、第１旋回歩容及び第２旋回歩容のいずれにおいても、片脚支持期では床反力鉛直成分が台形状に変化し、空中期では床反力鉛直成分が０に維持される。そして、このパターンの折れ点の時刻や、台形部分の高さ（ピーク値）が床反力鉛直成分軌道パラメータとして設定される。
【０１６４】
この床反力鉛直成分軌道パラメータの設定に際しては、床反力鉛直成分の歩容全期間（第１旋回歩容と第２旋回歩容両方の期間を合わせた期間で定常歩容の１周期の期間）における平均値をロボット１の自重と一致させる。すなわち、床反力鉛直成分の平均値がロボット１に作用する重力と同じ大きさで反対向きになるようにする。
【０１６５】
上記のごとく床反力鉛直成分軌道を設定することは、定常歩容の条件を満たすために必要である。定常歩容の条件とは、支持脚座標系（支持脚側足平２２の接地面に設定された座標系）から見た歩容のあらゆる状態変数（ロボット１の各部の位置、姿勢、速度等）の初期状態（第１旋回歩容の初期状態）と次の支持脚座標系（次の第１旋回歩容の支持脚座標系）から見た歩容の終端状態（第２旋回歩容の終端状態）が一致していることである（以下、この条件を定常歩容の境界条件ということがある）。従って、定常歩容終端におけるロボット１の全体重心鉛直速度と定常歩容初期における全体重心鉛直速度との差（詳細には、第２旋回歩容終端の全体重心鉛直速度と第１旋回歩容初期の全体重心鉛直速度との差）も零でなければならない。上記差は床反力鉛直成分と重力との差の積分値（１階積分値）であるから、上記差を零にするためには、上記のごとく床反力鉛直成分軌道を設定する必要がある。
【０１６６】
なお、本実施形態では、床反力鉛直成分の第１旋回歩容、第２旋回歩容それぞれの期間における平均値をロボット１の自重と一致させるようにした。より具体的には、例えば第１旋回歩容及び第２旋回歩容の歩容周期に応じて各旋回歩容における床反力鉛直成分軌道の台形部分の折れ点の時刻を設定した上で、その台形部分の高さを、床反力鉛直成分の第１旋回歩容、第２旋回歩容それぞれの期間における平均値がロボット１の自重と一致するように決定した（台形の高さを未知数として、上記平均値及び自重の一致条件を表す方程式を解くことで台形の高さを求める）。
【０１６７】
こうすることにより、第１旋回歩容終端の全体重心鉛直速度と第１旋回歩容初期の全体重心鉛直速度との差も０、第２旋回歩容終端の全体重心鉛直速度と第２旋回歩容初期の全体重心鉛直速度との差も０になる。但し、このようにする必然性はない。例えば、第１旋回歩容と第２旋回歩容との境界あたりで上体鉛直位置が高くなり過ぎたり低くなり過ぎたりして無理な姿勢になりそうな場合には、各旋回歩容で上記平均値及び自重を一致させた状態から各旋回歩容の床反力鉛直成分軌道の台形の高さ等を修正するようにしてもよい。
【０１６８】
次に、Ｓ１０８に進み、上記のごとく図１６のように設定された床反力鉛直成分軌道に応じて、床反力水平成分の許容範囲[Fxmin，Fxmax]（より詳しくはこれを規定するパラメータ）が図１７のように設定される。図１７の負側の折れ線が床反力水平成分許容下限値Fxmin、正側の折れ線が床反力水平成分許容上限値Fxmaxを表す。これらの設定方法に関して以下に補足する。以下では、床面が水平である場合について説明する。
【０１６９】
床反力水平成分は、床と足平２２との間の摩擦によって発生するが、摩擦はいくらでも発生できるわけではなく、限界がある。従って、生成された目標歩容に従って実際のロボット１が移動した時にスリップしないようにするためには、目標歩容の床反力水平成分が、常に摩擦限界以内になければならない。そこで、この条件を満足させるために、床反力水平成分許容範囲を設定し、後述するように、目標歩容の床反力水平成分がこの許容範囲内になるように、目標歩容を生成することとした。
【０１７０】
床と足平２２との間の摩擦係数をμとすると、Fxminは、常に−μ*床反力鉛直成分以上に、Fxmaxはμ*床反力鉛直成分以下に設定されなければならない。最も単純な設定方法は、次式による設定である。但し、kaは１より小さい正の定数である。
Figure 0003672101
【０１７１】
図１７の床反力水平成分許容範囲は、式１２に従って設定した例である。床反力水平成分許容範囲を規定するパラメータとして、図１７の台形波形などの折れ点での値と時刻を設定してもよいが、式１２により床反力水平成分許容範囲を決定するときには、単に式１２における(ka * μ)の値をパラメータとして設定するだけでもよい。
【０１７２】
なお、上記条件（目標歩容の床反力水平成分を常に摩擦限界以内にするという条件）を満足しているならば、他の設定方法で床反力水平成分許容範囲を設定するようにしても構わない。
【０１７３】
次に、Ｓ１１０に進み、第１旋回歩容及び第２旋回歩容を合わせた定常歩容のＺＭＰ軌道を規定するＺＭＰ軌道パラメータが設定される。この場合、目標ＺＭＰ軌道は、前述したように安定余裕が高くかつ急激な変化をしないように設定される。
【０１７４】
さらに詳細には、図５の走行歩容においては、支持脚足平２２のかかとで着地した後、しばらくして該支持脚足平２２の底面のほぼ全面が接地し、さらにしばらくして、支持脚足平２２のつま先だけが接地する。そして、次に支持脚足平２２のつま先で蹴って空中に飛び上がり、最後に遊脚足平２２のかかとで着地する。また、目標ＺＭＰは接地面内に存在しなければならない。
【０１７５】
そこで、本実施形態では、定常歩容の第１旋回歩容及び第２旋回歩容のそれぞれの目標ＺＭＰのＸ軸方向の位置は、前記図７の上段図に示したように、支持脚足平２２のかかとを初期位置として、該足平２２の底面のほぼ全体が接地するまでその位置に留まるように設定される。次に、目標ＺＭＰは支持脚足平２２の中央に移動し、該足平２２がつま先接地状態になるまでにつま先に移動し、その後、離床時まで支持脚足平２２のつまさきに留まるように設定される。さらにその後は、目標ＺＭＰは、前述のごとく、次の遊脚足平２２の着地までに目標ＺＭＰが、支持脚足平２２のつまさきから遊脚足平２２のかかとの着地位置まで連続的に移動するように設定される。
【０１７６】
従って、第１旋回歩容と第２旋回歩容とから成る定常歩容の目標ＺＭＰ軌道（Ｘ軸方向の軌道）は、図１８のようになる。そして、この目標ＺＭＰ軌道の折れ点の時刻及び位置がＺＭＰ軌道パラメータとして設定される。この場合、折れ点の時刻は、前記要求パラメータに応じて定めた第１旋回歩容及び第２旋回歩容の歩容周期に応じて設定され、該折れ点の位置は、次回歩容支持脚座標系及び次次回歩容支持脚座標系の位置姿勢あるいはこれらの座標系を規定する要求パラメータの１歩目及び２歩目の遊脚側足平着地予定位置姿勢の要求値に応じて設定される。なお、ＺＭＰ軌道のＹ軸方向の位置は、前記図７の下段図に示したものと同様に設定される。より詳しくは、第１旋回歩容における目標ＺＭＰのＹ軸方向位置の軌道は、図７の下段図のものと同一パターンで設定され、第２旋回歩容における目標ＺＭＰのＹ軸方向位置の軌道は、第１旋回歩容のものと同じ形の軌道で、該軌道の終端につながるものに設定される。
【０１７７】
最後に、Ｓ１１２に進み、定常歩容１歩（１周期）の初期時刻、終端時刻、期間が以下のように再定義される。
【０１７８】
定常歩容は、その初期と終端での状態変数が連続的につながる歩容でなければならない。このような歩容の決定を容易にするために、本実施形態では、定常歩容を決定するまでは、前述の狭義の歩容の定義とは異なり、定常歩容の１歩の初期、終端、期間を便宜上、図１６のように定める。すなわち、第１旋回歩容の片脚支持期の後半において床反力鉛直成分がある程度減少した時刻を定常歩容の初期時刻Tsとして設定する。なお、初期時刻Tsは、図７に示すように、支持脚足平２２の底面のほぼ全面が接地した状態からつま先接地に変わる瞬間あるいはその直前の時刻（図７の足底全面接地期間の終了時刻若しくはその直前の時刻）に設定するのが望ましい。また、Ｓ１１０において設定した図１８（又は図７）に示す目標ＺＭＰと時刻Tsとの関係を説明すると、第１旋回歩容において支持脚足平２２の底面のほぼ全面が接地した後に、目標ＺＭＰが支持脚足平２２の中央に移動し、つま先接地状態になるまでにつま先に移動を完了した瞬間が、時刻Tsとなっているのが望ましい。このような初期時刻Tsは例えば先に設定した目標ＺＭＰ軌道パラメータに応じて設定される。上記のごとく初期時刻Tsを設定する理由は後述する。
【０１７９】
また、図１６に示すように、定常歩容の周期Tcycは第１旋回歩容と第２旋回歩容の歩容周期の和である。定常歩容の終端時刻をTeとする。Teは、TsにTcycを加えた時刻に設定される。
【０１８０】
定常歩容が決定された時点（後述の図１９のＳ２０４のループを抜けた時点）から、改めて、歩容の初期、終端等の定義を、前述の狭義の歩容の定義に戻すこととする。以下の説明では、前述の狭義の歩容の定義による初期時刻（支持脚側足平２２の着地当初の時刻）を０とし、定常歩容を決定するまで用いる上記初期時刻Tsを参照符号Tsを用いて（単に「Ts」と省略することもある）本来の初期時刻０と区別する。
【０１８１】
図１２のＳ０１０からＳ０２２までに示す処理が行われた後、Ｓ０２４に進み、定常歩容の初期状態が算出される。ここで算出される初期状態は、定常歩容の初期上体水平位置速度（水平方向での初期上体位置及び初期上体速度）、初期上体鉛直位置速度（鉛直方向での初期上体位置及び初期上体速度）、初期発散成分、初期上体姿勢角及びその角速度である。この初期状態の算出は、図１９のフローチャートに従って、探索的に行なわれる。
【０１８２】
図１９フローチャートにおいては、先ず、Ｓ２００において、定常歩容の歩容パラメータ（前記図１２のＳ０２２で設定したパラメータ）に基づいて、目標足平位置姿勢、目標腕姿勢、及び目標上体姿勢角（姿勢角と方向）の初期状態（初期時刻Tsでの状態）が決定される。ここで状態とは、位置や姿勢角とその変化率（時間微分）とを表す。
【０１８３】
この場合、支持脚側の目標足平位置姿勢の初期状態は、前記図１４のＳ１００で決定した足平軌道パラメータの第１旋回歩容初期支持脚足平位置姿勢から、第２旋回歩容終端遊脚足平位置姿勢に至る足平位置姿勢軌道（次回歩容支持脚座標系から見た軌道）を時刻Tsまで有限時間整定フィルタにより生成することにより決定される。遊脚側の目標足平位置姿勢の初期状態は、次回歩容支持脚座標系から見た今回歩容初期支持脚足平位置姿勢から、第１旋回歩容終端遊脚足平位置姿勢に至る足平位置姿勢軌道を時刻Tsまで有限時間整定フィルタにより生成することにより決定される。
【０１８４】
また、目標腕姿勢の初期状態は、図１４のＳ１０４で決定した腕姿勢軌道パラメータに基づいて時刻Tsにおける腕姿勢（上体２４に対する両腕体の全体重心位置等）を求めることで決定される。また、目標上体姿勢角の初期状態は、図１４のＳ１０２で決定した基準上体姿勢軌道パラメータにより定まる時刻Tsにおける基準上体姿勢（姿勢角）及びその角速度が該目標上体姿勢角の初期状態として決定される。なお、本実施形態では、基準状態姿勢角は鉛直姿勢であるので、目標上体姿勢角の初期状態（姿勢角及びその角速度）は０である。
【０１８５】
また、本実施形態では、定常歩容の目標足平位置姿勢軌道、床反力鉛直成分軌道、及び目標ＺＭＰ軌道は、それぞれ、図１４のフローチャートで決定した足平軌道パラメータ、床反力鉛直成分軌道パラメータ、ＺＭＰ軌道パラメータにより互いに独立的に決定される。例えば定常歩容の瞬時瞬時の目標足平位置姿勢は、床反力鉛直成分の瞬時値に依存することなく足平軌道パラメータに応じて決定される。
【０１８６】
次いでＳ２０２において初期上体水平位置速度の候補（すなわち初期時刻Tsでの上体水平位置速度候補）である（Ｘs，Ｖxs）（Ｘs：水平位置、Ｖxs：水平速度）が仮決めされる。ここで仮決めする候補（Ｘs，Ｖxs）は、任意でよいが、例えば前回歩容の生成時に求めた定常歩容の初期状態における上体水平位置速度を仮決め候補（Ｘs，Ｖxs）とすればよい。
【０１８７】
なお、説明を簡略にするため、サジタルプレーン上でＸ方向（前後方向）での定常歩容の初期状態を探索する場合を例にとるが、実際には位置・速度ともＸ方向（前後方向），Ｙ方向（左右方向）を別々にあるいは同時に定常歩容の初期状態（定常歩容の前記境界条件を満たす初期状態）を探索する必要がある。
【０１８８】
探索的な決定手法としては、擬似ヤコビアン（感度マトリックス）を求め、最急降下法などにより次候補を決定する方法や、シンプレックス法などを用いればよい。本実施例では、最急降下法を用いる。
【０１８９】
次いで、Ｓ２０４を経てＳ２０６において、初期（時刻Ts）上体鉛直位置速度（Zs、Ｖzs）（Zs：鉛直位置、Ｖzs：鉛直速度）が決定される。
【０１９０】
初期上体鉛直速度Ｖzsは、本実施形態では以下のように解析的に決定される。
【０１９１】
ロボット１には、動力学的関係として、次式が成立する。
Figure 0003672101
（但し、重力加速度は負の値とする。）
【０１９２】
また、定常歩容では、終端全体重心鉛直位置と初期全体重心鉛直位置は一致するので、上式１３の右辺は零にならなければならない。従って、これらの関係から初期全体重心鉛直速度を求めることができる。具体的には、まず、前記図１４のＳ１０４で設定した床反力鉛直成分パラメータによって算出される床反力鉛直成分をロボット１の全体質量で割った値を１歩の期間（時刻Tsから時刻Teまで）２階積分することにより、床反力鉛直成分による全体重心移動量（式１３の右辺第１項）が求められる。さらに、重力加速度を一歩の期間２階積分することにより、重力による全体重心移動量（式１３の右辺第２項）が求められる。そして、上記求めた床反力による全体重心移動量と重力による全体重心移動量との和を符号反転し、これを１歩の時間（定常歩容の１周期Tcyclの時間）で割ることにより、初期全体重心鉛直速度が求められる。
【０１９３】
次に、初期上体鉛直位置Zsを求めるために、次式を用いて、時刻０の全体重心鉛直速度が求められる。この際、次式における時刻Tsの全体重心鉛直速度には、式１３に基づいて上記の通り求めた値を代入し、積分期間は時刻０から時刻Tsまでとする。
Figure 0003672101
（但し、重力加速度は負の値とする。）
【０１９４】
次に、本出願人が先に特開平１０−８６０８０号公報で提案した上体高さ決定手法を用いて時刻０における（すなわち着地瞬間における）上体高さ（上体鉛直位置）が決定される。このとき、時刻０における足平位置姿勢（前記図１４のＳ１００で決定した第１旋回歩容初期（時刻０）支持脚足平位置姿勢及び第１旋回歩容初期（時刻０）遊脚足平位置姿勢）と、各脚体２の膝部の曲げ角に関する所定の幾何学的条件とに基づいて、時刻０での各脚体２，２の膝部が伸び切らないような上体鉛直位置（上体高さ）が決定される。
【０１９５】
具体的には、支持脚側脚体２の膝曲げ角をθsup、遊脚側脚体２の膝曲げ角をθswgとしたとき、例えばそれらの膝曲げ角θsup，θswgの正弦値の逆数の和がある所定値（有限値）になるように、上体鉛直位置が決定される。ここで、膝曲げ角θsup，θswgは、各脚体２の大腿部の軸心に対する下腿部の軸心の角度であり、各脚体２が伸びきった状態から膝部を曲げていくに伴い、０から増加していく角度である。なお、このような上体２４の鉛直位置の決定手法は、上記特開平１０−８６０８０号公報に詳細に説明されているので、ここでは以上の説明に留める。
【０１９６】
次に、このように決定した時刻０における上体鉛直位置や、足平位置姿勢などから時刻０における全体重心鉛直位置がロボット１のモデルを用いて求められる。例えば図１０のモデルに対応する前記式０４のキネマティクスモデルを用いることで、時刻０における全体重心鉛直位置が求められる。具体的には、時刻０での上体鉛直位置と上体姿勢角（本実施形態では０）とから上体質点２４ｍの鉛直位置が求められ、時刻０での支持脚足平位置姿勢及び遊脚足平位置姿勢（これらは、前記図１４のＳ１００で設定した第１旋回歩容初期支持脚足平位置姿勢及び第１旋回歩容初期遊脚足平位置姿勢である）とからそれぞれ支持脚質点２ｍ及び遊脚質点２ｍの鉛直位置が求められる。
【０１９７】
そして、これらの求めた上体質点２４ｍ、支持脚質点２ｍ及び遊脚質点２ｍの鉛直位置を、前記式０４のＺb、Ｚsup、Zswgに代入することで、全体重心鉛直位置（式０４のＺGtotal）が求められる。なお、ロボット１のより厳密なモデル（例えば図１１に示すような多質点モデル）を用い、時刻０での上体水平位置や腕姿勢をも考慮して、時刻０での全体重心鉛直位置を求めるようにしてもよい。
【０１９８】
次に、前記式１３において、上記求めた時刻０における全体重心鉛直位置を同式１３の左辺の初期全体重心鉛直位置に代入し、上記求めた時刻０の全体重心鉛直速度を同式１３の右辺の初期全体重心鉛直速度に代入し、さらに、同式１３の１歩の時間をTsとし、積分期間を時刻０から時刻Tsまでとすることで、式１３の左辺の終端全体重心鉛直位置の値が算出され、この算出値が初期（時刻Ts）全体重心鉛直位置として得られる。さらに、この求めた初期（時刻Ts）全体重心鉛直位置と時刻Tsにおける足平位置姿勢（Ｓ２００で求めたもの）などから、ロボット１のモデル（例えば式０４のキネマティクスモデル）を用いて、初期（時刻Ts）上体鉛直位置Zsが求められる。具体的には、時刻Tsにおける支持脚及び遊脚の各平位置姿勢から、図１０のモデルの支持脚質点２ｍ及び遊脚質点２ｍの鉛直位置が求められ、これらの鉛直位置と、上記求めた初期（時刻Ts）全体重心鉛直位置とを式０４に適用することで、上体質点２４ｍの鉛直位置（式０４のZb）が求められる。
【０１９９】
そして、この上体質点２４ｍの鉛直位置と時刻Tsでの上体姿勢（本実施形態では０）とから逆算的に初期（時刻Ts）上体鉛直位置Zsが求められる。なお、この場合も、より厳密なモデルを用い、上体水平位置や腕姿勢をも考慮して初期上体鉛直位置Zsを求めるようにしてもよい。
【０２００】
最後に、前記Ｓ２００で決定した足平位置姿勢の初期状態や、Ｓ２０６で求めた初期全体重心鉛直速度等から、ロボット１のモデル（例えば式０４のキネマティクスモデル）を用いて、初期上体鉛直速度が求められる。具体的には、式０４の両辺を時間微分してなる式に、前記式１３に基づいて求めた初期全体重心鉛直速度と、支持脚側及び遊脚側の各足平位置姿勢の初期状態により定まる支持脚質点２ｍ及び遊脚質点２ｍの鉛直速度とを適用することで、上体質点２４ｍの鉛直速度が求められる。そして、この上体質点２４ｍの鉛直速度と上体姿勢角の初期状態（Ｓ２００若しくは後述のＳ２０８で決定されたもの）とから、上体鉛直速度が求められる。
【０２０１】
なお、各足平位置姿勢の初期状態や、初期全体重心鉛直速度のほか、腕姿勢の初期状態（Ｓ２００で決定されたもの）、仮決定した上体水平位置の初期状態（Ｓ２０２若しくは後述のＳ２１６若しくはＳ２１８で仮決定された最新のもの）、上記求めた初期上体鉛直位置を考慮し、上記求めた初期全体重心鉛直速度を満足するような初期上体鉛直速度を、ロボット１のより厳密なモデルを用いて求めるようにしてもよい。
【０２０２】
補足すると、ロボット１のモデルが図１１のような複雑なもの（厳密なモデル）であっても、ロボット１は、片脚当たり６自由度であることから、足平位置姿勢軌道及び上体位置姿勢軌道の初期状態（位置姿勢とその変化率）が与えられれば、ロボットの初期状態は一義的にすべて決定されることになる。従って、初期全体重心鉛直速度もこれらが与えられれば一義的に決定される。逆に、片脚当たり６自由度であることから、足平位置姿勢軌道及び上体位置姿勢軌道の初期状態の内で速度に関する状態のひとつ（例えば初期上体鉛直速度）が未定であっても、初期全体重心鉛直速度が与えられれば、未定の初期状態は一義的に決定される。
【０２０３】
Ｓ２０６の処理の後、次いでＳ２０８に進み、定常旋回歩容が仮に生成される。より具体的には、前記図１２のＳ０２２で決定した定常歩容の歩容パラメータを基に、初期時刻Tsから終端時刻Teまでの各瞬間における目標ＺＭＰ、目標床反力鉛直成分、目標足平位置姿勢、基準上体姿勢、目標腕姿勢及び床反力水平成分許容範囲が逐次求められる。そして、求めた目標ＺＭＰと目標床反力鉛直成分とに関する動力学的平衡条件、並びに床反力水平成分許容範囲の条件を満足するように、前記動力学モデル（図１０のモデル）を用いて、前記上体水平位置速度（Ｘs，Ｖｘs）、上体鉛直位置速度（Zs、Ｖｚs）を上体２４の初期（時刻Ts）状態として、上体位置姿勢を逐次決定することによって、時刻Tsから終端時刻Teまでの歩容を生成する。また、この時、上体姿勢は、基準上体姿勢になるべく一致するように生成される。
【０２０４】
なお、この定常歩容の歩容生成は歩容生成装置１００の内部で行われるだけであって、実際のロボット１を駆動するための目標値として、後述する複合コンプライアンス動作決定部１０４に出力されることはない。
【０２０５】
以下に、Ｓ２０８の処理である逐次演算による定常歩容生成処理の詳細を説明する。図２０はその処理を示すサブルーチンフローチャートである。
【０２０６】
以下説明すると、Ｓ３００において、諸々の初期化が行われる。具体的には、仮歩容生成用時刻kに初期時刻Tsを代入する。さらに、上体水平位置速度に、現在仮決定されている（Ｘs，Ｖｘs）（図１９のＳ２０２若しくは後述のＳ２１６若しくはＳ２１８で決定されたもの）が代入され、上体鉛直位置速度に、前記Ｓ２０６で求めた最新の（Zs、Ｖｚs）が代入される。また、目標上体姿勢角には、基準上体姿勢角初期値（時刻Tsでの基準上体姿勢角）、目標上体姿勢角速度には、基準上体姿勢角速度初期値（時刻Tsでの基準上体姿勢角速度）を代入する。補足すると、後述するごとく最終的には初期目標上体姿勢角速度は変更されるので、基準上体姿勢角速度初期値と異なる値を代入してもよい。
【０２０７】
次いで、Ｓ３０２を経てＳ３０４において、仮歩容生成用時刻kが歩容終端時刻以前であるか否か（k ≦ Ts + Tcycであるか否か）が判断され、その判断結果がＹＥＳである場合には、Ｓ３０６の歩容瞬時値決定サブルーチンに進み、歩容瞬時値が決定される。次いで歩容生成装置１００の処理は、Ｓ３０８に進み、仮歩容生成用時刻kをΔkだけ増やした後、Ｓ３０４に戻る。
【０２０８】
ここで、Δkは、仮歩容生成のインターバルであり、通常、制御周期Δｔと一致させておけばよい。なお、Δkは、仮歩容の動力学的精度を落としてもよいならば、演算量を低減するために、ΔkをΔｔよりも長く設定してもよい。
【０２０９】
Ｓ３０４の判断結果がＮＯである場合には、Ｓ３１０に進む。以上の処理により、Ｓ３１０に進むまでに定常歩容が初期から終端まで生成される。
【０２１０】
以下に、Ｓ３０６の歩容瞬時値決定サブルーチンの詳細を図２１を参照して説明する。
【０２１１】
まず図２１のＳ４００において、定常歩容パラメータ（床反力鉛直成分軌道パラメータ）を基に、前記図１６に示した目標床反力鉛直成分の時刻kにおける値（今回値）が求められる。さらに、Ｓ４０２において、定常歩容パラメータ（ＺＭＰ軌道パラメータ）を基に、前記図１８に示した目標ＺＭＰ軌道の時刻kにおける値（今回値）が求められる。
【０２１２】
次いでＳ４０４に進み、定常歩容パラメータ（足平軌道パラメータ、基準上体姿勢軌道パラメータ、及び腕姿勢軌道パラメータ）を基に、時刻kにおける目標両足平位置姿勢（支持脚側及び遊脚側の両者の目標足平位置姿勢）、基準上体姿勢及び目標腕姿勢の値（今回値）が求められる。但し、目標腕姿勢に関しては、より詳しくは両腕体の全体重心位置が決定されるが、鉛直軸（又は上体体幹軸）まわりの角運動量を変化させる腕体の運動（腕振り運動）は、未だ決定されていない。なお、目標足平位置姿勢の今回値（時刻ｋでの値）は、前記図１９のＳ２００で初期時刻Tsでの足平位置姿勢を求めた場合と同様に求められる。
【０２１３】
次いでＳ４０６に進み、目標床反力鉛直成分を満足する（ロボット１の鉛直方向の慣性力と重力との和を目標床反力鉛直成分に釣り合わせる）ような時刻kにおける全体重心鉛直位置速度の値（今回値）が算出される。具体的には、例えば前記図１０の動力学モデルに係わる前記式０１と式０４とに基づいて、全体重心鉛直位置速度が算出される。すなわち、式０１と式０４とによれば、ロボット１の運動による全体重心鉛直加速度と重力加速度との和にロボット１の全体質量を乗算したものが床反力鉛直成分に等しいという関係式（ロボット１の全体重心の鉛直方向に関する運動方程式）が得られる。従って、この関係式と目標床反力鉛直成分とから、全体重心鉛直加速度が求められる。
【０２１４】
なお、この関係式自体は、ロボット１のモデルに依存することなく一般的に成立するものである。そして、この求めた全体鉛直加速度を積分することにより、全体重心鉛直速度が算出され、さらにその全体重心鉛直速度を積分することにより、全体重心鉛直位置が算出される。これらの算出は、より一般的には、次式１５及び式１６で表される動力学関係式（ニュートンの運動方程式を離散化した式）を用いて行なわれる。
Figure 0003672101
【０２１５】
次いでＳ４０８に進み、全体重心鉛直位置を満足する上体鉛直位置が算出される。具体的には、例えば前記図１０のモデルに係わる式０４を用いて上体鉛直位置が算出される。すなわち、支持脚側及び遊脚側の目標足平位置姿勢の今回値から、図１０のモデルの支持脚質点２ｍ及び遊脚質点２ｍの鉛直位置が求められる。そして、これらの求めた支持脚質点２ｍ及び遊脚質点２ｍの鉛直位置と、Ｓ４０７で求めた全体重心鉛直位置の今回値とを式０４に適用することで、上体質点２４ｍの鉛直位置が求められる。さらに、この求めた上体質点２４ｍの鉛直位置と目標上体姿勢角の現在値（Ｓ４０４で設定された基準上体姿勢角又は後述のＳ４１４で決定された前回（時刻ｋ−Δｋ）の目標上体姿勢角）とから上体鉛直位置が求められる。
【０２１６】
なお、より厳密なモデル（例えば図１１に示すようにロボット１の各リンクに対応する質点をもたせたようなモデル）を用いて上体鉛直位置を求めてもよい。この場合には、前記求めた目標両足平位置姿勢の今回値（時刻ｋの値）、時刻(k−Δk)の目標上体姿勢（又は前記求めた基準上体姿勢の今回値）、前記求めた目標腕姿勢（両腕の重心位置）の今回値、時刻(k−Δk)の上体水平位置と、求めたい上体鉛直位置とから決定される全体重心鉛直位置が、前記求めた全体重心鉛直位置の今回値に一致するように上体鉛直位置が求められる。
【０２１７】
この場合、時刻kの上体姿勢と上体水平位置は、未だ決定されていないので、代わりに時刻(k−Δk)の値を用いた。より精度を高めるために、時刻kでの推定値を、時刻(k−Δk)での歩容状態から外挿によって求めてもよい。
【０２１８】
次いでＳ４１０に進み、前記図１４のＳ１０８で決定した歩容パラメータ（床反力水平成分許容範囲を規定するパラメータ）に基づいて、図１７に示した床反力水平成分許容範囲[Fxmin，Fxmax]の時刻kにおける値（今回値）が求められる。
【０２１９】
次いでＳ４１２に進み、目標ＺＭＰに関する動力学的平衡条件（ロボット１の慣性力と重力との合力が目標ＺＭＰまわりに発生するモーメントの水平成分が０であるという条件）を満足するように、上体水平加速度と上体姿勢角加速度との今回値が決定される。但し、床反力水平成分Fxが[Fxmin，Fxmax]を越えず、かつ、上体姿勢角速度が定常歩容の初期と終端とで一致するように、上体水平加速度と上体姿勢角加速度とが決定される。以下にこの詳細を説明する。
【０２２０】
この時点において、前記の如く足平位置姿勢及び上体鉛直位置の瞬時値（今回値）が決定されているので、残りの上体水平位置と上体姿勢角とを決定すれば、鉛直軸まわりの角運動量を変化させる腕体の運動自由度を除いて、ロボット１の目標運動は一義的に決定できる。従って、上体水平位置と上体姿勢角とを決定すれば、床反力の鉛直軸まわりのモーメントを除き、すべての床反力も一義的に決定される。なお、本実施形態では、定常歩容の目標床反力鉛直成分及び目標ＺＭＰは、それぞれ前記図１２のＳ０２２で決定した床反力鉛直成分軌道パラメータ及び目標ＺＭＰ軌道パラメータによって規定される。従って、上体水平位置と上体姿勢角の決定に応じて従属的に決定される床反力は、床反力水平成分のみである。また、補足すると、前述したように、ロボット１は片脚当たり６自由度であることから、目標足平位置姿勢と目標上体位置姿勢とから脚体２の各部の位置姿勢は一義的に決定される。なお、鉛直軸まわりの角運動量を変化させる腕の運動自由度は、後述するように、スピン力を打ち消すために用いられる。
【０２２１】
ところで、歩容生成において、前記上体並進モードをあまり用いずに主に上体回転モードを用いることにより、目標ＺＭＰを満足させる（目標ＺＭＰまわりの床反力モーメントの水平成分を０にする）と、上体姿勢角が大きく振れ過ぎてしまうおそれがある。従って、これを防ぐためには、なるべく上体並進モードを用いるべきである。しかし、上体並進モードは、床反力水平成分の変化を伴うので、床反力水平成分許容範囲が狭い場合には、上体並進モードを強く働かせるとスリップするおそれがある。この場合には、上体回転モードに頼るしかない。特に、前記走行歩容のように床反力水平成分許容範囲が０となる期間では、床反力水平成分を発生させるような歩容を生成することはできないので、上体回転モードに頼らざるを得ない。以上のことを考慮し、本実施形態では、図２２に示すフローチャートに従って、上体水平加速度と上体姿勢角加速度とが決定される。
【０２２２】
まず、Ｓ５００において、初期時刻Tsから第１旋回歩容の空中期を経て第２旋回歩容になり、床反力鉛直成分がある所定の大きさまで増加した時刻Tmが設定される。さらに、第２旋回歩容の片脚支持期の後半において床反力鉛直成分がある程度減少した時刻Ts2が設定される。さらに、第２旋回歩容の空中期を経て第１旋回歩容になり、床反力鉛直成分がある所定の大きさまで増加した時刻Tm2が設定される。
【０２２３】
図１６にこれらの時刻を示す。時刻Tmは、支持脚足平２２の底面のほぼ全面が接地した瞬間あるいはその直後に設定するのが望ましい。時刻Tm2も同様である。また、時刻Ts2は、前記初期時刻Ts同様、足平２２の底面のほぼ全面が接地した状態からつま先接地に変わる瞬間あるいはその直前に設定するのが望ましい。
【０２２４】
また、前記図１４のＳ１１０において設定した図１８の目標ＺＭＰとこれらの時刻Tm，Ts2，Tm2との関係を説明すると、第２旋回歩容において、目標ＺＭＰが、支持脚足平２２のかかとを初期位置として、該足平２２の底面のほぼ全体が接地するまでその位置に留まり、次に支持脚足平２２の中央に移動し始める瞬間を時刻Tmとすることが望ましい。その後、支持脚足平２２のつま先だけ接地した状態になるまでに、目標ＺＭＰがつま先に移動を完了した瞬間を、時刻Ts2とすることが望ましい。さらに次の第１旋回歩容において、目標ＺＭＰが、支持脚足平２２のかかとを初期位置として該足平２２の底面のほぼ全体が接地するまでその位置に留まり、次に支持脚足平２２の中央に移動し始める瞬間を時刻Tm2とすることが望ましい。上記のごとく設定する理由は後述する。
【０２２５】
次にＳ５０２において現在時刻（定常歩容作成用タイマーの値）kが、時刻TsからTmの間又は時刻Ts2からTm2の間にあるか否かが判定される。Ｓ５０２の判定結果がＹＥＳであるならば、Ｓ５０４に進み、ＮＯであるならばＳ５１８に進む。
【０２２６】
Ｓ５０４では、ロボット１の前回瞬時歩容状態（時刻ｋ−１の歩容状態）から、仮に、上体回転モードの角加速度を０にして、上体並進モードの運動をロボット１にさせた場合に今回（時刻ｋ）の目標ＺＭＰを満足するために必要な上体水平加速度αtmpが求められる。このαtmpは、例えば前記図１０の動力学モデルに係わる前記式０３を用いて求められる。より具体的には、例えば、現在時刻ｋまでに求められた目標足平位置姿勢の時系列値を用いて、現在時刻ｋにおける支持脚質点２ｍ及び遊脚質点２ｍの鉛直加速度が求められると共に、現在時刻ｋ（今回）の目標足平位置姿勢を用いて支持脚質点２ｍ及び遊脚質点２ｍの鉛直位置が求められる。
【０２２７】
また、現在時刻ｋ（今回）の床反力鉛直位置を用いて上体質点２４ｍの鉛直位置が求められると共に、現在時刻ｋまでに求めた目標上体鉛直位置の時系列値を用いて現在時刻ｋにおける上体質点２４ｍの鉛直加速度が求められる。そして、これらの求めた値を前記式０３に代入すると共に、同式０３のMy、d2θby/dt2を０にしてなる式を、d2Xb/dt2について解くことにより、上体質点水平加速度d2Xb/dt2が上体水平加速度αtmpとして求められる。
【０２２８】
なお、より厳密な動力学モデルを用いて、目標ＺＭＰ回りの床反力モーメントの水平成分を零にするような上体水平加速度αtmpを探索的に求めるようにしてもよい。また、本実施形態では、基準上体姿勢が鉛直姿勢で、基準上体姿勢による上体姿勢角加速度が０であるため、上体回転モードの角加速度を０にして上体水平加速度αtmpを求めるようにした。但し、基準上体姿勢が変化するように該基準上体姿勢軌道パラメータを設定した場合で、それにより定まる現在時刻ｋにおける基準上体姿勢角加速度が０でない場合には、上体回転モードの角加速度をその０でない基準上体姿勢角加速度の値にして、上体水平加速度αtmpを動力学モデルを用いて求める（例えば式０３のd2θby/dt2を０でない基準上体姿勢角加速度に設定して上記と同様に上体水平加速度αtmpを求める）ようにすればよい。
【０２２９】
次に、Ｓ５０６に進み、上体水平加速度がαtmpの場合の時刻ｋにおける床反力水平成分Fxtmpが動力学モデルを用いて求められる。本実施形態においては、前記動力学モデルの式０２を用いてFxtmpが求められる。すなわち、次式１７によってFxtmpが求められる。但し、d2Xsup／dt2及びd2Xswg／dt2はそれぞれ時刻ｋにおける支持脚足平質点水平加速度、遊脚足平質点水平加速度を表す。
Figure 0003672101
【０２３０】
このようにして求められるFxtmpの例を図２３に示す。図２３に、Fxtmpが床反力水平成分許容範囲[Fxmin，Fxmax]を越えている部分を斜線で示す。
【０２３１】
次に、Ｓ５０８に進み、上体並進モードの上体水平加速度α、これによって発生する床反力水平成分Fx、上体回転モードの上体角加速度βが次のように決定される（Ｓ５０８〜Ｓ５１６）。
【０２３２】
すなわち、
Fxtmp ＞ Fxmaxならば、Ｓ５１０に進み、次式によりＦxが決定される。
Fx = Fxmax …式１８
【０２３３】
Fxtmp ＜ Fxminならば、Ｓ５１２に進み、次式によりＦxが決定される。
Fx = Fxmin …式１９
【０２３４】
それ以外、すなわち、Fxtmpが、床反力水平成分許容範囲[Fxmin，Fxmax]内に存するならば、Ｓ５１４に進み、次式によりＦxが決定される。
Fx = Fxtmp …式２０
【０２３５】
いずれの場合においても、次いでＳ５１６に進み、次式により上体水平加速度α、上体姿勢角加速度βが決定される。
α =αtmp + (Fx−Fxtmp)/ ΔFp …式２１
β = (αtmp−α) *ΔMｐ /ΔMｒ …式２２
但し、ΔＦp、ΔMｐ及びΔMｒはそれぞれ前記式０６、０７、及び式０９により決定される。
【０２３６】
補足すると、より動力学演算の精度を高めようとするならば、上記のごとく上体角加速度βを求めた後、上体並進モードと上記求めた上体角加速度βの上体回転モードとを合成した運動が目標ＺＭＰを満足するように、上体並進モードの上体水平加速度αを、より厳密な動力学モデルを用いて解析的あるいは探索的に決定した方がよい。なお、探索的な決定法としては、擬似ヤコビアン（感度マトリックス）を求め、擬似ニュートン法などにより次候補を決定する方法や、シンプレックス法などを用いればよい。
【０２３７】
さらに床反力水平成分Fxが床反力水平成分許容範囲[Fxmin，Fxmax]を厳密に越えないようにするために、Ｓ５１０においては、Fx = Fxmax かつ目標ＺＭＰまわりの床反力モーメントの水平成分が０になるように、Ｓ５１２においては、Fx = Fxmin かつ目標ＺＭＰまわりの床反力モーメントの水平成分が０になるように、上体水平加速度αと上体角加速度βとの組を探索的に求めてもよい。
【０２３８】
上記のように求められるFxを図２４に示す。Fxは、Fxtmpの値を床反力水平成分許容範囲[Fxmin，Fxmax]から越えないように制限（飽和）させたものになっている。より詳しくは、上体並進モードのみによる上体水平加速度αtmpに応じたFxtmpが許容範囲[Fxmin，Fxmax]内にある場合には、FxtmpがそのままFxとなる。また、上体並進モードのみによる上体水平加速度αtmpに応じたFxtmpが許容範囲[Fxmin，Fxmax]の上限を超え、若しくは下限を下回った場合には、それぞれFxは、それぞれ強制的にFxmax、Fxminに制限される。特に走行歩容の空中期では、常に、Fxmax＝Fxmin＝０であるので、Fx＝０となる。
【０２３９】
また、上記のように求められる上体姿勢角加速度βを図２５に示す。上体並進モードによって発生するFxが許容範囲[Fxmin，Fxmax]を越えないように、上体並進モードの加速度を制限したことによって不足した床反力モーメント（より詳しくは目標ＺＭＰ回りの床反力モーメントの水平成分を０にする上で必要な慣性力モーメントから、制限した上体水平運動と両脚体２，２の運動とによるモーメント成分を差し引いたモーメント）を、上体回転モードで補ったことになる。なお、走行歩容の空中期では、上体並進モードによる上体水平加速度αは常に０に制限されることとなるので、上体回転モードによる上体姿勢角加速度βのみによって、上記不足分の床反力モーメントが補われることとなる。
【０２４０】
以上が、時刻ｋが時刻TsからTmの間又は時刻Ts2からTm2の間の場合の処理である。
【０２４１】
Ｓ５０２の判定結果がＮＯである場合には以下の処理が行われる。まず、Ｓ５１８に進み、上体姿勢角速度を、現在時刻ｋが時刻Ts2以前ならば時刻Ts2までに、そうでないならば時刻Teまでに、初期値（現在時刻ｋが時刻Ts2以前ならば時刻Tsでの値、そうでないならば時刻Ts2での値）に戻すための上体姿勢角加速度を発生させる床反力モーメントのＺＭＰ換算値（以降、上体姿勢復元モーメントＺＭＰ換算値と呼び、ＺＭＰrecと略す）のパターンを設定する。
【０２４２】
これについて以下に詳細に説明する。現在時刻ｋが時刻Tm2以降の時期の処理は、時刻Ts2以前の時期の処理と同様なので、現在時刻ｋが時刻Ts2以前までの時期の処理だけを解説する。
【０２４３】
時刻Tmから時刻Ts2までに、上体回転モードを用いて上体姿勢角加速度を発生させることにより、上体姿勢角速度を初期値（時刻Tsでの値）に戻すことを考える。このための上体姿勢角加速度パターンを、β(ｋ)とする。
【０２４４】
上体回転モードでは、上体姿勢角加速度β(ｋ)を発生させようとすると、床反力モーメントβ(ｋ)*ΔMｒが発生する。この結果、その瞬間における床反力鉛直成分がFz(ｋ)であるとすると、（目標ＺＭＰでなく）運動から算出されるＺＭＰ(ｋ)は、次式で求められるΔＺＭＰだけずれる。
ΔＺＭＰ(ｋ) =−β(ｋ)＊ΔMｒ/Fz(ｋ) …式２３
【０２４５】
従って、ΔMｒのパターンとFz(ｋ)のパターンが決まっていれば（既知であれば）、ΔＺＭＰ(ｋ)のパターンを適当に設定することによって、式２３を満足する上体姿勢角加速度パターンを発生させて、上体姿勢角速度を初期値（時刻Tsでの値）、すなわち基準上体姿勢軌道の初期（時刻Ts)状態における上体姿勢角速度に戻すことができる。
【０２４６】
前記上体姿勢復元モーメントＺＭＰ換算値（ＺＭＰrec）は、そのように適切に設定されたΔＺＭＰ(ｋ)を意味する。前記式２３を用いて上体姿勢復元モーメントＺＭＰ換算値を設定する際に、ΔMｒは厳密には変動するが、近似的に一定値としてもよい。定常歩容は仮に生成されるだけであり、実際のロボットをこの歩容に追従させるわけではないので、定常歩容の動力学的精度はあまり高くなくてもよいからである。
【０２４７】
図２６にＺＭＰrecの一例を示す。図２６では、そのパターンは台形パターンとされている。その台形部の折れ点の時刻は、時刻Tmと時刻Ts2との間の期間における目標ＺＭＰパターンの折れ点の時刻（図１８参照）に一致させてある。これは、後述するが、今回歩容の目標ＺＭＰパターンの修正が簡単になるからである。式２３のΔＺＭＰ(ｋ)にＺＭＰrecを代入することにより次式が得られる。
β(ｋ) =−ＺＭＰrec＊ Fz(ｋ)/ΔMｒ …式２４
【０２４８】
従って、この式２４で求められるβ(ｋ)は、図２７の実線で示すようになる。なお、図２７の点線で示すものは、時刻Tsから時刻Tmまでの上体姿勢角加速度（図２５の実線示のもの）である。
【０２４９】
ところで、定常歩容では、時刻Ts2での上体姿勢角速度が時刻Tsでの上体姿勢角速度に一致していることが望ましい。一致していると、上体姿勢角の変動が小さくなるからである。
【０２５０】
そこで、時刻Ts2での上体姿勢角速度を時刻Tsでの上体姿勢角速度に一致させるため、時刻TsからTs2までの上体姿勢角加速度βの積分値が０になるように、上体姿勢角加速度パターンを設定する。すなわち、時刻Tmから時刻Ts2までの期間のβ(ｋ)の積分値（図２７の実線部の積分値）が、時刻Tsから時刻Tmまでの上体姿勢角加速度（これは図２２のＳ５０４〜Ｓ５１６で前述のように求められる）の積分値（図２７の点線部の積分値、言い換えれば時刻Tmにおける上体姿勢角速度と時刻Tsにおける上体姿勢角速度の差）に−１を乗じた値になるように設定される。
【０２５１】
より具体的には、本実施形態では、図２６のＺＭＰrecの台形パターンにおいて、台形の折れ点の時刻（これは前述のように定常歩容の目標ＺＭＰ軌道に基づいて決定される）を既知とし、台形高さを未知数とすることで、上記関係を満足するＺＭＰrecの台形高さ（ＺＭＰrecパターンを規定するパラメータ）が求められる。
【０２５２】
第１旋回歩容におけるＺＭＰrecの台形高さを第１旋回歩容上体姿勢復元モーメントＺＭＰ換算値台形高さacyc1と呼ぶ。第２旋回歩容におけるＺＭＰrecの台形高さを第２旋回歩容上体姿勢復元モーメントＺＭＰ換算値台形高さacyc2と呼ぶ。なお、第２旋回歩容におけるＺＭＰrecは、時刻Tm2からTeまでの期間で設定される台形パターンである。
【０２５３】
補足すると、今回歩容を１歩生成している途中で歩容パラメータが変更されない限り、時刻TmとTs2との間の期間、又は時刻Tm2とTeとの間の期間においてＳ５１８で決定されるＺＭＰrecパターンは変わらない（同一パラメータ値が算出される）ので、Ｓ５１８の処理は、時刻Tmと時刻Tm2でのみ実行してもよい。
【０２５４】
次いでＳ５２０に進み、時刻ｋにおける上体姿勢復元モーメントＺＭＰ換算値ＺＭＰrecの瞬間値（今回値）が、上記のごとく決定したパラメータ（台形高さ）を基に算出される。
【０２５５】
次いでＳ５２２に進み、前記式２４を用いて、時刻ｋにおける上記上体姿勢角加速度パターンの瞬間値（今回値）βが算出される。
【０２５６】
次いでＳ５２４に進み、ロボットの前回瞬時目標歩容状態（時刻ｋ−１の目標歩容状態）から、仮に上体回転モードをさせずに上体並進モードの運動のみをさせた場合に、今回（時刻ｋ）の目標ＺＭＰを満足するために必要な上体水平加速度αtmpが、ロボット１の動力学モデルを用いて求められる。この算出は、Ｓ５０４と同様に行なわれる。
【０２５７】
次いでＳ５２６に進み、次式を用いて、上体並進モードの上体水平加速度αが算出される。
α = αtmp−（ΔMｒ /ΔMｐ）* β …式２５
【０２５８】
さらにＳ５２８に進み、上体水平加速度が上記の如く求めたαである場合の時刻ｋにおける床反力水平成分Fxが、前記式１７と同様の次式２６によって求められる。
Figure 0003672101
【０２５９】
補足すると、より動力学演算の精度を高めようとするならば、上記のごとく上体角加速度βを求めた後、Ｓ５２６において、式２５を用いた上体水平加速度αの算出を実行する代わりに、Ｓ５１６の補足で解説した手法と同様、上体並進モードと上記求めた上体角加速度βの上体回転モードを合成した運動が目標ＺＭＰを満足するように、上体並進モードの上体水平加速度αを、より厳密な動力学モデルを用いて、解析的あるいは探索的に決定した方がよい。
【０２６０】
以上が、時刻ｋが時刻TsからTmの間又は時刻Ts2からTm2の間のいずれでもない場合の処理である。
【０２６１】
以上の処理を時刻Ts2まで完了した時の、床反力水平成分Fxを図２８に示す。さらに、以上の処理を時刻Teまで完了した時の、床反力水平成分Fxを図２９に、上体姿勢角加速度βを図３０に示す。なお、以上に示したＳ４１２の処理（上体水平加速度と上体姿勢角加速度を決定するサブルーチン）は、時刻ｋにおける上体水平加速度と上体姿勢角加速度の瞬間値が決定されるのであって、時刻Teまでのこれらの時系列が一度に生成されるわけではない。
【０２６２】
なお、本実施形態では、基準上体姿勢が鉛直姿勢で、基準上体姿勢による上体姿勢角加速度が０であるため、上記の如く求めた上体回転モードの角加速度βをＳ４１２の処理で決定される上体姿勢角加速度とした。但し、基準上体姿勢が変化するように該基準上体姿勢軌道パラメータを設定した場合には、上記の如く求めた上体回転モードの角加速度βと基準上体姿勢角加速度の和をもって、Ｓ４１２の処理で決定される上体姿勢角加速度とすべきである。
【０２６３】
時刻Ts、Tm、Ts2及びTm2を前記のごとく設定した理由は、時刻TmからTs2までの期間と時刻Tm2からTeまでの期間とにおいて、上体姿勢角速度を基準上体姿勢軌道の初期角速度に戻すように上体姿勢角加速度βを発生させても、床反力水平成分Fxが許容範囲[Fxmin，Fxmax]を越えないようにするためである。換言すれば、時刻TmからTs2までの期間と時刻Tm2からTeまでの期間とにおいては、床反力水平成分許容範囲が十分に大きいため、目標ＺＭＰを満足しつつ、上体姿勢角速度を戻すように上体姿勢角加速度βを発生させても、床反力水平成分Ｆxは、許容範囲を越えることがない。
【０２６４】
また、時刻Tsでの上体姿勢角速度を時刻Tsでの上体姿勢角速度に一致させることを考えず、acyc1とacyc2を同一値として（acyc1＝acyc2として）、時刻Teでの上体姿勢角速度と時刻Tsでの上体姿勢角速度に一致させるようにacyc1及びacyc2の値を決定してもよい。
【０２６５】
次いで図２１のＳ４１４に進み、Ｓ４１２で求めた上体水平加速度を逐次積分する（時刻Tsから現在時刻ｋまで累積加算する）ことにより上体水平速度が求められ、さらにその上体水平速度を逐次積分する（時刻Tsから現在時刻ｋまで累積加算する）ことにより、上体水平位置（今回値）が求められる。また、Ｓ４１２で求めた上体姿勢角加速度を逐次積分する（時刻Tsから現在時刻ｋまで累積加算する）ことにより上体姿勢角速度が求められ、さらにその上体姿勢角速度を逐次積分する（時刻Tsから現在時刻ｋまで累積加算する）ことにより、上体姿勢角（今回値）が求められる。
【０２６６】
以上のごとく図２０のＳ３０６の定常歩容瞬時値決定サブルーチンが実行された後、Ｓ３０８に進み、歩容生成用時刻kの値が歩容生成インターバルΔｋだけ増加される。次いでＳ３０４に戻り、Ｓ３０４に示す条件が成立している限り、Ｓ３０６とＳ３０８の処理が繰り返され、Ｓ３０４に示す条件が成立しなくなったら、すなわち終端（時刻Te＝Ts＋Tcyc）まで仮定常歩容の生成が完了したら、Ｓ３１０に進む。Ｓ３１０では、次式に従って初期（時刻Ts）上体姿勢角と初期（時刻Ts）上体姿勢角速度が、上記求めた仮歩容の終端（時刻Te）上体姿勢角などを基に修正される。この修正は、上体姿勢角及びその角速度に関する定常歩容の境界条件（定常歩容の初期と終端とで上体姿勢角及び角速度を一致させる）を満たすようにするためのものである。なお、ここでの説明では、ロボット１の歩容は、該ロボット１を直線的に移動させる歩容であるとする。
【０２６７】
この場合、次式の新たな値が修正された値である。
Figure 0003672101
【０２６８】
ここで、上記式３０により初期状態姿勢角速度を修正する理由を以下に説明する。定常歩容では、それを繰り返したときに境界でロボット１の運動状態が不連続にならないように（前記境界条件を満たすように）初期状態姿勢角及びその角速度を決定する必要がある。この場合、上述のように求めた仮定常歩容の終端上体姿勢角速度は、前述した上体姿勢復元モーメントＺＭＰ換算値ＺＭＰrecに対応する上体姿勢角加速度パターンの設定によって、初期上体姿勢角速度初期値（基準上体姿勢角速度初期値）に一致するように生成されているので、残りの条件である次式を満たせば、上体姿勢角及び角速度に関する上記条件を満足する。
終端上体姿勢角 ＝ 初期上体姿勢角 …式３２
【０２６９】
また、
上体姿勢角の２階微分 = 上体姿勢角加速度 …式３３
であるから、この式３３の両辺を定常歩容の初期から終端まで２階積分することにより、次式の関係を得る。
Figure 0003672101
【０２７０】
一方、定常歩容生成においては、前記の如く目標ＺＭＰを満足するために、基本的には上体並進運動モードを用いて上体２４の水平加速度（水平加減速）を調整するが、目標ＺＭＰを満足するための上体２４の水平加速度が、十分に発生できない状況（十分な摩擦力が発生できない状況）では、上体回転運動モードを用いて全体重心加速度が変わらないようにしつつ上体姿勢角の角加速度を調整することで、上体並進運動モードによる上体水平加速度の不足分が補われる。
【０２７１】
上記上体回転運動モードを用いて上体姿勢角加速度を調整する動作は、図１０に示すフライホイールFHが備わったロボット１において、そのフライホイールFHの角加速度を調整することと近似的に等価である。フライホイールFHの回転速度が０に近いならば、ジャイロ効果は発生せず、フライホイールFHが発生する力は、フライホイールFHの角加速度だけで決定される。従って、上体２４にフライホイールFHが備わったロボット１においては、フライホイールFHの初期角度・角速度が多少変わっても、該フライホイールFHを同じパターンの角加速度で動かせば、発生する力はほとんど変わらない。それ故、ロボット動力学方程式である式０１、式０２、式０３ではジャイロ効果を無視している。
【０２７２】
従って、本実施形態のロボット１において、式０１、式０２、式０３、あるいは、より一般的で厳密な動力学モデルのいずれを用いた場合でも、全体重心加速度が変わらないようにしつつ上体姿勢角を同じパターンの角加速度で動かせば（すなわち上体回転運動モードを用いて、上体姿勢角を同じパターンの角加速度で動かせば）、初期上体姿勢角度・角速度を少々変えても、発生する慣性力と重力との合力はほぼ同じになる。言い換えれば、初期上体姿勢角度・角速度を少々変えても、上記のフローチャートに従って生成される歩容の上体姿勢角加速度は同じになる。
【０２７３】
つまり、式３４における上体姿勢角加速度の２階積分値は、初期上体姿勢角度・角速度に依存しなくなる。すなわち、式３４における上体姿勢角加速度の２階積分値は、初期上体姿勢角度・角速度の値に関わらず、一定値として扱うことができる。
【０２７４】
初期上体姿勢角の値が仮歩容の初期上体姿勢角、かつ初期上体姿勢角速度の値が仮歩容の初期上体姿勢角速度であった場合に、終端上体姿勢角が仮歩容の終端上体姿勢角になったのであるから、この関係を式３４に代入して次式を得る。
Figure 0003672101
【０２７５】
上記議論により上体姿勢角加速度の２階積分値は定数扱いできる（初期上体姿勢角度・角速度に依存しない）ので、上式を式３４に代入し、次式が得られる。
Figure 0003672101
【０２７６】
式３７と式３２とから前記式３０が得られる。
【０２７７】
なお、初期上体姿勢角は、本実施形態では、式３１のように基準上体姿勢角初期値に一致させるようにしたが、定常歩容の上体姿勢角の平均値が基準上体姿勢角初期値に一致するように初期上体姿勢角を設定するようにしてもよい。あるいは、定常歩容の上体姿勢角の最大値と最小値の平均値が基準上体姿勢角初期値に一致するように初期上体姿勢角を設定してもよい。
【０２７８】
また、前記ではロボット１を直進移動させる場合に限定した例を説明したが、旋回移動を含む定常歩容を決定する場合には、その初期と終端とではロボット１の進行方向が変わる。このため初期上体姿勢角速度は初期上体姿勢角に依存するようになる。従って、これを考慮して初期上体姿勢角及び角速度を決定する必要がある。この場合には、例えば次の式３７ａ、３７ｂを満たすように初期上体姿勢角及び初期上体姿勢角速度を更新するようにすればよい。
Figure 0003672101
【０２７９】
なお、式３７ａ、３７ｂのそれぞれの右辺第１項の積分期間は、時刻TsからTmまでの期間と、Ts2からTm2までの期間とを合わせた期間であり、右辺第２項の積分期間は、時刻TmからTs2までの期間とTm2からTeまでの期間とを合わせた期間である。
【０２８０】
より具体的に説明すると定常歩容では、第１旋回歩容の支持脚座標系（次回歩容支持客座標系）から見た初期状態姿勢角及び角速度が、それぞれ、次の第１旋回歩容の支持脚座標系（次次次回歩容支持脚座標系）から見た終端上体姿勢角及び角速度に一致していなければならない。そこで、本実施形態では、新たな初期上体姿勢角は、前記式３１により決定し、この新たな初期上体姿勢角と、これを定常歩容におけるロボット１のトータルの旋回角（鉛直軸回りの旋回角）に応じたマトリクス（回転座標変換のマトリクス）により次回歩容支持脚座標系から見た値に座標変換したものとをそれぞれ式３７ａの左辺の初期上体姿勢角、終端上体姿勢角に代入する。また、式３７ａ，３７ｂのそれぞれの右辺第１項の積分に係る上体姿勢角加速度は、前記図２２のＳ５１６で逐次求められたものが用いられる。
【０２８１】
そして、式３７ａ，３７ｂの初期上体姿勢角速度と、式３７ａ，３７ｂの右辺第２項の積分に係るＺＭＰrec（図２６の台形状のパターン）の台形高さをと未知数として（但し、ＺＭＰrecの台形パターンの折れ点の時刻はあらかじめ定める。また、第１旋回歩容のＺＭＰrecの台形高さacyc1と第２旋回歩容のＺＭＰrecの台形高さacyc2を同一値とする。）、それらの未知数を含む式３７ａ，３７ｂの連立方程式を解くことにより求められる初期上体姿勢角速度を新たな初期上体姿勢角速度として決定する。この場合、式３７ｂの終端上体姿勢角速度は、未知数である初期上体姿勢角速度を、定常歩容の上記トータルの旋回角に応じたマトリクスにより次回支持脚座標系から見た値に座標変換したものである。
【０２８２】
ロボット１の移動が旋回を含む移動である場合には、上記のようにして、新たな初期上体姿勢角及び角速度を決定すればよい。
【０２８３】
なお、定常歩容の境界条件を満たすような初期上体姿勢角速度を探索的に求めることも可能である。
【０２８４】
図２０のＳ３１０の処理を完了した後、図１９のＳ２１０に進み、生成した歩容（仮定常歩容）の終端上体水平位置・速度を、その瞬間の支持脚に対応する支持脚座標系（図３１のＸ'''，Ｙ''' ，Z'''座標系）から見た値に変換し、その値を（Ｘｅ，Ｖｘｅ）とする（Ｘｅ：終端上体水平位置、Ｖｘｅ：終端上体水平速度）。
【０２８５】
次いでＳ２１２に進み、図示の如く、初期上体水平位置速度（Ｘｓ，Ｖｘｓ）と終端上体水平位置速度（Ｘｅ，Ｖｘｅ）との差を算出する。この差（Ｘｓ−Ｘｅ，Ｖｘｓ−Ｖｘｅ）を上体水平位置速度境界条件誤差（errx，errvx）と呼ぶ。定常歩容では、前記境界条件を満たす必要があるので、（Ｘｓ，Ｖｘｓ）と（Ｘｅ，Ｖｘｅ）とが一致していなければならない。従って、上体水平位置速度境界条件誤差（errx，errvx）が零又はほぼ零でなければならない。本実施形態では、以下のように、上体水平位置速度境界条件誤差（errx，errvx）がほぼ零となる（Ｘｓ，Ｖｘｓ）が探索的に求められる。
【０２８６】
次いでＳ２１４に進み、算出した上体水平位置速度境界条件誤差（errx，errvx）が、あらかじめ適宜設定された許容範囲内にあるか否かが判断される。なお、このように上体水平位置速度境界条件誤差の許容範囲を設定する代わりに、初期発散成分（Ｘｓ＋Ｖｘｓ／ω0）と終端発散成分（Ｘｅ＋Ｖｘｅ／ω0）との差、及び初期収束成分（Ｘｓ−Ｖｘｓ／ω0）と終端収束成分（Ｘｅ−Ｖｘｅ／ω0）との差がそれぞれある許容範囲内にあるか否か判断するようにしてもよい。但しω0は、前述したように、ある所定の値である。
【０２８７】
Ｓ２１４の判断結果がＮＯであるときにはＳ２１６に進む。このＳ２１６では、（Ｘｓ，Ｖｘｓ）の付近に複数（本実施形態では２つ）の初期値候補（Ｘｓ＋ΔＸｓ，Ｖｘｓ），（Ｘｓ，Ｖｘｓ＋ΔＶｘｓ）が決定される。ここで、ΔＸｓ，ΔＶｘｓは、それぞれＸｓ，Ｖｘｓに対する所定の微小変化量を意味している。そして、これらの初期値候補のそれぞれを上体水平位置速度の初期状態として、前記Ｓ２０８と同様の処理によって定常歩容が歩容パラメータを用いて生成される。
【０２８８】
さらに、その生成された定常歩容の終端上体位置速度を、その瞬間の支持脚に対応する支持脚座標系（図３１のＸ'''，Ｙ''' ，Z'''座標系）から見た値に変換した値（Ｘｅ＋ΔＸｅ１，Ｖｘｅ＋ΔＶｘｅ１），（Ｘｅ＋ΔＸｅ２，Ｖｘｅ＋ΔＶｘｅ２）が求められる。ここで、（Ｘｅ＋ΔＸｅ１，Ｖｘｅ＋ΔＶｘｅ１）は（Ｘｓ＋ΔＸｓ，Ｖｘｓ）に対応する終端上体位置速度を意味し、（Ｘｅ＋ΔＸｅ２，Ｖｘｅ＋ΔＶｘｅ２）は（Ｘｓ，Ｖｘｓ＋ΔＶｘｓ）に対応する終端上体位置速度を意味している。なお、この場合の定常歩容（仮歩容）の生成処理では、上体水平位置速度以外の変数の初期状態（時刻Ｔｓでの状態）は、例えば上体水平位置速度の初期値候補を（Ｘｓ，Ｖｘｓ）とした場合と同一に設定すればよい。
【０２８９】
Ｓ２１６ではさらに、前記Ｓ２１０と同様の処理によって、各初期値候補とこれに対応する終端上体位置速度との差、すなわち、各初期値候補（Ｘｓ＋ΔＸｓ，Ｖｘｓ），（Ｘｓ，Ｖｘｓ＋ΔＶｘｓ）のそれぞれに対応する上体水平位置速度境界条件誤差が求められる。
【０２９０】
次いでＳ２１８に進み、（Ｘｓ，Ｖｘｓ）及びその付近の初期値候補（Ｘｓ＋ΔＸｓ，Ｖｘｓ），（Ｘｓ，Ｖｘｓ＋ΔＶｘｓ）のそれぞれに対する上体水平位置速度境界条件誤差を基に、（Ｘｓ，Ｖｘｓ）の次の初期値候補が探索法（擬似ヤコビアン（感度マトリックス）を求め、最急降下法などにより次候補を決定する方法や、シンプレックス法など）により決定される。すなわち、（Ｘｓ，Ｖｘｓ）及びその付近の初期値候補（Ｘｓ＋ΔＸｓ，Ｖｘｓ），（Ｘｓ，Ｖｘｓ＋ΔＶｘｓ）のそれぞれに対する上体水平位置速度境界条件誤差によって、上体水平位置及び上体水平速度をそれぞれ初期値候補（Ｘｓ，Ｖｘｓ）から微小変化させたときの、上体水平位置速度境界条件誤差の変化度合いを示す感度マトリックスが求められ、その感度マトリックスに基づいて、上体水平位置速度境界条件誤差をより小さくするような初期値候補（Ｘｓ，Ｖｘｓ）が新たに決定される。そして、このように上体水平位置速度の新たな初期値候補（Ｘｓ，Ｖｘｓ）が決定された後、Ｓ２０６に戻る。
【０２９１】
Ｓ２１４の判断結果がＮＯとなる限りは上記した処理（Ｓ２０６〜Ｓ２１８の処理）が繰り返される。なお、この場合、上体水平位置速度の新たな初期値候補（Ｘｓ，Ｖｘｓ）に対応する定常歩容の生成処理（Ｓ２０８）におけるＳ３００（図２０参照）では、上体姿勢角速度の初期値は、基準上体姿勢角速度の初期値ではなく、上体水平位置速度の前回の初期値候補（Ｘｓ，Ｖｘｓ）に対応するＳ２０８の処理におけるＳ３１０（図２０参照）で決定したものに設定される。そして、Ｓ２１４の判断結果がＹＥＳになると、繰り返しループ（Ｓ２０４）を抜けてＳ２２０に進む。なお、Ｓ２０４の繰り返しループを抜けたときの直前に生成された仮定常歩容が、境界条件を満たす定常歩容として得られることとなる。
Ｓ２２０では、本来の初期時刻０（今回歩容の終端時刻）における初期上体水平位置速度（Ｘ0，Ｖ0）と初期時刻０における初期上体鉛直位置速度（Ｚ0、Ｖｚ0）と初期時刻０における初期上体姿勢角及び角速度が求められる。
【０２９２】
具体的には、（Ｘ0，Ｖ0）と（Ｚ0，Ｖｚ0）は、前記図２１に示した定常歩容瞬時値決定サブルーチンのＳ４０８及びＳ４１４において、第２旋回歩容から第２旋回歩容に切り換わった瞬間の時刻、すなわち、時刻ｋ＝Tcyc（時刻Te−Ts）であるときに決定された上体水平位置速度と上体鉛直位置速度とを、それぞれ時刻Tcycから始まる一歩（すなわち２度目の第１旋回歩容）の支持脚に対応する支持脚座標系（図３１のＸ'''，Ｙ'''，Z'''座標系）から見た値に変換した値に決定される。同様に、初期状態姿勢角及び角速度は、時刻ｋ＝Tcyc（時刻Te−Ts）であるときに決定された上体姿勢角及び角加速度を、時刻Tcycから始まる一歩（すなわち２度目の第１旋回歩容）の支持脚に対応する支持脚座標系（図３１のＸ'''，Ｙ'''，Z'''座標系）から見た値に変換した値に決定される。
【０２９３】
次いでＳ２２２に進み、定常歩容初期発散成分ｑ［０］が次式から求められる。
ｑ[0] = Ｘ0 + Ｖ0／ω0 …式４０
但しω0は、発散についての解説で述べたように、ある所定の値である。
【０２９４】
さらに、Ｓ２２４に進み、定常歩容初期発散成分ｑ［０］が今回歩容支持脚座標系から見た値に変換され、これがｑ”［０］として求められる。また、初期上体鉛直位置速度（Ｚ０，Ｖｚ０）が今回歩容支持脚座標系から見た値に変換され、これが（Z０”，Ｖｚ０”）として求められる。
【０２９５】
補足すると、（Ｚ０”，Ｖｚ０”）は、第２旋回歩容の支持脚座標系（図１５のＸ”，Ｙ”，Ｚ”座標系）から見た第２旋回歩容終端上体鉛直位置速度に一致している。また、ｑ”［０］も第２旋回歩容の支持脚座標系（図１５のＸ”，Ｙ”，Ｚ”座標系）から見た第２旋回歩容終端発散成分に一致している。従って、これらの性質を用いて、（Ｚ０”，Ｖｚ０”）及びｑ”［０］を算出するようにしてもよい。
【０２９６】
以上により、図１２のＳ０２４の処理、すなわち定常歩容の初期状態を求めるサブルーチン処理が終了する。
【０２９７】
次いで、図１２のＳ０２６に進み、今回歩容の歩容パラメータを決定（一部は仮決定）する。Ｓ０２６では、より具体的には、図３２に示すフローチャートに従って、以下の処理が行われる。
【０２９８】
まず、Ｓ６００において、今回歩容の足平位置姿勢軌道が定常歩容の足平位置姿勢軌道につながるように、今回歩容の足平軌道パラメータが設定される。
【０２９９】
具体的には、今回歩容初期遊脚足平位置姿勢（今回歩容遊脚足平位置姿勢の初期値）は、今回歩容支持脚座標系から見た現在遊脚位置姿勢（前回歩容終端遊脚位置姿勢）に設定される。今回歩容初期支持脚足平位置姿勢（今回歩容支持脚足平位置姿勢の初期値）は、今回歩容支持脚座標系から見た現在支持脚足平位置姿勢（前回歩容終端支持脚足平位置姿勢）に設定される。また、今回歩容終端遊脚足平位置姿勢は、今回歩容支持脚座標系から見た次回歩容支持脚座標系（今回歩容に係わる１歩目の遊脚着床位置姿勢の要求値）に対応して決定される。すなわち、今回歩容終端遊脚足平位置姿勢から遊脚足平２２を床に接触させたまま、すべらないように該足平２２をその底面のほぼ全面が接地するまで回転させたときの、該足平２２の代表点が今回歩容支持脚座標系から見た次回歩容支持脚座標系の原点に合致するように今回歩容終端遊脚足平位置姿勢が決定される。
【０３００】
今回歩容終端では、支持脚足平２２は離床して空中にある。支持脚足平２２が離床してから後の軌道を決定するために、支持脚足平着地予定位置姿勢を設定する。支持脚足平着地予定位置姿勢は、今回歩容支持脚座標から見た次次回歩容支持脚座標（今回歩容に係わる２歩目の遊脚足平位置姿勢の要求値）に対応して設定される。より具体的には、支持脚足平着地予定位置姿勢は、その位置姿勢から、足平２２を床に接触させたまま、すべらないように該足平２２をその底面のほぼ全面が床に接地するまで回転させたときの該足平２２の代表点が今回歩容支持脚座標から見た次次回歩容支持脚座標の原点に合致するように設定される。
【０３０１】
今回歩容終端支持脚足平位置姿勢は、現在支持脚位置姿勢（今回歩容初期支持脚足平位置姿勢）から、次回歩容支持脚座標系に対応する足平着地予定位置姿勢（前記要求パラメータにおける２歩目の遊脚側足平着地位置姿勢の要求値）に至る足平位置姿勢軌道を、今回歩容終端まで前記有限時間整定フィルタにより生成することにより求められる。
【０３０２】
次いで、Ｓ６０２に進み、今回歩容の基準上体姿勢軌道パラメータが、定常歩容の第１旋回歩容や第２旋回歩容と同様に決定される。但し、今回歩容の基準上体姿勢軌道が前記定常歩容の基準上体姿勢軌道に連続してつながる（今回歩容終端での基準上体姿勢角及び角速度がそれぞれ定常歩容初期の基準上体姿勢角及び角速度に一致する）ように上記パラメータが設定される。なお、本実施形態では、基準上体姿勢は、今回歩容及び定常歩容のいずれでも定常的な鉛直姿勢である。
【０３０３】
次いで、Ｓ６０４に進み、今回歩容の腕姿勢軌道パラメータが、定常歩容の第１旋回歩容や第２旋回歩容と同様に決定される。但し、今回歩容の腕姿勢軌道が前記定常歩容の腕姿勢軌道に連続してつながるように上記パラメータを設定する。なお、ここで決定される腕姿勢軌道パラメータは、定常歩容パラメータの決定（図１４のＳ１０４）の場合と同様、鉛直軸（あるいは上体体幹軸）まわりの両腕体の角運動量変化に関すること以外の運動パラメータであり、両腕体の重心位置の軌道を規定するパラメータである。
【０３０４】
次いで、Ｓ６０６に進み、今回歩容の床反力鉛直成分軌道パラメータが、定常歩容の第１旋回歩容や第２旋回歩容と同様、該パラメータにより規定される床反力鉛直成分軌道が前記図６のように実質的に連続な（値がステップ状に飛ばない）軌道になるように設定される。
【０３０５】
但し、床反力鉛直成分軌道パラメータは、今回歩容の全体重心鉛直位置速度と床反力鉛直成分軌道とのいずれもが、前記定常歩容と連続してつながるように決定される。
【０３０６】
具体的には、まず、前記図１２のＳ０２４の処理（定常歩容初期状態の決定処理）で最終的に求めた定常歩容の初期上体鉛直位置速度を今回歩容支持脚座標系から見た値に変換した値（Z０”，Ｖｚ０”）、すなわち、図１９のＳ２２４で求めた（Z０”，Ｖｚ０”）等を基に、例えば前記式０４（あるいはロボット１のキネマティクスモデル）を用いて、今回歩容支持脚座標系から見た定常歩容の初期全体重心鉛直位置速度が求められる。
【０３０７】
具体的には、今回歩容支持脚座標系から見た定常歩容の初期全体重心鉛直位置は、Ｓ２２４で求めた定常歩容の上体鉛直位置Z0”に対応する図１０のモデルの上体質点鉛直位置と、定常歩容初期の各足平位置を今回歩容支持脚座標系から見た値に変換したものに対応する支持脚側及び遊脚側の脚体質点鉛直位置とを式０４に代入することで求められる。また、今回歩容支持脚座標系から見た定常歩容の初期全体重心鉛直速度は、Ｓ２２４で求めた定常歩容の上体鉛直速度Vz0”に対応する図１０のモデルの上体質点鉛直速度と、定常歩容初期の各足平鉛直速度を今回歩容支持脚座標系から見た値に変換したものに対応する支持脚側及び遊脚側の脚体質点鉛直速度とを式０４の両辺を微分してなる式に代入することにより求められる。なお、この初期全体重心鉛直位置速度の算出は、より厳密なモデルを用いて行なうようにしてもよい。
【０３０８】
そして、このようにして求めた定常歩容の初期全体重心鉛直位置速度を、前記式１３と下記式４１の終端全体重心鉛直位置速度に代入すると共に、前回の目標歩容瞬時値（より厳密には、前回目標歩容の終端状態を今回支持脚座標系に変換したもの）の全体重心鉛直位置及び速度を、前記式１３と下記式４１の初期全体重心鉛直位置及び速度に代入し、式１３と式４１の関係を満足するように、今回歩容の床反力鉛直成分パターン（より具体的にはパラメータ値）が決定される。但し、式１３と式４１における積分値は今回歩容の初期から終端までの期間の積分値とする。
Figure 0003672101
但し、重力加速度は負の値とする。
【０３０９】
より具体的には、まず、図６のような床反力鉛直成分パターンを規定する床反力鉛直成分パラメータ（折れ点の時刻等）のうちの、少なくとも２つのパラメータを独立な未知変数として、その未知変数の値を、式１３と式４１とからなる連立方程式を解いて決定する。
【０３１０】
未知変数とする床反力鉛直成分パラメータには、例えば、図６の台形の高さ（床反力鉛直成分のピーク値）と幅（片脚支持期時間）とを選択すればよい。この場合、図６の台形の両側部分の傾きは今回歩容周期等に応じてあらかじめ定めた値とし、あるいは、片脚支持期から空中期に移行する時刻を除く床反力鉛直成分パターンの折れ点の時刻を今回歩容周期等に応じてあらかじめ定めた値とする。補足すると、未知変数を１つとすると、一般的には式１３と式４１の連立方程式を満足する解が存在しない。
【０３１１】
次いで、Ｓ６０８に進み、床反力水平成分許容範囲[Fxmin，Fxmax]（具体的には該床反力水平成分許容範囲のパターンを規定するパラメータ）が、定常歩容の第１旋回歩容や第２旋回歩容と同様に設定される。たとえば図３３に示すようなパターンで床反力水平成分許容範囲が設定される。本実施形態では、先にＳ６０６で決定した床反力鉛直成分パターンに応じて前記式１２に基づいて床反力水平成分許容範囲が設定される。
【０３１２】
次いで、Ｓ６１０に進み、今回歩容のＺＭＰ軌道（具体的にはＺＭＰ軌道を規定するパラメータで、軌道の折れ点の時刻や位置）が、定常歩容の第１旋回歩容や第２旋回歩容と同様、安定余裕が高くかつ急激な変化をしないように、前記図７に示すごとく設定される。但し、今回歩容のＺＭＰ軌道が前記定常歩容のＺＭＰ軌道に連続してつながるように上記パラメータを設定される。つまり、今回歩容終端におけるＺＭＰの位置が定常歩容初期のＺＭＰ位置に一致するように、ＺＭＰ軌道パラメータが決定される。この場合、走行歩容では、片脚支持期におけるＺＭＰ軌道の折れ点の時刻や位置の設定の仕方は、前述した定常歩容のＺＭＰ軌道パラメータの設定の仕方と同様でよい。そして、空中期における目標ＺＭＰ軌道が、空中期開始時から、定常歩容初期のＺＭＰ位置まで、直線的に連続して変化するようにＺＭＰ軌道パラメータを設定すればよい。
【０３１３】
なお、Ｓ６１０で決定される今回歩容のＺＭＰ軌道パラメータは、仮決定されただけであり、後述するように修正される。そこで、上記のごとく設定した今回歩容のＺＭＰ軌道を、以降、今回歩容の仮目標ＺＭＰ軌道と呼ぶこととする。
【０３１４】
最後に、Ｓ６１２に進み、上体姿勢角復元期間[Ta，Tb]が設定される。上体姿勢角復元開始時刻Taは、定常歩容の第２旋回歩容におけるTmに相当し、上体姿勢角復元修了時刻Tbは、定常歩容の第２旋回歩容におけるTs2に相当するものである。これらの時刻Ta，Tbの設定の仕方は、それぞれTm及びTs2の設定の仕方と同様である。
【０３１５】
図１２の説明に戻って、上記のごとくＳ０２６に示す処理（今回歩容の歩容パラメータ決定処理）を行って後、次いでＳ０２８に進み、今回歩容の歩容パラメータ（ＺＭＰ軌道パラメータ）が修正される。この処理では、上体位置姿勢軌道を定常歩容に連続させ、若しくは近づけるべくＺＭＰ軌道パラメータが修正される。図３４はその処理を示すサブルーチン・フロー・チャートである。
【０３１６】
まずＳ７００を経てＳ７０２に進み、仮目標ＺＭＰパターンとその他の今回歩容パラメータを基に、今回歩容終端時刻までの仮今回歩容が仮生成される。Ｓ７０２では、図３５に示すフローチャートに従って、以下の処理が行われる。
【０３１７】
以下説明すると、Ｓ８００において、諸々の初期化が行われる。具体的には、仮歩容生成用時刻kに０が代入される。また、前回目標歩容の終端状態（より具体的には、上体水平位置速度、上体鉛直位置速度、上体姿勢角及びその角速度、目標足平位置姿勢、目標腕姿勢などの歩容状態の終端値）を今回支持脚座標系に変換したものを、今回歩容初期状態とする。
【０３１８】
次いで、Ｓ８０２を経てＳ８０４において、仮歩容生成用時刻kが今回歩容終端時刻Tcurr以前であるか否か（k ≦ Tcurrであるか否か）が判断され、その判断結果がＹＥＳある場合には、Ｓ８０６の今回歩容瞬時値決定サブルーチンに進み、今回歩容の時刻kの瞬時値が決定される。次いでＳ８０８に進み、仮歩容生成用時刻kがΔkだけ増加され、Ｓ８０４に戻る。Ｓ８０４の判断結果がＮＯである場合には、図３５に示すフローチャートの処理が完了する。以上の処理により、仮の今回歩容が初期から終端まで生成される。
【０３１９】
Ｓ８０６の歩容瞬時値決定サブルーチンでは、図３６に示す処理が行われる。以下にこれを説明する。
【０３２０】
まずＳ９００において、今回歩容パラメータの床反力鉛直成分軌道パラメータを基に、図６に示した目標床反力鉛直成分の時刻kにおける値（今回値）が求められる。次いで、Ｓ９０２において、今回歩容パラメータのＺＭＰ軌道パラメータを基に、図７に示す目標ＺＭＰ軌道（仮目標ＺＭＰ軌道）の時刻kにおける値（今回値）を求める。
【０３２１】
次いでＳ９０４に進み、今回歩容パラメータ（足平軌道パラメータ、基準上体姿勢軌道パラメータ及び腕姿勢軌道パラメータ）を基に、時刻kにおける目標両足平位置姿勢、基準上体姿勢及び目標腕姿勢の値（今回値）がそれぞれ求められる。但し、目標腕姿勢に関しては、腕全体重心位置は決定されるが、鉛直軸（又は上体体幹軸）まわりの角運動量を変化させる運動自由度は、未だ決定されていない。なお、定常歩容の場合と同様、今回歩容の目標足平位置姿勢軌道及び床反力鉛直成分軌道は、それぞれ、図３２のフローチャートで決定した足平軌道パラメータ、床反力鉛直成分軌道パラメータに応じて互いに独立的に決定される。
【０３２２】
次いでＳ９０６に進み、Ｓ９００で求めた目標床反力鉛直成分の今回値を満足する（ロボット１の鉛直方向の慣性力と重力との和を目標床反力鉛直成分に釣り合わせる）ような時刻kにおける全体重心鉛直位置が算出される。この算出は、具体的には前記図２１のＳ４０６と同様の処理により行なわれる。
【０３２３】
次いでＳ９０８に進み、上記の如く求めた全体重心鉛直位置を満足する上体鉛直位置の今回値が算出される。この算出は、具体的には、前記図２１のＳ４０８と同様の処理により行なわれる。
【０３２４】
次いでＳ９１０に進み、前記図３２のＳ６０８で決定した床反力水平成分許容範囲のパラメータに基づいて、図３３に示す床反力水平成分許容範囲[Fxmin，Fxmax]の時刻kにおける値（今回値）が求められる。
【０３２５】
次いでＳ９１２に進み、目標ＺＭＰを満足する（目標ＺＭＰ回りに発生するモーメント水平成分が０になる）ように、今回仮歩容の上体水平加速度と上体姿勢角加速度が決定される。但し、これらの加速度は、床反力水平成分Fxが[Fxmin，Fxmax]を越えないように決定される。この処理は、図２１のＳ４１２の詳細を示す図２２のフローチャートの処理とは若干異なる。
【０３２６】
Ｓ９１２では、具体的には、図３７のフローチャートに示す処理が行われる。図３７のフローチャートでは、まずＳ１０００おいて、時刻kが前記図３２のＳ６１２で設定した上体姿勢角復元期間[Ta，Tb]にあるか否かが判断される。
【０３２７】
この判断結果がＮＯである場合（床反力水平成分許容範囲が０若しくは狭い場合）には、Ｓ１００２からＳ１０１４までの処理が実行される。Ｓ１００２からＳ１０１４までの処理は、前述の図２２のＳ５０４からＳ５１６までの処理と同じであるので、説明を省略する。
【０３２８】
Ｓ１０００の判断結果がＹＥＳである場合には、Ｓ１０１６に進み、上体姿勢復元モーメントＺＭＰ換算値パターンＺＭＰrecが設定される。この場合、定常歩容の生成に係わる前記図２２のＳ５１８と異なり、ＺＭＰrecは、一定値０のパターン（すなわち図２６に示す台形パターンの高さが０であるパターン）に設定される。次に、Ｓ１０１８からＳ１０２６までの処理が行われる。Ｓ１０１８からＳ１０２６までの処理は、前記図２２のＳ５２０からＳ５２８までの処理と同じであるので説明を省略する。
【０３２９】
なお、Ｓ１０１６〜Ｓ１０２６の処理では、上体姿勢復元モーメントＺＭＰ換算値ＺＭＰrecの瞬時値は常に０になるので、Ｓ１０２０で求められる上体回転モードの上体姿勢角加速度βも０になる。従って、β＝０として、Ｓ１０２２、Ｓ１０２４及びＳ１０２６の処理のみを行なうようにしてもよい。Ｓ１０００の判断結果がＹＥＳである場合、すなわち、上体姿勢角復元期間[Ta，Tb]では、上記のようにβ＝０となることから、Ｓ９１２の処理では、上体姿勢角復元期間[Ta，Tb]の期間（床反力水平成分許容範囲が十分に大きい期間）で、定常歩容生成の場合と異なり、上体姿勢角速度の復元方向への上体姿勢変化の運動軌道は生成されないこととなる。
【０３３０】
なお、本実施形態では、基準上体姿勢が鉛直姿勢で、基準上体姿勢による上体姿勢角加速度が０であるため、上記の如く求めた上体回転モードの角加速度βをＳ９１２の処理で決定される上体姿勢角加速度とした。但し、基準上体姿勢が変化するように該基準上体姿勢軌道パラメータを設定した場合には、上記の如く求めた上体回転モードの角加速度βと基準上体姿勢角加速度の和をもって、Ｓ９１２の処理で決定される上体姿勢角加速度とすべきである。
【０３３１】
以上のごとく図３６のＳ９１２の処理を完了した後、次いでＳ９１４に進み、上記Ｓ９１２で求めた上体水平加速度を逐次積分する（今回歩容初期（時刻k=0）から現在時刻ｋまで累積加算する）ことによって上体水平速度が求められ、さらにその上体水平速度を逐次積分する（今回歩容初期（時刻k=0）から現在時刻ｋまで累積加算する）ことによって、上体水平位置（今回値）が求められる。また、上記Ｓ９１２で求めた上体姿勢角加速度を逐次積分する（今回歩容初期（時刻k=0）から現在時刻ｋまで累積加算する）ことによって、上体姿勢角速度が求められ、さらにその上体姿勢角速度を逐次積分する（今回歩容初期（時刻k=0）から現在時刻ｋまで累積加算する）ことによって、上体姿勢角の今回値が求められる。このＳ９１４の処理は図２１のＳ４１４と同様の処理である。
【０３３２】
以上のごとく図３５のＳ８０６の今回歩容瞬時値決定サブルーチンが実行され、次いでＳ８０８に進み、歩容生成用時刻kの値が歩容生成インターバルΔｋだけ増加される。次いでＳ８０４に戻り、Ｓ８０４に示す条件が成立している限り、Ｓ８０６とＳ８０８の処理が繰り返される。そして、Ｓ８０４に示す条件が成立しなくなったら、すなわち終端まで仮今回歩容の生成が完了したら、図３４のＳ７０４に進む。
【０３３３】
Ｓ７０４では、上記のごとくＳ７０２で求めた今回歩容終端での上体水平位置速度（Ｘｅ，Ｖｘｅ）から、終端発散成分ｑ0[k]（k=Tcurr）が図示の式（前記式１０）を用いて求められる。
【０３３４】
次いでＳ７０６に進み、今回歩容終端発散成分ｑ0[k]と定常歩容初期発散成分ｑ”（図１９のＳ２２４で求めたもの）との差である終端発散成分誤差errqが図示の式を用いて求められる。さらに、Ｓ７０８に進んで、その求めた終端発散成分誤差errqが許容範囲内（０近傍の範囲）にあるか否か判断する。
【０３３５】
Ｓ７０８の判断結果がＮＯであるときはＳ７１０に進み、ａ＝Δａ（Δａは所定の微小量）とし、図３８の関係に従って現在の仮目標ＺＭＰパターンに台形状の修正を加えた目標ＺＭＰを基に、前記Ｓ７０２と同様に、終端までの仮今回歩容を計算する。ここで、図３８を参照して、ａは、今回歩容終端発散成分を定常歩容初期発散成分にできるだけ一致させる（今回歩容の上体水平位置姿勢軌道を定常歩容の上体水平位置姿勢軌道に近づける）ために、仮目標ＺＭＰを修正するための台形パターンの高さである。この場合、本実施形態では、仮目標ＺＭＰの修正は、支持脚足平２２の底面のほぼ全面が接地する期間（足底全面接地期間）、すなわち、床反力水平成分許容範囲が十分に広いものとなる期間において行なうようにしており、上記台形パターンの折れ点の時刻は、足底全面接地期間における仮目標ＺＭＰの折れ点の時刻に合わせて設定されている。なお、Ｓ７１０でａ＝Δａとするのは、現在の仮目標ＺＭＰ軌道を上記台形パターンによって微小量、修正したときの前記終端発散成分誤差errqの変化を観測するためである。
【０３３６】
上記のようにＳ７１０にて、ａ＝Δａとして仮目標ＺＭＰ軌道を修正したときの仮今回歩容を終端まで生成した後、さらにＳ７１２に進み、Ｓ７１０で求めた仮今回歩容終端での上体水平位置速度（Ｘｅ1，Ｖｘｅ1）を基に、この仮今回歩容における終端発散成分ｑ1[k]が図示の式（前記式１０）を用いて求められる。
【０３３７】
なお、Ｓ７１０においてΔａは、本実施形態では、適宜に設定される微小量の定数としたが、以下に説明する繰り返し演算によって終端発散成分誤差errqが小さくなるにつれてΔａを減少させるように該Δａを設定するようにしてもよい。但し、定数にしておいても、数回の繰り返し演算で終端発散成分誤差errqを許容範囲内に収めることができる。
【０３３８】
次いでＳ７１４に進み、パラメータ感度ｒ（Δａに対する終端発散成分誤差の変化の割合）が図示の式から求められる。さらに、Ｓ７１６に進み、ａ＝−errq／r、すなわちＳ７０６で求めた終端発散成分誤差errqを、Ｓ７１４で求めたパラメータ感度ｒで割った値を高さａとする台形パターンの修正量を図３８の関係に従って仮目標ＺＭＰパターンに加えることにより、仮目標ＺＭＰパターンが修正される（新たな仮目標ＺＭＰパターンが決定される）。
【０３３９】
次いでＳ７０２に戻る。そして、Ｓ７０８の判断結果がＮＯである限りは、上記したＳ７０２〜Ｓ７１６の処理が繰り返され、Ｓ７０８の判断結果がＹＥＳになったときには、その繰り返しループ（Ｓ７００）を抜けてＳ７１８に進む。
【０３４０】
Ｓ７１８では、仮今回歩容の終端上体姿勢角と定常歩容の初期上体姿勢角との差、及び仮今回歩容の終端上体姿勢角速度と定常歩容の初期上体姿勢角速度との差などを基に、今回歩容の上体姿勢角が定常歩容の上体姿勢角に近づくように、今回歩容の上体姿勢復元モーメントＺＭＰ換算値（ＺＭＰrec）のパターンが決定される。ここで決定するＺＭＰrecは、後述する今回歩容瞬時値の生成処理で、床反力水平成分許容範囲が十分に大きいものとなる期間（片脚支持期内の期間）において、上体姿勢角軌道を定常歩容につながらせる（近づける）ように上体姿勢角加速度を発生させても、今回歩容終端発散成分と定常歩容初期発散成分との一致性（Ｓ７０８の条件）を維持できるように、仮目標ＺＭＰを修正するためのものである。
【０３４１】
このＺＭＰrecは、前記定常歩容生成処理で説明したものと同様に台形状のパターンであり、具体的には次のように決定される。すなわち、図２６に示したＺＭＰrecの台形パターンにおいて、台形の頂点（折れ点）の時刻は既知とする（より具体的には台形の折れ点の時刻を目標ＺＭＰの折れ点時刻に合わせる）と共に、台形高さを未知数とし、以下のようにＺＭＰrecの台形高さ（パラメータ）が求められる。但し、Ｓ７１８では図２６におけるTm及びTs2をそれぞれTa，Tbに置き換えるものとする。
【０３４２】
上記のように上体姿勢復元モーメントＺＭＰ換算値パターンの未知パラメータがひとつの場合には、今回歩容の終端において上体姿勢角と上体姿勢角速度の両方を定常歩容に連続につなげることは一般的にはできない。そこで、本実施形態では、複数歩に渡って徐々に、生成される歩容の状態が定常歩容の状態に近づけるように、未知パラメータを決定することとする。
【０３４３】
補足すると、１歩容の中でのＺＭＰrecパターンを複雑にし、未知パラメータを２つ以上にして、今回歩容の終端において上体姿勢角と上体姿勢角速度との両者を定常歩容に連続につなげてもよいが、ＺＭＰrecパターンがジグザグに大きく変動し過ぎるおそれがある。
【０３４４】
以下では、算出原理を説明した後、算出手順を説明する。
【０３４５】
前述のごとくＳ７０２でＺＭＰrecパターンの台形高さを０として求めた仮今回歩容の終端上体姿勢角と定常歩容の初期上体姿勢角との差を求め、これをθerrとする。また、仮今回歩容の終端上体姿勢角速度と定常歩容の初期上体姿勢角速度との差を求め、これをvθerrとする。
【０３４６】
ここで、ＺＭＰrecパターンの台形高さをある値bcurrとして今回歩容が生成され、引き続いて、今回歩容と同様のアルゴリズムによって第１旋回歩容が生成されると想定する。但し、第１旋回歩容の上体姿勢復元モーメントＺＭＰ換算値ＺＭＰrecパターンは、図２２のＳ５１８において求められた第１旋回歩容のＺＭＰrecパターン（高さが前記acyc1である図２６の台形パターン）とある値b1の和であるとする。
【０３４７】
このようにして生成された歩容をＺＭＰrec修正歩容と呼び、その終端（第１旋回歩容の終端）上体姿勢角と角速度をそれぞれθ1、vθ1とする。
【０３４８】
Ｓ０２４における定常歩容の初期状態を求めるサブルーチンの処理が完了した時点で求められた本来の定常歩容（最終的にＳ３１０の式３０、式３１によって決定された定常歩容初期上体姿勢角及び角速度を初期値とし、ＺＭＰrecパターンをＳ５１８において求められたパターン（高さがacyc1である図２６の台形パターン）とした場合の定常歩容）の第１旋回歩容終端上体姿勢角と角速度をそれぞれθ1org、vθ1orgとする。
【０３４９】
ここで、Δθ1、Δvθ1を次のように定義する。
Δθ1 =θ1−θ1org …式５０
Δvθ1 =vθ1−vθ1org …式５１
【０３５０】
Δθ1及びΔvθ1は、ＺＭＰrec修正歩容と本来の定常歩容を第１旋回歩容の終端まで生成した時点において、両者間における上体姿勢角の差及び角速度の差を意味する。もし、Δθ1及びΔ v θ 1が０になれば、ＺＭＰrec修正歩容に引き続いて、今回歩容と同様のアルゴリズムによって、ＺＭＰrecパターンの台形高さを前記acyc2として第２旋回歩容が生成されると、この歩容は、本来の定常歩容に一致する。
【０３５１】
従って、Δθ1及びΔvθ1が０となる今回歩容台形高さbcurr、第１旋回歩容台形高さb1を求め、求めたbcurrを今回歩容の台形高さとして最終的に決定すればよい。
【０３５２】
ところで、ロボット１の上体姿勢角に関する動力学モデルが図１０に示すフライホイールFHのような線形特性を持つことから、Δθ1及びΔ v θ 1は、今回歩容台形高さbcurr、第１旋回歩容台形高さb1、仮今回歩容の終端上体姿勢角と定常歩容の初期上体姿勢角の差θerr、仮今回歩容の終端上体姿勢角速度と定常歩容の初期上体姿勢角速度の差vθerrと以下の関係を持つ。
Δθ1 = c11 * bcurr + c12* b1 + θerr + e1 * vθerr …式５２
Δvθ1 = c21 * bcurr + c22 * b1 + e2 * vθerr …式５３
但し、c11、c12、c21、c22、e1、e2は、今回歩容、第１旋回歩容の歩容周期、上体姿勢復元モーメントＺＭＰ換算値ＺＭＰrecパターンのパラメータ（特に時間に関するパラメータ）などによって一義的に決定される係数である。
【０３５３】
以上の原理に基づき、算出手順として、まず、仮今回歩容と定常歩容との境界での上体姿勢角の差θerrと角速度の差Ｖθerrが求められる。
【０３５４】
次いで、式５２，５３の係数であるc11、c12、c21、c22、e1、e2が、今回歩容、第１旋回歩容の歩容周期、上体姿勢復元モーメントＺＭＰ換算値ＺＭＰrecパターンのパラメータ（特に時間に関するパラメータ）などを基に求められる。
【０３５５】
次いで式５２、式５３の右辺が０となるように今回歩容台形高さbcurr、第１旋回歩容台形高さb1が決定される。すなわち、式５２、式５３の右辺を０とした連立方程式を解くことによって、bcurr、b1が求められる。
【０３５６】
最後に、今回歩容の上体姿勢復元モーメントＺＭＰ換算値（ＺＭＰrec）の台形パターンの台形高さが、上記求めた今回歩容台形高さbcurrに設定される。
【０３５７】
次いでＳ７２０に進み、現在の仮目標ＺＭＰパターン（Ｓ７００の繰り返しループを抜けたときの仮目標ＺＭＰパターン）に、Ｓ７１８で上記のように求めた上体姿勢復元モーメントＺＭＰ換算値パターンを加算してなるパターンが今回歩容の目標ＺＭＰパターンとして決定される。なお、この処理は、Ｓ７１０においてΔaの高さの台形パターンを仮目標ＺＭＰパターンに加える処理と同様である。
【０３５８】
以下に仮目標ＺＭＰパターンに上体姿勢復元モーメントＺＭＰ換算値パターンを加算した理由を述べる。
【０３５９】
Ｓ７００のループにおいて生成される仮今回歩容は、前述の如く、上体姿勢復元モーメントＺＭＰ換算値ＺＭＰrecを０（ＺＭＰrecの台形パターンの高さパラメータを０）にして生成される。このようにしてＳ７００のループで最終的に生成された仮今回歩容では、その上体位置速度は、定常歩容に連続し、若しくは近づくが、上体姿勢角は、定常歩容の上体姿勢角からずれ、場合によっては発散してしまう。
【０３６０】
Ｓ７１８で求められた上体姿勢復元モーメントＺＭＰ換算値パターンは、上体姿勢角の定常歩容に対するずれを０に近づけるための上体姿勢角加速度を発生させるものである。
【０３６１】
しかし、Ｓ７００のループで最終的に得られた仮目標ＺＭＰパターンを修正することなく、Ｓ７１８で求められた上体姿勢復元モーメントＺＭＰ換算値パターンに応じた上体姿勢角加速度を発生させると、動力学的平衡条件（ロボットの重力と慣性力の合力が目標ＺＭＰに作用するモーメントが鉛直成分を除いて０になること）を満足させるために、上体水平位置軌道を前記仮今回歩容の上体水平位置軌道からずらさざるを得なくなる。そこで、本実施例では、上体水平位置軌道をＳ７００のループで最終的に得られるものからずらさなくて済むように、ＺＭＰrecによって仮目標ＺＭＰパターンを修正することとした。
【０３６２】
前記仮今回歩容の運動に加えて、Ｓ７１８で求めた上体姿勢復元モーメントＺＭＰ換算値パターンに対応する上体姿勢角加速度を発生させると、ＺＭＰ（運動によって発生する重力と慣性力の合力の鉛直成分を除くモーメントが０になる点）は上体姿勢復元モーメントＺＭＰ換算値だけずれる。従って、逆に、仮目標ＺＭＰパターンに上体姿勢復元モーメントＺＭＰ換算値パターンを加算したパターンを目標ＺＭＰパターンとして、Ｓ７１８で求めた上体姿勢復元モーメントＺＭＰ換算値パターンに対応する上体回転モードの上体姿勢角加速度を発生させながら、目標ＺＭＰパターンを満足する今回歩容を生成すれば、前記仮今回歩容と同じ上体並進運動となる。
【０３６３】
以上が、仮目標ＺＭＰパターンに上体姿勢復元モーメントＺＭＰ換算値パターンを加算したパターンを目標ＺＭＰパターンとした理由である。
【０３６４】
図１２に戻って、上記のごとくＳ０２８において今回歩容パラメータを修正した後、あるいはＳ０１６の判断結果がＮＯである場合には、Ｓ０３０に進み、今回歩容瞬時値が決定される。
【０３６５】
Ｓ０３０では、図３６のＳ９００からＳ９１０までと同一の処理が行なわれ、次に、Ｓ９１２のサブルーチンである図３７のＳ１０００〜Ｓ１０２６の処理が行なわれる。但し、この場合、図３７のＳ１０１６においては、上体姿勢復元モーメントＺＭＰ換算値（ＺＭＰrec）パターンは、０に設定されるのではなく、図３４のＳ７１８で設定した上体姿勢復元モーメントＺＭＰ換算値（ＺＭＰrec）パターンに設定される。次いで図３６のＳ９１４と同一の処理が実行され、これにより、図１２のＳ０３０の処理が完了する。
【０３６６】
次いでＳ０３２に進み、スピン力をキャンセルする（ロボット１の腕以外の運動によって目標ＺＭＰ回りに発生する床反力モーメント鉛直成分を略零にする）ための腕動作が決定される。具体的には、腕を振らなかった場合の目標ＺＭＰにおける床反力モーメント鉛直成分軌道（厳密には、腕を振らずに歩容を生成した場合において、ロボットの重力と慣性力の合力が目標ＺＭＰに作用するモーメント鉛直成分軌道の各瞬時値の符号を反転したもの）が求められる。すなわち、Ｓ０３０の処理によって生成された歩容の運動（これには腕振りの運動は含まれていない）の瞬時値に釣り合う目標ＺＭＰ（瞬時値）回りの床反力モーメント鉛直成分で瞬時値が求められる。そして、これを、腕振り運動の等価慣性モーメントで割ることにより、スピン力キャンセルに必要な腕振り動作の角加速度が求められる。なお、補足すると、腕の振りが大き過ぎる場合には、等価慣性モーメントよりも大きな値で割ればよい。
【０３６７】
次に、この角加速度を２階積分し、これを積分値が過大になるのを防ぐためのローカットフィルタに通して得た角度を腕振り動作角とする。但し、腕振り動作では、左右の腕を前後逆方向に振り、両腕体の重心位置を変化させないようにする。なお、スピン力をキャンセルするための腕振り運動を定常歩容でも生成しておき、これにつながるように、今回歩容における腕振り運動を決定するようにしてもよい。
【０３６８】
次いでＳ０３４に進み、歩容生成用時刻ｔをΔｔだけ増やし、Ｓ０１４に戻り、以上のごとく歩容生成を続ける。
【０３６９】
以上が、歩容生成装置１００における目標歩容生成処理である。
【０３７０】
図４を参照して本実施形態に係る装置の動作をさらに説明すると、歩容生成装置１００において、上記したように目標歩容が生成される。生成された目標歩容のうち、目標上体位置姿勢（軌道）、目標腕姿勢（軌道）が、ロボット幾何学モデル（逆キネマティクス演算部）１０２に送出される。
【０３７１】
また、目標足平位置姿勢（軌道）、目標ＺＭＰ軌道（目標全床反力中心点軌道）、及び目標全床反力（軌道）（目標床反力水平成分と目標床反力鉛直成分）は、複合コンプライアンス動作決定部１０４に送られると共に、目標床反力分配器１０６にも送られる。そして、目標床反力分配器１０６で、床反力は各足平２２Ｒ，２２Ｌに分配され、目標各足平床反力中心点及び目標各足平床反力が決定される。この決定された目標各足平床反力中心点及び目標各足平床反力は複合コンプライアンス動作決定部１０４に送られる。
【０３７２】
複合コンプライアンス動作決定部１０４から、機構変形補償付き修正目標足平位置姿勢（軌道）がロボット幾何学モデル１０２に送られる。ロボット幾何学モデル１０２は、目標上体位置姿勢（軌道）と機構変形補償付き修正目標足平位置姿勢（軌道）を入力されると、それらを満足する脚体２，２の１２個の関節（１０Ｒ（Ｌ）など）の関節変位指令（値）を算出して変位コントローラ１０８に送る。変位コントローラ１０８は、ロボット幾何学モデル１０２で算出された関節変位指令（値）を目標値としてロボット１の１２個の関節の変位を追従制御する。また、ロボット幾何学モデル１０２は、目標腕姿勢を満足する腕関節の変位指定（値）を算出して変位コントローラ１０８に送る。変位コントローラ１０８は、ロボット幾何学モデル１０２で算出された関節変位指令（値）を目標値としてロボット１の腕体の１２個の関節の変位を追従制御する。
【０３７３】
ロボット１に生じた床反力（詳しくは実各足床反力）は６軸力センサ３４によって検出される。その検出値は前記複合コンプライアンス動作決定部１０４に送られる。また、ロボット１に生じた姿勢傾斜偏差θerrx，θerry（詳しくは目標上体姿勢角に対する実姿勢角の偏差で、ロール方向（Ｘ軸回り）の姿勢角偏差がθerrxであり、ピッチ方向（Ｙ軸回り）の姿勢角偏差がθerryである）が傾斜センサ３６を介して検出され、その検出値は姿勢安定化制御演算部１１２に送られる。この姿勢安定化制御演算部１１２で、ロボット１の上体姿勢角を目標上体姿勢角に復元するための目標全床反力中心点（目標ＺＭＰ）まわり補償全床反力モーメントが算出されて複合コンプライアンス動作決定部１０４に送られる。複合コンプライアンス動作決定部１０４は、入力値に基づいて目標床反力を修正する。具体的には、目標全床反力中心点（目標ＺＭＰ）回りに補償全床反力モーメントが作用するように目標床反力を修正する。
【０３７４】
複合コンプライアンス動作決定部１０４は、修正された目標床反力に、センサ検出値などから算出される実ロボットの状態及び床反力を一致させようと上記機構変形補償付き修正目標足平位置姿勢（軌道）を決定する。但しすべての状態を目標に一致させることは事実上不可能であるので、これらの間にトレードオフ関係を与えて妥協的になるべく一致させる。すなわち、各目標に対する制御偏差に重みを与えて、制御偏差（あるいは制御偏差の２乗）の重み付き平均が最小になるように制御する。これにより、実際の足平位置姿勢と全床反力とが目標足平位置姿勢と目標全床反力とに概ね従うように制御される。
【０３７５】
なお、この発明の要旨は歩容生成装置１００におけるロボット１の歩容生成にあり、上記した複合コンプライアンス動作決定部１０４などの構成及び動作は、前記特許文献３に詳細に記載されているので、説明を以上に止める。
【０３７６】
Ｓ０２８において、今回歩容は、前述のごとく、今回歩容の終端発散成分が、定常旋回初期発散成分ｑ［０］を今回歩容の支持脚座標系から見た値であるｑ”に一致するように修正される。
【０３７７】
実は、発散成分とは、動力学モデルを用いて今回歩容パラメータに従って歩容を生成し、そのまま連続して定常旋回歩容パラメータに従って歩容を繰り返し生成したとき、生成した歩容の上体水平位置が定常旋回歩容に収束するか否かを評価する指標である。収束する場合にちょうど、今回歩容の終端発散成分が、定常旋回初期発散成分ｑ［０］を今回歩容の支持脚座標系から見た値であるｑ”に一致するように、本来、発散成分は定義されなければならない。
【０３７８】
式１０で定義した発散成分は、実は、上記の性質を近似的に満足する発散成分である。
【０３７９】
従って、本実施形態においては、動力学モデルを用いて今回歩容パラメータに従って歩容を生成し、そのまま連続して定常旋回歩容パラメータに従って歩容を繰り返し生成したとき、生成した歩容の上体水平位置が定常旋回歩容の上体水平位置に収束する（近づく）ように、今回歩容パラメータを修正した、と言える。これは、前記特許文献１のものと同様である。
【０３８０】
特に、本実施形態においては、その条件（今回歩容が定常歩容に近づく）を満足するように、今回歩容の歩容パラメータの中の目標ＺＭＰパターンを修正するようにした。図３９を参照して説明すると、同図に符合Ｂで示す軌道は、上記したように歩容の境界において発散成分が一致するように生成した上体水平位置軌道を示す。
【０３８１】
同図に符合Ａで示す軌道は、定常旋回歩容との境界における上体水平位置速度が一致するように今回歩容を生成し、続いて定常歩容を繰り返し生成した場合の上体水平位置軌道を示す。
【０３８２】
図示の如く、符合Ｂで示す軌道は、今回歩容と最初の定常旋回歩容との境界においては、一般的に符合Ａで示す軌道からずれているが、その後、徐々に符合Ａで示す軌道に収束し（近づき）、次の定常旋回歩容時期において符合Ａで示す軌道にほぼ一致する。このように、歩容境界で発散成分のみを一致させる歩容生成手法でも、歩容境界で位置速度両方を一致させる歩容生成手法と同様、歩容の発散を防止することができる。なお、同図に符合Ｃで示す例は、それらを考慮せずに軌道を生成した場合を示す。このような場合は、生成した軌道は経時的に発散してしまう。当然、目標ＺＭＰパターンを複雑なものにし、複数のパラメータを調整して、位置速度両方を一致させてもよいが、目標ＺＭＰパターンがジグザグになるおそれがある。なお、位置速度両方を一致させれば、発散成分も一致するから、位置速度両方を一致させる方法も発散成分を一致させる方法の特殊例であると言える。
【０３８３】
またさらに、本実施形態においては、動力学モデルを用いて今回歩容パラメータに従って歩容を生成し、そのまま連続して定常旋回歩容パラメータに従って歩容を繰り返し生成したとき、生成した歩容の上体姿勢角が定常旋回歩容の上体姿勢角に収束し（近づき）、若しくは一致するように、今回歩容パラメータを修正した、と言える。
【０３８４】
本実施形態に係る脚式移動ロボットの歩容生成装置は上記の如く構成したので、動力学モデルを用いて今回歩容パラメータに従って歩容を生成し、そのまま連続して定常旋回歩容パラメータに従って歩容を繰り返し生成したとき、生成した歩容の上体水平位置が定常旋回歩容に収束する条件を満足する今回歩容の終端上体水平位置と終端上体水平速度との関係は、厳密には、図４１の実線のように曲線関係になる。発散成分の本来の定義から言えば、図４１の実線の関係を満足する終端上体水平位置と終端上体水平速度とのいかなる組から決定される発散成分の値は同一でなければならない。また、発散成分を指標として物理的にわかり易くするためには、終端上体水平速度が０の時に終端上体水平位置と発散成分の値とが一致していることが望ましい。
【０３８５】
すなわち、発散成分を求める関数をｆとすると、図４１の実線を表す式が次式６０の形で表され、かつ、次式６１を満足するのが望ましい。
Figure 0003672101
関数ｆ（終端上体水平位置, 終端上体水平速度）の値が発散成分の値になる。
【０３８６】
発散成分定義式である前述の式１０は、関数ｆの近似式である。式１０で定義される発散成分がある定数である場合、終端上体水平位置と 終端上体水平速度の関係は、図４１の点線になり、前記実線に対する近似直線になっている。
【０３８７】
発散成分を表す関数ｆは、直線近似する代わりに、多項式などを用いて曲線で近似してもよい。又は、関数ｆをマップ化して記憶してもよい。
【０３８８】
また、近似精度を高めるには、定常歩容パラメータに応じて、関数ｆを変えるべきである。
【０３８９】
なお、発散成分の定義式である式１０において、上体位置速度の代わりに、ロボット全体重心位置速度を用いてもよい。
【０３９０】
本実施形態では、理解を容易にするために、床反力水平成分許容範囲は、前後方向（X軸方向）成分と左右方向（Y軸方向）成分それぞれ独立に設定できることとしたが、前後方向と左右方向の関係式で表した方が、よりスリップし難い歩容が生成される。
【０３９１】
例えば、次式のようにいわゆる摩擦円を許容範囲としてもよい。
Figure 0003672101
但し、Fzは、目標床反力鉛直成分をμは摩擦係数、kaは１以下の正の定数を表す。
【０３９２】
但し、以上のように、床反力水平成分許容範囲を前後方向と左右方向の関係式で表す場合、許容範囲を同時にあるいは交互に満足するように、サジタルプレーン上での運動とラテラルプレーン上での運動を同時あるいは交互に求める必要がある。
【０３９３】
なお、ロボットの全体重心鉛直加速度と重力加速度との和は床反力鉛直成分に比例するので、歩容パラメータとして、床反力鉛直成分軌道の代わりにロボットの全体重心鉛直加速度軌道を規定するパラメータを明示的に設定しても構わない。本質的に同じことである。また、ロボットの全体重心軌道に近い挙動をする部位の鉛直加速度軌道を規定するパラメータを明示的に設定しても構わない。例えば、脚体の質量が上体の質量に比べて十分に小さい場合には、上体鉛直加速度軌道とロボットの全体重心鉛直加速度軌道は、ほぼ同じか比例関係になるので、床反力鉛直成分軌道の代わりに上体鉛直加速度軌道を用いてもよい。同様に、床反力水平成分とロボットの全体重心水平加速度は、比例関係にあるので、本実施例における床反力水平成分及びその許容範囲の代わりに、ロボット全体重心水平加速度及びその許容範囲を用いても構わない。また、ロボットの全体重心水平軌道に近い挙動をする部位の水平加速度軌道に関するパラメータを明示的に設定しても構わない。例えば、脚体の質量が上体の質量に比べ十分に小さい場合には、上体水平加速度軌道とロボットの全体重心水平加速度軌道は、ほぼ同じか比例関係にあるので、床反力水平成分及びその許容範囲の代わりに上体水平加速度及びその許容範囲を用いてもよい。
【０３９４】
前記実施形態では、床反力水平成分と目標ＺＭＰまわりの床反力モーメントを適切な値にするために、上体回転モードと上体並進モードとの２つの運動モードを用いたが、これら以外の運動モードを用いてもよい。
【０３９５】
例えば、図４０のように、股関節を中心に上体姿勢を回転させると、全体重心まわりの角運動量が変化すると共に全体重心も変化する。この運動と前記上体並進モードをある所定の割合で重ね合わせると（合成すると）、前記上体回転モードとほとんど同じ運動になり、床反力水平成分が発生しなくなる。従って、これを改めて前記上体回転モードとみなせば、本実施例のアルゴリズムに従って、同様の歩容を生成することができる。
【０３９６】
従って、運動モードのひとつが床反力水平成分を発生しない運動モードである必要もない。いかなるモードの組み合わせであっても、床反力水平成分と目標ＺＭＰまわりの床反力モーメントの発生の割合が異なるふたつの運動モードを用いさえすれば、上記例のように、任意の床反力水平成分と目標ＺＭＰまわりの床反力モーメントを発生させることができるからである。
【０３９７】
また、上体姿勢を変化させる運動モード以外の運動モードを用いてもよい。但し、なるべく小さい変位で大きな床反力水平成分又は目標ＺＭＰまわりの床反力モーメントが発生できる運動モードを選ぶことが好ましい。
【０３９８】
例えば、左右の腕を同一回転方向に振りまわす運動モード、接地していない（空中に存在する）足平の位置を摂動させる運動モードでもよい。但し、遊脚軌道を摂動させる場合には、着地位置が変わらないように着地直前までには、摂動量を実質的に０に戻すべきである。
【０３９９】
また、３つ以上の運動モードを用いてもよい。
【０４００】
また、選択した運動モードのうちの少なくとも２つは、その運動モードによる床反力水平成分と目標ＺＭＰまわりの床反力モーメントとの発生比率が、互いに異なるものである必要がある。そうでないと、一般的に連立方程式の解がなくなる（各運動モードの挙動を一義的に決定できない）からである。
【０４０１】
さらにできる限り、床反力水平成分をあまり変化させないで目標ＺＭＰまわりの床反力モーメントを十分に大きく変化させることができる運動モードと、目標ＺＭＰまわりの床反力モーメントをあまり変化させないで床反力水平成分を十分に大きく変化させることができる運動モードとを組み合わせることが望ましい。
【０４０２】
言い換えると、全体重心をあまり変化させないで角運動量を十分に大きく変化させることができる運動モードと、角運動量をあまり変化させないで全体重心を十分に大きく変化させることができる運動モードとを組み合わせることが望ましい。このようにすると、運動モードの変位が小さくなるからである。
【０４０３】
前記実施形態に用いた動力学モデル以外にも以下のモデルを用いてもよい。
１）図１１に示したように複数のリンクに質点を設定した非線形なモデル（多質点モデル）
２）本願出願人による前記特許文献１に示された３質点モデル
３）上体にのみ質量がある１質点モデル
４）全体重心まわりの角運動量変化によって生じる慣性力のモーメントを無視したモデル
５）重力と慣性力との合力（又はこれと釣り合う床反力）と上体並進運動との関係を表す部分モデルと、上記合力と上体回転運動との関係を表す部分モデルとを分離して持つ分離型モデル。例えば、図１０に示す質点は、上記合力と上体並進運動との関係を表す部分モデルであり、図１０に示すフライホイールは、上記合力と上体回転運動との関係を表す部分モデルである。
【０４０４】
また、各処理で用いられるモデルは同一でもよいし、処理に応じて適宜、モデルを使い分けてもよい。例えば、前記定常歩容は今回歩容の終端状態を決定するためだけに生成されるものであるので、その定常歩容の動力学的な精度に対する要求は、今回歩容に比べて小さい。そこで、例えば、今回歩容の生成処理では、図１０の動力学モデル（３質点＋フライホイールのモデル）を用いる一方、定常歩容の生成処理（特に図２１のＳ４０８、Ｓ４１２）では、各脚体２の質量を無視し、上体２４に対応する上体質点２４ｍと、フライホールFHとで構成される動力学モデル（図１０のモデルで脚質点２ｍ，２ｍを除去した１質点＋フライホイールのモデル）を用いて定常歩容を生成するようにしてもよい。この場合の定常歩容の生成処理では、前記実施形態において、脚質点２ｍの質量を０として前記図２１のＳ４０８、Ｓ４１２の処理を行なうようにすればよい。このようにすると、定常歩容の生成処理における演算量を大幅に削減できる。
【０４０５】
なお、前記実施形態において、ブロック線図、フローチャート、及びアルゴリズムなどは、演算処理順序を変えるなどの等価変形をしてもよい。また、適宜ローパスフィルタを挿入してもよい。
【０４０６】
また、前記実施形態を２足移動ロボットに関して説明してきたが、３足以上の多脚ロボットにも応用することができる。
【０４０７】
前記図１９のＳ２０６において初期（時刻Ts）上体鉛直位置Zsを決定する手法について補足すると、本出願人が先に特開平１０−８６０８０号公報で提案した上体高さ決定手法では、両脚体の膝曲げ角がある関係を満足するように、上体鉛直位置が決定されるが、時刻０における（すなわち着地瞬間における）上体鉛直位置を決定方法としては、これ以外に、着地したばかりの脚体の膝曲げ角がある所定の角度あるいは角度範囲になるように決定してもよい。着地衝撃吸収能力は、主に着地する脚の膝曲げ角に依存するからである。補足すると、膝曲げ角が０に近いと（伸び過ぎていると）着地衝撃吸収能力が落ちる傾向がある。逆に曲げ過ぎると、膝関節アクチュエータのトルクが過大になるおそれがある。
【０４０８】
さらに補足すると、本実施形態では、図１９のＳ２０６において、着地瞬間では上体鉛直位置をキネマティクス的（幾何学的）に決定し、それ以外の時期では目標鉛直床反力を基に動力学を満足するように上体鉛直位置を決定した。但し、より一般的に、着地前後又は離床前後など、最も脚体が伸びる（言い換えると、膝曲げ角が最も零度に近い、あるいは股関節と足首の間の距離が最も長い）時における上体鉛直位置をキネマティクス的（幾何学的）に決定し、それ以外は、目標鉛直床反力を基に動力学を満足するように上体鉛直位置を決定してもよい。
【０４０９】
実施例のごとく、探索手法をもちいたり部分的に解析手法を用いたりして、定常歩容の初期状態（主に初期上体水平位置速度、初期上体鉛直位置速度のこと）を決定する手法の代わりに、あらかじめ、上記手法を用いて様々な定常歩容パラメータに対して計算しておき、定常歩容パラメータと定常歩容の初期状態との関係をマップ化あるいは近似式化して記憶して置き、実移動時には、マップ化あるいは近似式化された上記関係を基に、定常歩容の初期値を決定してもよい。
【０４１０】
さらには、マップ化あるいは近似式化された上記関係と上記関数ｆを合成した関数をマップ化あるいは近似式化して記憶してもよい。すなわち、前記した足平軌道パラメータ、床反力鉛直軌道パラメータ等からなる定常歩容パラメータから、定常歩容の発散成分を直接求める関数をマップ化あるいは近似式化して記憶してもよい。例えば、複数種類の代表的な定常歩容パラメータの組のそれぞれに対して、事前に定常歩容を生成しておき、各組の定常歩容パラメータに対する定常歩容の初期状態（図１２のＳ０２４で求めるもの）を求めておき、さらにその各組の定常歩容パラメータと、定常歩容初期状態との関係を表すマップをあらかじめ作成しておく。そして、目標歩容を生成する際に、決定された定常歩容パラメータの組から、上記マップに基づいて選択あるいは補間によって定常歩容初期状態を求めるようにすればよい。このようにすれば、今回歩容の生成毎に、定常歩容を生成する必要がなくなり、目標歩容生成処理の演算量を大幅に削減できる。
【０４１１】
定常歩容につなげる（近づける）ための今回歩容の修正方法として、本実施形態では、今回歩容の目標ＺＭＰパラメータを修正したが、それ以外のパラメータを修正してもよい。
【０４１２】
たとえば、今回歩容の遊脚の空中での軌道を変えてもよい。また、たとえば、上体水平位置が定常歩容よりも後方にずれてしまいそうな場合には、遊脚を離床後すばやく前方に移動させて遊脚重心位置を前方にずらす。こうすることにより、目標ＺＭＰを満足するための上体水平位置は、前方により一層加速せざるを得なくなる。この結果、上体水平位置が今回歩容終端において、より一層前方に移動し、定常歩容に一致させることができる。
【０４１３】
また、目標ＺＭＰパラメータを修正する代わりに、今回歩容の周期を修正してもよい。たとえば、上体水平位置が定常歩容よりも後方にずれてしまいそうな場合には、今回歩容の周期を長くすればよい。今回歩容の周期を長くことで、上体水平位置が移動する時間が延び、それだけ前方に移動できるからである。
【０４１４】
但し、探索手法によって、上体水平位置等の適正値を決定するときに、目標ＺＭＰパラメータを修正する場合では、目標ＺＭＰの修正量にほぼ比例して、今回歩容終端上体水平位置が変化するので、上記適正値の探索回数が少なくて済む。これに対して、遊脚重心軌道や歩容の周期を修正する場合には、その修正に対して、今回歩容終端上体水平位置が、かなり非線形に変化するので、上記適正値の探索により多くの探索回数を要する。
【０４１５】
定常歩容につなげる（近づける）ための今回歩容の修正方法として、本実施形態では、今回歩容の目標ＺＭＰパラメータを修正した。この方法では、場合によっては、目標ＺＭＰパラメータの修正量（前記図３８の修正量a）が過大になることがある。たとえば、その場でホッピングしている歩容からいきなり高速で移動する要求（走行要求）が与えられると、高速の定常歩容（走行の定常歩容）につなげる（近づける）ために、目標ＺＭＰパラメータは、進行方向に対して後ろに極端に大きくずらす必要が生じる。この場合には、上記したように目標ＺＭＰパラメータ以外の歩容パラメータも修正することが望ましい。但し、この場合では、実は、急激な加速を要求すること自体に無理があったわけであるから、要求値自身を修正してもよい。
【０４１６】
要求値の修正を行なう場合には、例えば、とりあえず本実施形態に示した手順に従って、要求（要求パラメータ）を満足する定常歩容を求め、この定常歩容につながるように今回歩容パラメータを決定した時点で、今回歩容の目標ＺＭＰ軌道の安定余裕が少なくなり過ぎたか否かを判定する。そして、安定余裕が少なくなり過ぎた場合（いわゆる支持多角形から目標ＺＭＰが外れたり、支持多角形の端部付近に目標ＺＭＰが位置するような場合）には、要求を修正するようにすればよい。
【０４１７】
又は、あらかじめ歩容の加減速度（次回歩容初期速度−今回歩容初期速度）/今回歩容の周期）の許容範囲を設定して置き、要求（歩容周期に関する要求パラメータ）を受けた時点で、該要求に対応する加減速度を求め、その求めた加減速度が許容範囲を越えていたら、許容範囲になるように、要求を修正してもよい。
【０４１８】
今回歩容の終端上体鉛直位置速度を定常歩容の初期上体鉛直位置速度に一致させるための床反力鉛直成分パラメータがロボットの能力を超えている場合には、前記位置速度両方を一致させる代わりに、少なくとも上体鉛直位置だけは一致させるように床反力鉛直成分パラメータを決定してもよい。
【０４１９】
あるいは、今回歩容の終端上体鉛直位置を定常歩容の初期上体鉛直位置よりも低くし、今回歩容の終端上体鉛直速度を定常歩容の初期上体鉛直速度よりも上向きに大きくなるように床反力鉛直成分パラメータを決定してもよい。
【０４２０】
あるいは、ある所定の重みを用いて、今回歩容の終端上体鉛直位置と今回歩容の終端上体鉛直速度の加重平均（重み付平均）を求め、求めた加重平均が、定常歩容の初期上体鉛直位置と初期上体鉛直速度の加重平均と一致するように床反力鉛直成分パラメータを決定してもよい。
【０４２１】
あるいは、ロボットの位置エネルギーと運動エネルギーとの和が、今回歩容の終端と定常歩容の初期で一致するように床反力鉛直成分パラメータを決定してもよい。
【０４２２】
あるいは、図３４のＳ７１８において今回歩容の上体姿勢角が定常歩容の上体姿勢角に近づくように、上体姿勢復元モーメントＺＭＰ換算値（ＺＭＰrec）のパターンを決定する手法を用いてもよい。すなわち、Ｓ７１８の手法あるいは後述する今回歩容の上体姿勢復元モーメントＺＭＰ換算値（ＺＭＰrec）を決定する別手法において、上体姿勢角を上体鉛直位置に、上体姿勢復元モーメントＺＭＰ換算値を床反力鉛直成分に置きかえた手法を用いて、床反力鉛直成分パラメータを決定してもよい。
【０４２３】
床反力水平成分許容範囲[Fxmin，Fxmax]を、式６２と式６３を満足するように設定してもよい。
Figure 0003672101
【０４２４】
但し、Fxmaxは、式１２でKa=1とした場合のFxmaxの値より大きくならないように設定し、Fxminは、式１２でKa=1とした場合のFxminの値より小さくならないように設定する。
【０４２５】
ここで、ZMPxは目標ＺＭＰの水平位置、ZMPzは目標ＺＭＰの鉛直位置を表す。
【０４２６】
またここで、(XG，ZG)は、少なくとも上体の質点を含む質点集合の重力と慣性力との合力を近似的に発生する質点の位置とする（XGは水平位置、ZGは鉛直位置を表す）。言い換えると、(XG，ZG)は、少なくとも上体の質点を含む質点集合を代表する質点の位置とする。例えば、全体重心位置、又は脚体の一部を除く全体重心位置とする。あるいは、前記実施例に用いた図１０に示す動力学モデルの上体質点２４ｍの位置（Xb，Xz）でもよい。
【０４２７】
上記式６２でkc = ０と設定した場合には、前記実施形態と同じになる（前記式１２を参照）。
【０４２８】
kc = １、かつFxmaxとFxminをほぼ０に設定した場合には、目標ＺＭＰ(ZMPx，ZMPz)に作用する目標床反力（Fx，Fz）のベクトルが、おおよそ(XG，ZG)を指すので、目標床反力の向きの変動（特に高い周波数の変動）を小さくすることができる。
【０４２９】
その結果、目標床反力水平成分Fxの変化が穏やかになって、接地性が高まりスリップを防止することができる。
【０４３０】
また、上体水平位置軌道の加速度はFxに比例するので、上体水平位置軌道の加速度の変化も穏やかになり、目標ＺＭＰを修正したときの歩容終端上体水平位置の変化が線形的（直線的、リニア）になり、定常歩容や今回歩容の探索における収束が速くなり、探索回数を減らすことができる。
【０４３１】
さらに、kc = １かつ、kmax = kmin = 0と設定した場合には、１質点モデルの挙動になる（特に、(XG，ZG)が全体重心の場合）。この場合、定常歩容の上体水平位置軌道が容易に探索可能である。
【０４３２】
また、式６２において、(ZG−ZMPz)の代わりにある所定の定数にしてもよい。歩行や走行中では、(ZG−ZMPz)は、大きく変動しない（変動しても１０パーセント程度である）からである。
【０４３３】
kc = １かつ、kmax = kmin = 0、かつ式６２において、(ZG−ZMPz)の代わりにある所定の定数とし、(XG，ZG)を全体重心位置とした場合、１質点線形倒立振子の挙動になるので、挙動を解析的に解くことができ、探索手法を用いなくても、定常歩容や今回歩容を決定することができる。但し、上体回転モードの角加速度の変動は大きくなる。
【０４３４】
補足すると、前記ΔMｐ、ΔFp、ΔMｒ及びΔFｒは、上記のごとく単純な動力学モデルを用いる場合には、動力学演算により解析的に求めてもよいが、一般的なより複雑な動力学モデルを用いる場合には、上体を上体並進モードで微小量だけ加速又は上体回転モードで微小量だけ加速させた場合の床反力を求め、加速させなかった場合の床反力との差を求め、この差を上記微小量で割ることによって求めればよい。
【０４３５】
また、あらかじめ標準的な歩容におけるΔMｐ、ΔFp、ΔMｒ、ΔFｒ及びΔMｐ /ΔMｒなどのそれぞれの平均値を求めておいて、それを用いてもよい。ΔMｐ、ΔFp、ΔMｒ、ΔFｒ及びΔMｐ /ΔMｒは、状態（姿勢とその変化率）によって変わるので、各瞬間の状態ごとに求める方法に較べて、精度は若干低下するが、上記モデルよりも複雑なモデルを用いた場合には、演算量を大幅に低減できる。
【０４３６】
前記図２２のＳ５０４からＳ５１６までの処理及び図３７のＳ１００２からＳ１０１４までの処理において、床反力水平成分Fxに許容限界まで余裕があれば、この余裕を用いて、その時点までの上体姿勢角加速度βの積分値、すなわち上体姿勢角速度を、徐々に元に（初期状態に）戻すようにしてもよい。
【０４３７】
具体的には、Ｓ５０６及び又はＳ１００４において、まず、上体姿勢角加速度βの積分値を徐々に戻すための上体姿勢角加速度βの値（これをβrecと呼ぶ）をそれまでの上体姿勢角加速度βの積分値などから決定する。例えば、上体姿勢角加速度βの積分値に負のゲインを乗じた値をβrecとしてもよい。
【０４３８】
次に、Fxtmpを前記式１７の代わりに次式７０で決定する。
Figure 0003672101
【０４３９】
式７０の右辺第２項は、上体姿勢角加速度がβrecである上体回転モードの運動をさせた時に、目標ＺＭＰまわりに発生するモーメント（βrec*ΔMｒ）を打ち消すために必要な上体並進モードの加速度（−βrec*ΔMｒ/ΔMｐ）によって生じる床反力水平成分を意味する。
【０４４０】
式７０によって決定されるFxtmpは、ロボットの前回瞬時目標歩容状態（時刻ｋ−１の目標歩容状態）から、仮に上体姿勢角加速度がβrecである上体回転モードの運動をさせながら上体並進モードの運動をさせた場合に、今回（時刻ｋ）目標ＺＭＰを満足するために必要な上体並進モードの上体水平加速度を意味する。
【０４４１】
それ以降の処理は、前記実施形態の通りとする。以上の処理により、床反力水平成分Fxの余裕を用いて、ある程度、上体姿勢角速度を復元することができるので、上体姿勢角速度変動をより一層小さく抑えることができる。
【０４４２】
図３７のＳ１０１６において値が０に一定であるＺＭＰrecのパターンを設定した場合に、仮今回歩容の終端上体姿勢角が定常歩容の初期上体姿勢角から大きくずれてしまう場合には、ずれが小さくなるように図２６に示す台形パターンの高さを０以外に設定しても構わない。その代わりに、それ以降の図３４のＳ７１８において、Ｓ７１８で求められる上体姿勢復元モーメントＺＭＰ換算値パターンに、Ｓ１０１６において設定した上体姿勢復元モーメントＺＭＰ換算値パターンを加算する必要がある。このようにすれば、最終的に得られる歩容は、Ｓ１０１６において値が０に一定であるパターンを設定した場合と同一又はほぼ同一の歩容になる。
【０４４３】
但し、図３４のＳ７００の探索ループの処理を開始してから完了するまでの間は、図３７のＳ１０１６において設定する上体姿勢復元モーメントＺＭＰ換算値パターン（図２６に示すＺＭＰrecの台形パターンの高さ）を変更しないことが望ましい。途中で変更すると、終端発散成分errqが収束しなくなり、ループを抜け出すことができなくなるおそれがあるからである。
【０４４４】
今回歩容の上体姿勢復元モーメントＺＭＰ換算値（ＺＭＰrec）パターンの台形高さbcurrを決定する方法として、以下の方法を用いてもよい。
【０４４５】
前記ＺＭＰrec修正歩容（図３４のＳ７１８の説明を参照）の今回歩容終端時点での上体姿勢角と角速度をそれぞれθcurr、vθcurrとし、これらと、定常歩容の初期上体姿勢角、角速度との差をΔθcerr、Δvθcerrとする。
【０４４６】
歩容周期をインターバルとし、仮今回歩容の終端上体姿勢角、角速度と定常歩容の初期上体姿勢角、角速度との差θerr、vθerrを前回状態、bcurrを入力、Δθcerr、Δvθcerrを今回状態とする離散系の状態方程式を立てて、Δθcerr、Δvθcerrを０に収束させるように、現代制御理論等を用いてフィードバック則を決定し、これに基づいてbcurrを求めてもよい。
【０４４７】
今回歩容及び又は定常歩容のＺＭＰrecは、台形パターンとせず、各瞬間において、目標上体姿勢角・角速度と基準上体姿勢角・角速度との差などを基に、その差が０に収束するように、状態フィードバックなど則を用いて、各瞬間におけるＺＭＰrecの値を決定してもよい。
【０４４８】
今回歩容のＺＭＰrecは、台形パターンとせず、各瞬間において今回歩容の目標上体姿勢角・角速度を基に、これらが第１旋回歩容の初期上体姿勢角・角速度に近づくように、状態フィードバック則などを用いて、各瞬間におけるＺＭＰrecを決定してもよい。
【０４４９】
次に、ロボット１の歩行歩容の生成に関して説明する。なお、ここで、歩行歩容は、空中期がなく、片脚支持期と両脚支持期とが交互に繰り返される歩容である。
【０４５０】
歩行歩容を生成する場合には、Ｓ１０６及びＳ６０６において以下のような処理を行う。すなわち、膝の曲げ角度が適切であるかなど、少なくとも各脚体の関節の変位に関する幾何学的条件（幾何学的制約条件）から決定した上体鉛直位置軌道（本出願人による特開平１０−８６０８０号公報に示される上体高さ決定手法などを用いた上体鉛直位置軌道）の位相や振幅などの特徴量をできる限り満足するように床反力鉛直成分軌道を決定する。
【０４５１】
これにより、歩容生成のアルゴリズムの主要部を走行と歩行とで共通化しつつ、歩行途中から走行へ、又は走行途中から歩行に移行することもできるようになる。
【０４５２】
図４３を用いてその処理を説明すると、まず、Ｓ１３００において、本出願人が先に特開平１０−８６０８０号公報に提案した上体高さ決定法などを用いて、少なくとも各脚体２の関節の変位に関する所定の幾何学的制約条件を満足する上体鉛直位置軌道を求める。以降、これを基準上体鉛直位置軌道と呼ぶ。
【０４５３】
より具体的には、まず、要求パラメータに応じて決定した足平軌道パラメータや目標ＺＭＰ軌道パラメータなどを基に、本出願人が先に提案した前記特許文献１の第１実施形態を用いて、上体水平位置軌道が求められる。なお、この場合、上体水平位置軌道は、床反力鉛直成分がロボット１の自重に一致し、また、上体鉛直位置が、あらかじめ定めた一定値であるとして、目標ＺＭＰ回りの床反力モーメントの水平成分が０になるように決定される。また、このときの上体姿勢軌道は例えば一定姿勢（鉛直姿勢等）の軌道でよい。
【０４５４】
次に、本願出願人が先に提案した上体高さ決定法（特開平１０−８６０８０号公報。より具体的には同公報の図６の手法等）を用いて、足平軌道パラメータにより定まる足平軌道や上記の如く決定した上体水平位置軌道、上体姿勢軌道を基に上体鉛直位置軌道が算出され、これをもって前記基準上体鉛直位置軌道とする。
【０４５５】
次にＳ１３０２に進み、基準上体鉛直位置軌道になるべく似た目標上体鉛直位置軌道を生成することが可能な床反力鉛直成分軌道を決定するために、基準上体鉛直位置軌道の振幅や位相などの特徴量が算出（抽出）される。例えば、基準上体鉛直位置軌道の振幅（最小値と最大値との差）が特徴量として算出される。
【０４５６】
次にＳ１３０４に進み、床反力鉛直成分軌道パラメータを基に生成される上体鉛直位置軌道が、前記特徴量をできる限り満足し得るように（前記基準上体鉛直位置軌道にできるだけ似たパターンになるように）、床反力鉛直成分軌道パラメータ（折れ点での時刻や床反力鉛直成分の値）が決定される。より具体的には、歩行歩容の場合、定常歩容の第１旋回歩容と第２旋回歩容、及び今回歩容の床反力鉛直成分軌道は、例えば、図４２のような折れ線状に設定される。すなわち、両脚支持期では、床反力鉛直成分の増加側に凸（上に凸）の台形状に設定され、片脚支持期では床反力鉛直成分の減少側に凸（下に凸）の台形状に設定される。そして、この床反力鉛直成分軌道を歩容初期（両脚支持期の開始時刻）から終端（片脚支持期の終了時刻）まで２階積分して得られるロボット１の全体重心鉛直位置軌道に対応する上体鉛直位置軌道の最大値と最小値との差が前記特徴量に一致するように、床反力鉛直成分軌道パラメータ、例えば該床反力鉛直成分軌道の２つの台形の高さC1，C2が決定される（この例では床反力鉛直成分軌道の折れ点の時刻は歩容周期に関する要求パラメータに応じて決定される）。
【０４５７】
但し、定常歩容の床反力鉛直成分軌道のパラメータは、前述のごとく以下の条件も満足するように決定される。
（条件）床反力鉛直成分軌道の定常歩容全期間（第１旋回歩容と第２旋回歩容両方の期間）における平均値をロボットの自重と一致させる。すなわち、床反力鉛直成分の平均値がロボットに作用する重力と同じ大きさで反対向きになるようにする。
【０４５８】
また、今回歩容の床反力鉛直成分軌道のパラメータは、前述のごとく、上体（全体重心）鉛直位置軌道が定常歩容に連続してつながるあるいは近づくように決定される。
【０４５９】
以上により、歩行歩容における目標床反力鉛直成分軌道（これを規定するパラメータ）が決定されることとなる。以上説明した目標床反力鉛直成分軌道の決定処理以外の歩容生成処理は、前記した走行歩容に係る実施形態と同一でよい。
【０４６０】
上記のごとく基準上体鉛直位置軌道を求めるために要する演算量はかなり多いので、定常歩容の運動パラメータ（足平軌道パラメータなど）と上体（全体重心）鉛直位置軌道の特徴量（振幅など）との関係を表すマップをあらかじめ作成して記憶しておいて、与えられた定常歩容パラメータから、上記マップを参照することで、特徴量を求めるようにしてもよい。
【０４６１】
又は、床反力鉛直成分から生成される上体（全体重心）鉛直位置軌道の特徴量が基準上体鉛直位置軌道の特徴量にほぼ一致する場合における定常歩容の運動パラメータと床反力鉛直成分軌道パラメータとの関係を表すマップをあらかじめ作成して記憶しておいて、与えられた定常歩容パラメータから、上記マップを参照することで、床反力鉛直成分軌道パラメータを直接的に求めるようにしてもよい。
【０４６２】
なお、前記特徴量は、基本的には、前記幾何学的制約条件に基づく基準上体鉛直位置軌道の形状の特徴を表すものであればよく、該基準上体鉛直位置軌道の振幅や位相などのほか、周波数成分等（例えば基本周波数成分の振幅など）を特徴量として用いてもよい。
【０４６３】
さらには、上記の例では、１歩分の基準上体鉛直位置軌道の特徴量を用いたが、基準上体鉛直位置軌道の初期状態（位置・速度）を特徴量として用いて、以下のように床反力鉛直成分軌道パラメータを決定するようにしてもよい。
【０４６４】
すなわち、図４４に示すごとく、まずＳ１４００において、本出願人が先に提案した上体高さ決定法（特開平１０−８６０８０号公報）などを用いて、少なくとも幾何学的制約条件に基づいて、歩容の初期時刻とそれからΔｔ秒後（制御周期後）の基準上体鉛直位置を決定し、これらの初期時刻及びΔｔ秒後の基準状態鉛直位置の差を基に、初期基準上体鉛直速度を算出する。なお、初期時刻とΔｔ秒後の基準状態鉛直位置は、例えば前記図４３のＳ１３００の処理を初期時刻からΔｔ秒後まで実行すれば決定できる。
【０４６５】
次いで、Ｓ１４０２に進み、初期基準上体鉛直速度と足平軌道パラメータにより定まる足平位置軌道とを基に、ロボット幾何学モデル（例えば式０４の両辺を微分したもの）を用いて、初期基準全体重心鉛直速度を算出する。
【０４６６】
最後に、Ｓ１４０４に進み、床反力鉛直成分軌道から生成される全体重心鉛直位置軌道の初期速度が、上記の如く求めた初期基準全体重心鉛直速度に一致するように、床反力鉛直成分軌道パラメータを決定する。なお、この場合も、上記初期速度の条件だけでなく、定常歩容と今回歩容とでそれらに係わる前記した条件（図４３の処理に関して説明した条件）をも満たすように床反力鉛直成分軌道パラメータが決定される。
【０４６７】
また、図４４の処理を図１４のＳ１０６で行うと、その時点で初期（時刻Ts）上体鉛直速度Ｖｚsが決定されるので、当然、図１９のＳ２０６においては、上体鉛直速度Ｖｚsを求める処理を省略できる。
【０４６８】
歩行歩容を生成する場合には、本出願人が先に提案した上体高さ決定法（特開平１０−８６０８０号公報）などを用いて、少なくとも幾何学的制約条件に基づいて上体鉛直位置を決定し、走行歩容を生成する場合には、前記図３６のＳ９０６、Ｓ９０８のごとく床反力鉛直成分から決定されるようにしてもよい。この場合、歩行から走行あるいは走行から歩行に移行する際の歩容における最終的な上体鉛直位置は、幾何学的制約条件に基づいて決定される歩行用の上体鉛直位置Ｚgと、床反力鉛直成分から動力学的に決定される走行用の上体鉛直位置Ｚfとを合成することにより決定することが好ましい。より具体的には、例えば次式７１のように、それらの上体鉛直位置Zg，Zfの重み付き平均により最終的な上体鉛直位置Ｚを決定する。この場合、重みｗを１から０あるいは０から１に徐々に変化させる。これにより、歩行と走行の間の移行時の上体鉛直位置軌道を滑らかに変化させることができる。
上体鉛直位置Ｚ =(1−w)*Ｚg + w*Ｚf …式７１
【０４６９】
具体的な処理を図４５を用いて説明すると、まず、Ｓ１５００において、前記の実施形態で説明した如く（図３６のＳ９０８を参照）、目標床反力鉛直成分軌道に応じて定まる全体重心鉛直位置軌道を満足する上体鉛直位置Zfを算出する。次いでＳ１５０２に進み、本出願人が先に提案した上体高さ決定法などを用いて、少なくとも各脚体２の関節（膝関節）の変位に関する幾何学的制約条件に基づいて決定される上体鉛直位置Zgを生成する。
【０４７０】
次いで、Ｓ１５０４に進み、歩容の時期に応じて重みｗを決定する。例えば、歩容の初期から終端にかけて、０から１又は１から０に徐々に変化するように前記式７１の重みｗを決定する。この場合、歩行から走行への移行時には、ｗを０から１に変化させ、走行から歩行への移行時には、ｗを１から０に変化させるように重みｗを決定する。なお、この時、重みｗの変化率（重みの１階時間微分）も連続的に変化するように設定するとよい。さらには、重みｗの変化率の変化率（重みの２階時間微分）も連続的に変化するように設定するとよい。こうすることにより、最終的に生成される上体鉛直位置軌道が滑らかになる。
【０４７１】
最後に、Ｓ１５０６に進み、前記式７１により、最終的な上体鉛直位置を決定する。
【０４７２】
なお、上記のごとく、歩行から走行あるいは走行から歩行に移行する時にだけ、重みｗが０と１の中間の値をとるのではなく、それ以外の時でも重みｗが０と１の中間の値をとるようにしてもよい。また、歩行から走行、又は走行から歩行への移行は、１歩容で行なう必要はなく、複数歩容で行なうようにしてもよい。
【０４７３】
斜面移動時（傾斜した床面でロボット１を移動させるとき）の歩容生成においては、床反力水平成分許容範囲や全体重心加速度水平成分の代わりに、並進床反力の床面平行成分（床面に平行な成分）、すなわち摩擦力の許容範囲、あるいは全体重心加速度の床面平行成分（これは摩擦力に比例する）の許容範囲を設定するようにしてもよい。例えば、並進床反力の床面平行成分（摩擦力）の許容範囲を設定する場合に関して説明（この説明は全体重心加速度の床面平行成分の許容範囲を設定する場合でも同様である）すると、該摩擦力は、床面の水平面に対する傾斜角度θf（ロボット１の進行方向に向かって前下がり斜面の場合を正とする）とすると、次式７２の関係が成立する。従って、前記実施形態と同様のアルゴリズムに歩容を生成する場合、この式７２の関係を用いて、摩擦力許容範囲を床反力水平成分許容範囲に変換することで、該床反力水平成分許容範囲を設定するようにすればよい。なお、この場合、式７２の床反力鉛直成分には、目標床反力鉛直成分を用いればよい。
Figure 0003672101
【０４７４】
今回歩容のパラメータ決定は、前記実施形態のように前回歩容が完了した時点で行う以外に、本願出願人による前記特許文献１に記述されているように、今回歩容の生成途中で、再決定してもよい。こうすることにより、演算量は増えるが、歩容に対する要求に変更があった時に即応できるからである。
【０４７５】
また、歩容の修正（今回歩容パラメータを再決定すること）が、今回制御周期で間に合わない場合には、とりあえず今回は、修正しない歩容あるいは暫定的に修正した歩容（探索途中の歩容であって、完全には、探索完了条件（歩容境界条件のずれが許容値以内に入っていること）を満足していない歩容）を出力し、次回制御周期までに、あるいは複数制御周期後までに（暫定的でない）適切な修正歩容にしてもよい。修正された目標ＺＭＰ軌道と目標床反力鉛直成分軌道は連続であり、短時間後では、これらが急激に変化することはないので、今回歩容の目標ＺＭＰ軌道と目標床反力鉛直成分軌道が若干ぎざぎざになるだけで、ほとんど問題はない。
【０４７６】
前記図１２のＳ０３２における、スピン力をキャンセルする腕振り動作の代わりに、上体２４をその体幹軸（あるいは鉛直軸）まわりに回転させる（ひねる）動作を行ってもよい。あるいは、腕振り動作と上体２４をその体幹軸（あるいは鉛直軸）まわりに回転させる（ひねる）動作とを併用してもよい。
【０４７７】
前記図２１のＳ４０８及び図３６のＳ９０８において、全体重心鉛直位置速度を満足する上体鉛直位置を決定する際には、前述のごとく式０４などを用いて解析的に上体鉛直位置を決定する代わりに、以下の別手法１又は２によって上体鉛直位置を決定してもよい。
【０４７８】
別手法１
図４６に、別手法１の演算処理フローチャートを示す。
【０４７９】
まずＳ１１００において、前回瞬時目標歩容状態（時刻ｋ−１に決定された目標歩容状態）などを基に動力学モデルを用いて全体重心鉛直位置・速度が算出される。以降、動力学モデルを用いて算出した全体重心鉛直位置・速度をモデル全体重心鉛直位置・速度と呼ぶ。すなわち、Ｓ１１００では、前回モデル全体重心鉛直位置・速度が算出される。なお、上記動力学モデルは例えば前記図１１のような多質点モデル等を用いればよい。
【０４８０】
次いで、Ｓ１１０２に進み、上記の如く求めた前回モデル全体重心鉛直位置・速度と、図２１のＳ４０６又は図３６のＳ９０６において算出された全体重心鉛直位置速度、すなわち目標床反力鉛直成分の今回値（時刻ｋの値）を満足する全体重心鉛直位置・速度との差（位置の差と速度の差の両者。以降この差を重心鉛直位置・速度偏差と呼ぶ）が求められる。すなわち、次式８０により重心鉛直位置・速度偏差が決定される。
Figure 0003672101
【０４８１】
次いで、Ｓ１１０４に進み、目標床反力鉛直成分を満足する全体重心鉛直位置・速度に前記モデル全体重心鉛直位置・速度が追従するように、少なくとも前記重心鉛直方向偏差と前回上体鉛直位置（時刻k−1で決定された上体鉛直位置）を基に、今回上体鉛直位置（上体鉛直位置の今回値）を決定する。例えば、次式によって今回上体鉛直位置が決定される。
Figure 0003672101
但し、Kgz、Kgvzはゲインである。
【０４８２】
Kgvzは０でも構わない。この場合、モデル全体重心鉛直速度、目標床反力鉛直成分を満足する全体重心鉛直速度及び重心鉛直方向速度偏差を算出する必要はない。
【０４８３】
以上のごとく、今回上体鉛直位置が算出される。この場合、式８１によるときには、重心鉛直位置偏差及び重心鉛直速度偏差に応じて今回上体鉛直位置が算出されることとなる。
【０４８４】
また、今回上体鉛直位置を求めるために、重心鉛直位置偏差に応じた成分や、重心鉛直速度偏差に応じた成分の他、さらに、例えば以下のようにロボット１のモデル（例えば図１０のモデルからフライホイールFHを除いた３質点モデル）を用いて求めた上体鉛直位置に応じた成分（フィードフォワード成分）を前回上体鉛直位置に加算することで、今回上体鉛直位置を求めるようにしてもよい。この場合には、図２１のＳ４０６又は図３６のＳ９０６において算出された全体重心鉛直位置速度、すなわち目標床反力鉛直成分の今回値（時刻ｋの値）を満足する全体重心鉛直位置速度と、図２１のＳ４０４又は図３６のＳ９０４において算出された目標両足平位置姿勢の今回値（時刻ｋの値）とから、例えば上記３質点モデルを用いて仮上体鉛直位置（これをここでは、FF上体鉛直位置という）を求める。なお、図２１のＳ４０８又は図３６のＳ９０８において前述の如く図１０のモデルを用いて上体鉛直位置を求めていた場合には、それをそのまま上記FF上体鉛直位置として用いればよい。
【０４８５】
そして、このようにして求めたFF上体鉛直位置に適当なゲインを乗算したものをフィードフォワード成分として、前記式８１の右辺にさらに加算し、これにより、今回上体鉛直位置を求める。つまり、重心鉛直位置偏差及び重心鉛直速度偏差と（重心鉛直速度偏差は省略してもよい）、FF上体鉛直位置とに応じて前回上体鉛直位置を補正することで、今回上体鉛直位置が求められる。このようにすると、最終的に求められる今回上体鉛直位置の変動を抑えることができる。なお、この手法で前回上体鉛直位置を求めるために用いるロボット１のモデルは、より厳密なモデルであることが好ましい。
【０４８６】
別手法２
また、以下に示すように繰り返し探索手法を用いた別手法２によって今回上体鉛直位置を決定してもよい。図４７に、その手法の演算処理フローチャートを示す。
【０４８７】
まずＳ１２００において、上体鉛直位置速度（より詳しくは上体鉛直位置速度の今回値の候補）が仮決定される。例えば、前回目標歩容瞬時値の上体鉛直位置速度（前回値）が上体鉛直位置速度の候補値として仮決定される。あるいは、上体鉛直位置の前回値に、前回目標歩容瞬時値の上体鉛直速度と制御周期Δｔとの積を加えた値を上体鉛直位置の候補値として仮決定してもよい。
【０４８８】
次いで、Ｓ１２０２を経て、Ｓ１２０４に進み、上体鉛直位置速度（候補）の現在値（現在の仮決定値）と、前記求めた目標両足平位置姿勢の今回値、時刻(k−Δk)の目標上体姿勢（又は前記求めた基準上体姿勢の今回値）、前記求めた目標腕姿勢の今回値、時刻(k−Δk)の上体水平位置及びそれらの変化率から決定されるロボット１の姿勢状態から今回モデル全体重心鉛直位置・速度が算出される。なお、今回モデル全体重心鉛直位置・速度の算出で用いる一部の変数には前回値が用いられている。
【０４８９】
次いで、Ｓ１２０６に進み、次式８２により、重心鉛直方向位置・速度偏差を算出する。
Figure 0003672101
【０４９０】
次いで、Ｓ１２０８に進み、式８２で求めた重心鉛直位置偏差が所定の許容範囲内にあれば、最終的に求められた上体鉛直位置（現在値）を上体鉛直位置の今回値（今回上体鉛直位置）として決定し、今回上体鉛直位置決定の処理を完了する。また、Ｓ１２０８の判断で重心鉛直位置偏差が所定の許容範囲内にない場合には、Ｓ１２１０に進み、次式により、上体鉛直位置の次候補を決定する。
Figure 0003672101
【０４９１】
次いで、Ｓ１２１２に進み、上体鉛直位置次候補を改めて上体鉛直位置とし（上体鉛直位置の候補を更新する）、再びＳ１２０４に進む。そして、この新たな上体鉛直位置の候補を基に今回モデル全体重心鉛直位置・速度が求められ、以下、重心鉛直方向位置・速度偏差が所定の許容範囲内になるまで、上記の処理が繰り返される。
【０４９２】
これらの手法１、２は、モデル全体重心鉛直位置が、図２１のＳ４０６又は図３６のＳ９０８において算出された全体重心鉛直位置、すなわち目標床反力鉛直成分の今回値を全体質量で割った値を２階積分することにより得られる全体重心鉛直位置に追従又はほぼ一致するように、上体鉛直位置を決定するものである。
【０４９３】
この代わりに、モデル全体重心鉛直速度が、目標床反力鉛直成分の今回値を全体質量で割った値を１階積分することにより得られる全体重心鉛直速度に追従又はほぼ一致するように、手法１又は手法２と同様の手法により上体鉛直位置を決定し、これを１階積分することにより上体鉛直速度を決定してもよい。
【０４９４】
又は、モデル全体重心鉛直加速度が、目標床反力鉛直成分の今回値を全体質量で割った値に追従又はほぼ一致するように、手法１又は手法２と同様の手法により上体鉛直加速度を決定し、これを２階積分することにより上体鉛直位置を決定してもよい。
【０４９５】
但し、前記別手法１及び２に較べ、瞬間的な動力学的誤差は少ないが、積分誤差によって、モデル全体重心鉛直位置が、目標床反力鉛直成分の今回値を全体質量で割った値を２階積分することにより得られる全体重心鉛直位置からずれても、そのずれを０に収束される作用が働かないので、歩容の動力学的精度が長期的には低下する傾向がある。
【０４９６】
言い換えると、前記別手法１及び２においては、瞬間的な動力学的誤差は若干大きいが、長期的な動力学的誤差は少ないので、ロボットの姿勢の安定性が高くなる。
【０４９７】
【図面の簡単な説明】
【図１】本発明の実施形態における脚式移動ロボットとしての２足移動ロボットの全体的構成の概略を示す概略図
【図２】図１のロボットの各脚体の足平部分の構成を示す側面図
【図３】図１のロボットに備えた制御ユニットの構成を示すブロック図
【図４】図３の制御ユニットの機能的構成を示すブロック図
【図５】図１のロボットの走行歩容を例示する説明図
【図６】目標床反力鉛直成分の設定例を示す線図
【図７】目標ＺＭＰの設定例を示す線図
【図８】ロボットの運動モード（上体並進モード及び上体回転モード）の説明図
【図９】ロボットの運動モード（上体並進モード及び上体回転モード）の説明図
【図１０】ロボットの動力学モデルの説明図
【図１１】ロボットの動力学モデルの説明図
【図１２】図３の制御ユニットに備えた歩容生成装置のメインルーチン処理を示すフローチャート
【図１３】ロボットの上体位置の発散状態を示す説明図
【図１４】図１２のフローチャートサブルーチン処理を示すフローチャート
【図１５】定常歩容足平着地位置姿勢及び座標系の関係を示す説明図
【図１６】定常歩容の目標床反力鉛直成分の設定例を示す線図
【図１７】定常歩容の床反力水平成分許容範囲の設定例を示す線図
【図１８】定常歩容の目標ＺＭＰの設定例を示す線図
【図１９】図１２のフローチャートのサブルーチン処理を示すフローチャート
【図２０】図１９のフローチャートのサブルーチン処理を示すフローチャート
【図２１】図２０のフローチャートのサブルーチン処理を示すフローチャート
【図２２】図２１のフローチャートのサブルーチン処理を示すフローチャート
【図２３】図２２のフローチャートの要部の処理を説明するための線図
【図２４】図２２のフローチャートの要部の処理を説明するための線図
【図２５】図２２のフローチャートの要部の処理を説明するための線図
【図２６】図２２のフローチャートの要部の処理を説明するための線図
【図２７】図２２のフローチャートの要部の処理を説明するための線図
【図２８】図２２のフローチャートの要部の処理を説明するための線図
【図２９】図２２のフローチャートの要部の処理を説明するための線図
【図３０】図２２のフローチャートの要部の処理を説明するための線図
【図３１】定常歩容における上体位置の軌道の例を示す説明図
【図３２】図１２のフローチャートのサブルーチン処理を示すフローチャート
【図３３】今回歩容の床反力水平成分許容範囲の設定例を示す線図
【図３４】図１２のフローチャートのサブルーチン処理を示すフローチャート
【図３５】図３４のフローチャートのサブルーチン処理を示すフローチャート
【図３６】図３５のフローチャートのサブルーチン処理を示すフローチャート
【図３７】図３６のフローチャートのサブルーチン処理を示すフローチャート
【図３８】図３７のフローチャートの要部の処理を説明するための線図
【図３９】今回歩容と定常歩容とにおける上体水平位置軌道の関係を示す線図
【図４０】ロボットの運動のモードの他の例を示す説明図
【図４１】定常歩容に収束する今回歩容の終端における上体水平位置と上体水平速度との関係を示す線図
【図４２】歩行歩容における目標床反力鉛直成分の設定例を示す線図
【図４３】歩行歩容における目標床反力鉛直成分の設定処理を例示するフローチャート
【図４４】歩行歩容における目標床反力鉛直成分の設定処理を例示するフローチャート
【図４５】歩行と走行との間の歩容の切換に関する処理を示すフローチャート
【図４６】目標上体鉛直位置の決定処理を例示するフローチャート
【図４７】目標上体鉛直位置の決定処理を例示するフローチャート
【図４８】走行歩容における上体鉛直位置と床反力鉛直成分との関係を示す線図
【図４９】歩行歩容における上体鉛直位置と床反力鉛直成分との関係を示す線図

Claims (8)

  1. 上体から延設された複数の脚体を運動させて移動する脚式移動ロボットの目標歩容を所定期間分の歩容ずつ生成すると共に、新たに生成しようとする所定期間分の目標歩容である今回歩容を生成するとき、その今回歩容に続く仮想的な周期的歩容としての定常歩容に該今回歩容を連続させ、又は近づけるように該今回歩容を生成する歩容生成装置において、
    前記今回歩容で前記ロボットに作用させる並進床反力の水平成分又は該並進床反力の床面平行成分又は該ロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分の許容範囲を設定する許容範囲設定手段と、
    前記今回歩容の仮目標床反力作用点軌道とその作用点回りに発生する床反力モーメントの水平成分の目標軌道である仮目標床反力モーメント軌道とを決定する仮目標床反力決定手段と、
    少なくとも並進床反力と床反力モーメントとの発生比率が互いに異なるロボットの２つの運動モードを合成してなる仮目標運動軌道を、該仮目標運動に応じて発生する並進床反力の水平成分又は該並進床反力の床面平行成分又は該ロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分が前記許容範囲を逸脱する可能性が高いものとしてあらかじめ定めた第１所定期間では、並進床反力の水平成分又は該並進床反力の床面平行成分又は該ロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分を前記許容範囲内に制限しつつ、前記仮目標運動に応じて生じるロボットの慣性力と重力との合力が前記仮目標床反力作用点回りに発生するモーメントの水平成分が前記仮目標床反力モーメントに一致するという動力学的平衡条件を満たすように決定すると共に、該並進床反力の水平成分又は該並進床反力の床面平行成分又は該ロボットの全体重心加速度の水平成分又は該全体重心加速度の床面平行成分が前記許容範囲を逸脱する可能性が低いものとしてあらかじめ定めた第２所定期間では、少なくとも前記２つの運動モードのうちの１つの運動モードの運動を調整することによって前記動力学的平衡条件を満たすように決定する仮目標運動決定手段と、
    前記今回歩容の終了時刻における前記仮目標運動軌道の状態に基づいて、該今回歩容の２つの運動モードの運動を前記定常歩容の運動に連続させ、又は近づけるように前記第２所定期間における仮目標運動と、前記仮目標床反力作用点及び仮目標床反力モーメントのうちの少なくともいずれかとを修正して、今回歩容における前記２つの運動モードの目標運動軌道と目標床反力作用点軌道と目標床反力モーメント軌道とを決定する歩容修正手段とを備えたことを特徴とする脚式移動ロボットの歩容生成装置。
  2. 前記仮目標床反力作用点軌道は、その作用点回りに発生する前記仮目標床反力モーメントの水平成分を零とする床反力作用点の軌道であることを特徴とする請求項１記載の脚式移動ロボットの歩容生成装置。
  3. 前記２つの運動モードは、ロボットの上体の姿勢変化運動の運動モードと、上体の並進運動の運動モードとからなり、前記仮目標運動決定手段は、前記第２所定期間では、上体の並進運動を調整することによって前記動力学的平衡条件を満たすように前記仮目標運動軌道を決定することを特徴とする請求項１記載の脚式移動ロボットの歩容生成装置。
  4. 前記仮目標運動決定手段と前記歩容修正手段とのそれぞれの処理は、少なくとも前記上体の姿勢変化運動に対応するフライホイールの回転運動と前記上体の並進運動に対応する上体質点の並進運動と床反力との関係を表す動力学モデルを用いて実行されることを特徴とする請求項３記載の脚式移動ロボットの歩容生成装置。
  5. 前記歩容修正手段は、前記仮目標床反力作用点軌道及び仮目標床反力モーメント軌道のうち、修正対象の仮目標軌道の修正量パターンを規定する所定のパラメータの値を決定し、その決定したパラメータにより定まるパターンの修正量を前記修正対象の仮軌道に加えることにより該修正対象の目標軌道を決定することを特徴とする請求項１記載の脚式移動ロボットの歩容生成装置。
  6. 前記目標歩容はロボットの少なくとも一つの脚体を着地させる着地期と、全ての脚体を空中に浮かせる空中期とを交互に繰り返す歩容であり、前記許容範囲は、少なくとも前記空中期では零に設定されることを特徴とする請求項１記載の脚式移動ロボットの歩容生成装置。
  7. 前記仮目標床反力作用点軌道とこれを前記歩容修正手段により修正してなる目標床反力作用点軌道とは、前記着地期及び空中期を合わせた全期間で実質的に連続して変化するように決定されることを特徴とする請求項６記載の脚式移動ロボットの歩容生成装置。
  8. 前記許容範囲は、直交する２方向のそれぞれの許容範囲が互いに独立に設定されることを特徴とする請求項１記載の脚式移動ロボットの歩容生成装置。
JP2003557765A 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置 Expired - Lifetime JP3672101B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2001399496 2001-12-28
JP2001399496 2001-12-28
PCT/JP2002/013594 WO2003057424A1 (fr) 2001-12-28 2002-12-26 Production de demarche pour robot se deplaçant sur des jambes

Publications (2)

Publication Number Publication Date
JPWO2003057424A1 JPWO2003057424A1 (ja) 2005-05-19
JP3672101B2 true JP3672101B2 (ja) 2005-07-13

Family

ID=19189479

Family Applications (7)

Application Number Title Priority Date Filing Date
JP2003557771A Expired - Lifetime JP3672103B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置及び制御装置
JP2003557764A Expired - Lifetime JP3672100B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置
JP2003557767A Expired - Lifetime JP3674789B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置
JP2003557770A Expired - Lifetime JP3640255B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置
JP2003557766A Expired - Lifetime JP3672102B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置及び制御装置
JP2003557765A Expired - Lifetime JP3672101B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置
JP2003557763A Expired - Lifetime JP3674788B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置

Family Applications Before (5)

Application Number Title Priority Date Filing Date
JP2003557771A Expired - Lifetime JP3672103B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置及び制御装置
JP2003557764A Expired - Lifetime JP3672100B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置
JP2003557767A Expired - Lifetime JP3674789B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置
JP2003557770A Expired - Lifetime JP3640255B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置
JP2003557766A Expired - Lifetime JP3672102B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置及び制御装置

Family Applications After (1)

Application Number Title Priority Date Filing Date
JP2003557763A Expired - Lifetime JP3674788B2 (ja) 2001-12-28 2002-12-26 脚式移動ロボットの歩容生成装置

Country Status (6)

Country Link
US (7) US7496428B2 (ja)
EP (7) EP1470900B1 (ja)
JP (7) JP3672103B2 (ja)
KR (7) KR100917181B1 (ja)
DE (7) DE60236460D1 (ja)
WO (7) WO2003057424A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013180352A1 (ko) * 2012-05-29 2013-12-05 (주)엠텍 와이어가이드 및 그를 이용한 구동장치

Families Citing this family (97)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE60237999D1 (de) * 2001-12-28 2010-11-25 Honda Motor Co Ltd Vorrichtung zur steuerung des ganges für mobilen roboter mit beinen
DE60236460D1 (de) * 2001-12-28 2010-07-01 Honda Motor Co Ltd Gangerzeugungsvorrichtung für beweglichen roboter mit beinen
WO2003061917A1 (fr) * 2002-01-18 2003-07-31 Honda Giken Kogyo Kabushiki Kaisha Dispositif de commande pour robot bipede
WO2003090979A1 (fr) 2002-04-26 2003-11-06 Honda Giken Kogyo Kabushiki Kaisha Systeme permettant d'estimer l'attitude d'un robot mobile monte sur des jambes
JP4225968B2 (ja) 2002-04-26 2009-02-18 本田技研工業株式会社 脚式移動ロボットの制御装置
JP3599244B2 (ja) 2002-11-06 2004-12-08 ソニー株式会社 ロボット装置、ロボット装置の運動制御装置並びに運動制御方法
US7238079B2 (en) * 2003-01-14 2007-07-03 Disney Enterprise, Inc. Animatronic supported walking system
CN100344416C (zh) * 2003-03-23 2007-10-24 索尼株式会社 机器人装置和控制该装置的方法
JP4181175B2 (ja) 2003-06-27 2008-11-12 本田技研工業株式会社 脚式移動ロボットの制御装置
KR101112496B1 (ko) 2003-06-27 2012-08-01 혼다 기켄 고교 가부시키가이샤 다리식 이동 로봇의 제어장치
KR20050005995A (ko) * 2003-07-08 2005-01-15 삼성전자주식회사 2족 보행 이동 장치의 보행 제어 방법
JP4592276B2 (ja) * 2003-10-24 2010-12-01 ソニー株式会社 ロボット装置のためのモーション編集装置及びモーション編集方法、並びにコンピュータ・プログラム
JP4513320B2 (ja) * 2003-12-17 2010-07-28 ソニー株式会社 ロボット装置、並びにロボット装置の運動制御方法
WO2005075156A1 (ja) * 2004-02-06 2005-08-18 Honda Motor Co., Ltd. 移動ロボットの歩容生成装置
US7319302B2 (en) 2004-02-16 2008-01-15 Honda Motor Co., Ltd. Gate generating system for mobile robot
JP4805818B2 (ja) * 2004-02-27 2011-11-02 本田技研工業株式会社 移動ロボットの歩容生成装置
JP4744092B2 (ja) * 2004-03-23 2011-08-10 本田技研工業株式会社 脚式移動ロボットおよびその制御装置
US8060253B2 (en) * 2004-03-31 2011-11-15 Honda Motor Co., Ltd. Systems and methods for controlling a legged robot based on rate of change of angular momentum
JP4613539B2 (ja) * 2004-07-16 2011-01-19 トヨタ自動車株式会社 ロボットの動作計画方法
JP4410051B2 (ja) * 2004-07-22 2010-02-03 本田技研工業株式会社 角速度計測装置および脚式移動ロボット
JP4485279B2 (ja) 2004-08-02 2010-06-16 本田技研工業株式会社 脚式移動ロボットの歩容生成装置および制御装置
JP2006068872A (ja) * 2004-09-03 2006-03-16 Honda Motor Co Ltd 脚式移動ロボット
JP4531520B2 (ja) * 2004-10-15 2010-08-25 本田技研工業株式会社 脚式移動ロボットの制御装置
KR101131776B1 (ko) 2004-10-15 2012-04-06 혼다 기켄 고교 가부시키가이샤 다리식 이동 로봇의 보용 생성장치
WO2006064598A1 (ja) 2004-12-14 2006-06-22 Honda Motor Co., Ltd. 脚式移動ロボットおよびその制御プログラム
EP1842628B1 (en) * 2004-12-14 2011-05-11 Honda Motor Co., Ltd. Legged mobile robot
JP4440761B2 (ja) 2004-12-24 2010-03-24 本田技研工業株式会社 脚式移動ロボットの制御装置
JP4548135B2 (ja) 2005-02-03 2010-09-22 トヨタ自動車株式会社 脚式ロボットとその制御方法
JP4492395B2 (ja) * 2005-03-09 2010-06-30 トヨタ自動車株式会社 脚式ロボットとその動作制御方法
US7835822B2 (en) * 2005-03-30 2010-11-16 Honda Motor Co., Ltd. Systems and methods for controlling a legged robot using a two-phase disturbance response strategy
US7689320B2 (en) * 2005-12-20 2010-03-30 Intuitive Surgical Operations, Inc. Robotic surgical system with joint motion controller adapted to reduce instrument tip vibrations
JP4951732B2 (ja) * 2006-05-02 2012-06-13 ソニー株式会社 駆動方法、駆動制御装置及びロボット
KR100835354B1 (ko) * 2006-07-05 2008-06-04 삼성전자주식회사 보행로봇 및 그의 제어방법
JP4591419B2 (ja) * 2006-07-18 2010-12-01 トヨタ自動車株式会社 ロボットとその制御方法
JP4692443B2 (ja) 2006-09-06 2011-06-01 トヨタ自動車株式会社 脚式ロボット
US8180486B2 (en) * 2006-10-02 2012-05-15 Honda Motor Co., Ltd. Mobile robot and controller for same
JP4930003B2 (ja) * 2006-11-20 2012-05-09 株式会社日立製作所 移動ロボット
WO2008067404A2 (en) * 2006-11-29 2008-06-05 Honda Motor Co., Ltd. Determination of foot placement for humanoid push recovery
JP4985776B2 (ja) * 2007-09-25 2012-07-25 富士通株式会社 ロボット制御装置、ロボット制御方法およびロボット制御プログラム
WO2009067458A1 (en) * 2007-11-21 2009-05-28 Honda Motor Co., Ltd. Learning capture points for humanoid push recovery
KR100958114B1 (ko) * 2007-12-17 2010-05-18 한국과학기술연구원 인간형 로봇의 보행 안정화 및 자세 제어 방법
JP2010058253A (ja) * 2008-09-08 2010-03-18 Waseda Univ ２足歩行ロボットの制御装置、及び２足歩行ロボットの制御方法
US8332068B2 (en) * 2008-12-19 2012-12-11 Honda Motor Co., Ltd. Intelligent stepping for humanoid fall direction change
TW201031507A (en) * 2009-02-25 2010-09-01 Micro Star Int Co Ltd Control apparatus of a multi-axial joint and control method thereof
JP5219956B2 (ja) * 2009-07-23 2013-06-26 本田技研工業株式会社 移動体の制御装置
JP5506618B2 (ja) * 2009-12-28 2014-05-28 本田技研工業株式会社 ロボットの制御装置
KR101687631B1 (ko) * 2010-01-18 2016-12-20 삼성전자주식회사 로봇의 보행 제어 장치 및 그 제어 방법
JP5398592B2 (ja) * 2010-03-01 2014-01-29 本田技研工業株式会社 脚式移動ロボットの運動状態評価装置
JP5398589B2 (ja) 2010-03-01 2014-01-29 本田技研工業株式会社 脚式移動ロボットの目標運動評価装置
US8396593B2 (en) 2010-03-01 2013-03-12 Honda Motor Co., Ltd. Gait generating device of legged mobile robot
US8428780B2 (en) * 2010-03-01 2013-04-23 Honda Motor Co., Ltd. External force target generating device of legged mobile robot
JP5468974B2 (ja) * 2010-04-22 2014-04-09 本田技研工業株式会社 ２足移動ロボットの制御装置及び歩容生成装置
US9120512B2 (en) 2010-04-22 2015-09-01 Honda Motor Co., Ltd. Control device and gait generating device for bipedal mobile robot
KR101200191B1 (ko) * 2010-07-14 2012-11-13 서울대학교산학협력단 데이터 기반 바이페드 제어 장치 및 방법
US8880221B2 (en) * 2011-03-21 2014-11-04 Honda Motor Co., Ltd. Damage reduction control for humanoid robot fall
JP5752500B2 (ja) 2011-06-27 2015-07-22 本田技研工業株式会社 軌道生成システム
US20130077820A1 (en) * 2011-09-26 2013-03-28 Microsoft Corporation Machine learning gesture detection
KR20130073591A (ko) * 2011-12-23 2013-07-03 삼성전자주식회사 지지모듈 및 이를 포함하는 로봇
KR101985790B1 (ko) * 2012-02-21 2019-06-04 삼성전자주식회사 보행 로봇 및 그 제어 방법
US9605952B2 (en) * 2012-03-08 2017-03-28 Quality Manufacturing Inc. Touch sensitive robotic gripper
US9156159B2 (en) * 2012-03-08 2015-10-13 Disney Enterprises Inc. Robot cyclic locomotion using a dynamic object
CN102672719B (zh) * 2012-05-10 2014-11-19 浙江大学 一种仿人机器人手臂作业动态稳定控制方法
JP5642214B2 (ja) * 2013-02-15 2014-12-17 株式会社神戸製鋼所 多関節ロボットの弾性変形補償制御装置
JP6071815B2 (ja) * 2013-09-06 2017-02-01 本田技研工業株式会社 脚式移動ロボットの制御装置
KR101456797B1 (ko) 2013-10-10 2014-10-31 재단법인대구경북과학기술원 다리식 이동 로봇의 방향 전환 제어 장치 및 그 방법
JP5859036B2 (ja) * 2014-02-04 2016-02-10 本田技研工業株式会社 ロボット
JP5897644B2 (ja) * 2014-06-02 2016-03-30 株式会社神戸製鋼所 ロボットの制御装置
US9387896B1 (en) 2014-08-25 2016-07-12 Google Inc. Slip avoidance
US9618937B1 (en) * 2014-08-25 2017-04-11 Google Inc. Slip detection using robotic limbs
US9387588B1 (en) 2014-08-25 2016-07-12 Google Inc. Handling gait disturbances with asynchronous timing
US10081098B1 (en) 2014-08-25 2018-09-25 Boston Dynamics, Inc. Generalized coordinate surrogates for integrated estimation and control
US9623556B1 (en) * 2014-09-03 2017-04-18 X Development Llc Robotic sole joint
JP6228097B2 (ja) * 2014-10-06 2017-11-08 本田技研工業株式会社 移動ロボット
US9446518B1 (en) * 2014-11-11 2016-09-20 Google Inc. Leg collision avoidance in a robotic device
US9499218B1 (en) 2014-12-30 2016-11-22 Google Inc. Mechanically-timed footsteps for a robotic device
CN104765372B (zh) * 2015-03-02 2017-11-10 湘潭大学 一种多足机器人保持直线平动的步态规划方法
JP6407409B2 (ja) * 2015-04-02 2018-10-17 国立大学法人大阪大学 脚型機構体、歩行ロボット、姿勢制御方法及びプログラム
US9594377B1 (en) * 2015-05-12 2017-03-14 Google Inc. Auto-height swing adjustment
JP6450279B2 (ja) * 2015-08-05 2019-01-09 本田技研工業株式会社 移動ロボットの目標ｚｍｐ軌道の生成装置
US9586316B1 (en) 2015-09-15 2017-03-07 Google Inc. Determination of robotic step path
US9789607B1 (en) 2015-11-03 2017-10-17 Google Inc. Achieving a target gait in a legged robot based on steering commands
US10017218B1 (en) * 2015-11-11 2018-07-10 Boston Dynamics, Inc. Achieving a target gait behavior in a legged robot
CN106741277B (zh) * 2015-11-20 2020-10-30 沈阳新松机器人自动化股份有限公司 一种混合式机械腿机构
JP6498597B2 (ja) * 2015-12-14 2019-04-10 本田技研工業株式会社 移動ロボットの制御装置
US9789919B1 (en) 2016-03-22 2017-10-17 Google Inc. Mitigating sensor noise in legged robots
JP7069155B2 (ja) * 2017-06-29 2022-05-17 株式会社ソニー・インタラクティブエンタテインメント ロボットの制御装置、制御方法および制御プログラム
JP6823569B2 (ja) * 2017-09-04 2021-02-03 本田技研工業株式会社 目標ｚｍｐ軌道の生成装置
CN109693234B (zh) * 2017-10-20 2021-08-27 深圳市优必选科技有限公司 机器人跌倒预测方法、装置、终端设备及计算机存储介质
CN109693236B (zh) * 2017-10-23 2021-03-02 深圳市优必选科技有限公司 足式机器人着地控制方法及装置
CN109634100B (zh) * 2018-12-30 2021-11-02 深圳市优必选科技有限公司 仿人机器人行走加速度补偿方法、装置及仿人机器人
CN109856991B (zh) * 2019-01-22 2021-10-15 华东师范大学 一种基于动能热力分布图的动态虚拟人仿真方法
CN110001813B (zh) * 2019-04-19 2021-06-15 常州大学 一种单足驱动同时能够滚动摩擦与滑动的机器人腿
US11292126B2 (en) * 2019-10-17 2022-04-05 Disney Enterprises, Inc. Robots with robust bipedal locomotion supported with non-conventional physics
CN112757295B (zh) * 2020-12-28 2022-03-01 武汉远图信息科技有限公司 一种基于强化学习的双足机器人重心控制方法与仿真系统
DE102021112485B3 (de) 2021-05-12 2022-08-11 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Balancierung eines Roboters, Verfahren zur Ganzkörpersteuerung eines Roboters, Regler sowie Roboter
CN113297798B (zh) * 2021-06-10 2022-10-11 重庆邮电大学工业互联网研究院 一种基于人工神经网络的机器人外界接触力估计方法
US11738452B1 (en) * 2022-07-29 2023-08-29 Sarcos Corp. Sole with various compliant regions for robots

Family Cites Families (36)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08369B2 (ja) 1988-08-09 1996-01-10 工業技術院長 歩行脚運動軌跡制御装置
JP3078009B2 (ja) * 1990-11-30 2000-08-21 本田技研工業株式会社 脚式移動ロボットの歩行制御装置
US5455497A (en) 1992-04-20 1995-10-03 Honda Giken Kogyo Kabushiki Kaisha Legged mobile robot and a system for controlling the same
JP3148827B2 (ja) 1992-04-30 2001-03-26 本田技研工業株式会社 脚式移動ロボットの歩行制御装置
JP3132156B2 (ja) 1992-05-22 2001-02-05 本田技研工業株式会社 脚式移動ロボットの歩容生成装置
JP3273443B2 (ja) * 1992-05-22 2002-04-08 本田技研工業株式会社 ロボットのリンクなどの軌道生成方法及び装置
JP3233450B2 (ja) 1992-05-22 2001-11-26 本田技研工業株式会社 指定時刻到達関数発生器
US5644204A (en) * 1994-11-03 1997-07-01 Nagle; John Anti-slip control for a legged robot and realisitc simulation of a legged creature
US5808433A (en) * 1995-09-29 1998-09-15 Honda Giken Kogyo Kabushiki Kaisha Method of generating gait of legged walking robot and system for controlling its locomotion
JP3662996B2 (ja) * 1996-01-25 2005-06-22 本田技研工業株式会社 脚式移動ロボットの歩行制御装置
JP3658147B2 (ja) 1996-07-25 2005-06-08 本田技研工業株式会社 脚式移動ロボットの歩容生成装置
JP3663034B2 (ja) 1996-07-25 2005-06-22 本田技研工業株式会社 脚式移動ロボットの歩容生成装置
DE69725764T2 (de) * 1996-07-25 2004-08-05 Honda Giken Kogyo K.K. Vorrichtung zur nachbildung des ganges für einen zweibeinigen robotor
US5872893A (en) * 1996-07-25 1999-02-16 Honda Giken Kogyo Kabushiki Kaisha Gait generation system of legged mobile robot
JP3629133B2 (ja) 1997-01-31 2005-03-16 本田技研工業株式会社 脚式移動ロボットの制御装置
JP3672406B2 (ja) 1997-01-31 2005-07-20 本田技研工業株式会社 脚式移動ロボットの歩容生成装置
DE69836765T2 (de) * 1997-01-31 2007-10-04 Honda Giken Kogyo K.K. Steuergerät eines mit beinen beweglichen roboters
JP3592886B2 (ja) 1997-04-08 2004-11-24 同和鉱業株式会社 弗化炭素類の分解方法および分解用反応剤
US6064168A (en) * 1998-03-13 2000-05-16 Fanuc Robotics North America, Inc. Method of controlling robot movement
WO1999054095A1 (fr) * 1998-04-20 1999-10-28 Honda Giken Kogyo Kabushiki Kaisha Controleur pour robot mobile muni de jambes
JP2000352011A (ja) 1999-06-11 2000-12-19 Gakunan Koki Kk 視覚障害者用警告形道路ラインの施工方法
JP4660870B2 (ja) 1999-11-08 2011-03-30 ソニー株式会社 脚式移動ロボット及びその制御方法
JP3555107B2 (ja) * 1999-11-24 2004-08-18 ソニー株式会社 脚式移動ロボット及び脚式移動ロボットの動作制御方法
JP3615702B2 (ja) * 1999-11-25 2005-02-02 ソニー株式会社 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット
JP2001260063A (ja) * 2000-03-21 2001-09-25 Sony Corp 多関節型ロボット及びその動作制御方法
JP2001322079A (ja) * 2000-05-15 2001-11-20 Sony Corp 脚式移動ロボット及びその動作教示方法
JP3634238B2 (ja) 2000-05-19 2005-03-30 本田技研工業株式会社 脚式移動ロボットの床形状推定装置
KR100637057B1 (ko) * 2000-11-17 2006-10-23 혼다 기켄 고교 가부시키가이샤 레그식 이동 로봇의 보용 생성장치
JP3726032B2 (ja) 2001-04-27 2005-12-14 本田技研工業株式会社 脚式移動ロボットの目標運動生成装置
DE60236460D1 (de) * 2001-12-28 2010-07-01 Honda Motor Co Ltd Gangerzeugungsvorrichtung für beweglichen roboter mit beinen
WO2003061917A1 (fr) * 2002-01-18 2003-07-31 Honda Giken Kogyo Kabushiki Kaisha Dispositif de commande pour robot bipede
CN1305646C (zh) * 2002-02-15 2007-03-21 索尼公司 有腿的移动机器人腿部装置及该机器人的控制方法
EP1504858B1 (en) * 2002-04-26 2014-06-04 Honda Giken Kogyo Kabushiki Kaisha Control device and footstep determination device for legged mobile robot
WO2003090979A1 (fr) * 2002-04-26 2003-11-06 Honda Giken Kogyo Kabushiki Kaisha Systeme permettant d'estimer l'attitude d'un robot mobile monte sur des jambes
JP4181175B2 (ja) * 2003-06-27 2008-11-12 本田技研工業株式会社 脚式移動ロボットの制御装置
JP4513320B2 (ja) * 2003-12-17 2010-07-28 ソニー株式会社 ロボット装置、並びにロボット装置の運動制御方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013180352A1 (ko) * 2012-05-29 2013-12-05 (주)엠텍 와이어가이드 및 그를 이용한 구동장치

Also Published As

Publication number Publication date
KR100961901B1 (ko) 2010-06-10
EP1475196A1 (en) 2004-11-10
EP1475195A8 (en) 2006-03-08
KR100917181B1 (ko) 2009-09-15
EP1475192A4 (en) 2008-07-02
US7496428B2 (en) 2009-02-24
US7319917B2 (en) 2008-01-15
KR20040075335A (ko) 2004-08-27
US20050065646A1 (en) 2005-03-24
JPWO2003057424A1 (ja) 2005-05-19
EP1470900A1 (en) 2004-10-27
WO2003057422A1 (fr) 2003-07-17
KR20040075334A (ko) 2004-08-27
DE60236546D1 (de) 2010-07-08
EP1475195A4 (en) 2008-07-02
EP1475196B1 (en) 2010-03-31
DE60236460D1 (de) 2010-07-01
JP3640255B2 (ja) 2005-04-20
KR20040075332A (ko) 2004-08-27
KR20040075333A (ko) 2004-08-27
EP1470900A4 (en) 2008-07-02
US20050154492A1 (en) 2005-07-14
JPWO2003057426A1 (ja) 2005-05-19
KR100889598B1 (ko) 2009-03-20
JP3674789B2 (ja) 2005-07-20
EP1475192A1 (en) 2004-11-10
EP1466705B1 (en) 2010-05-19
EP1475197A4 (en) 2008-06-25
KR20040075336A (ko) 2004-08-27
KR100881609B1 (ko) 2009-02-04
EP1466705A4 (en) 2008-06-25
JP3672102B2 (ja) 2005-07-13
JP3672100B2 (ja) 2005-07-13
EP1475197B1 (en) 2009-12-16
EP1475192B1 (en) 2010-05-19
US20050055133A1 (en) 2005-03-10
JP3672103B2 (ja) 2005-07-13
EP1475195B1 (en) 2010-05-26
EP1475195A1 (en) 2004-11-10
WO2003057425A1 (fr) 2003-07-17
WO2003057429A1 (fr) 2003-07-17
US7487011B2 (en) 2009-02-03
US7308335B2 (en) 2007-12-11
EP1475197A1 (en) 2004-11-10
KR100917184B1 (ko) 2009-09-15
US7308336B2 (en) 2007-12-11
JP3674788B2 (ja) 2005-07-20
DE60236457D1 (de) 2010-07-01
WO2003057424A1 (fr) 2003-07-17
JPWO2003057423A1 (ja) 2005-05-19
WO2003057430A1 (fr) 2003-07-17
KR20040075339A (ko) 2004-08-27
EP1466706A1 (en) 2004-10-13
JPWO2003057429A1 (ja) 2005-05-19
EP1475196A4 (en) 2008-06-25
DE60237041D1 (de) 2010-08-26
KR100971473B1 (ko) 2010-07-22
DE60235839D1 (de) 2010-05-12
DE60234790D1 (de) 2010-01-28
WO2003057426A1 (fr) 2003-07-17
KR20040075338A (ko) 2004-08-27
EP1466706A4 (en) 2008-07-02
US20050115747A1 (en) 2005-06-02
EP1466705A1 (en) 2004-10-13
DE60237470D1 (de) 2010-10-07
US20050051368A1 (en) 2005-03-10
US7337039B2 (en) 2008-02-26
US20050240306A1 (en) 2005-10-27
WO2003057423A1 (fr) 2003-07-17
JPWO2003057422A1 (ja) 2005-05-19
EP1466706B1 (en) 2010-08-25
US7493192B2 (en) 2009-02-17
JPWO2003057430A1 (ja) 2005-05-19
US20050021176A1 (en) 2005-01-27
EP1470900B1 (en) 2010-07-14
KR100881608B1 (ko) 2009-02-04
JPWO2003057425A1 (ja) 2005-05-19

Similar Documents

Publication Publication Date Title
JP3672101B2 (ja) 脚式移動ロボットの歩容生成装置
JP3679105B2 (ja) 脚式移動ロボットの歩容生成装置
JP4246638B2 (ja) 脚式移動ロボットの制御装置
JP4199236B2 (ja) 脚式移動ロボットの歩容生成装置
JP4181175B2 (ja) 脚式移動ロボットの制御装置
US7319302B2 (en) Gate generating system for mobile robot

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20050308

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20050412

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20050413

R150 Certificate of patent or registration of utility model

Ref document number: 3672101

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080428

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090428

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090428

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100428

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110428

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110428

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120428

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130428

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130428

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140428

Year of fee payment: 9

EXPY Cancellation because of completion of term