JP2011177839A - 脚式移動ロボットの運動状態評価装置 - Google Patents

脚式移動ロボットの運動状態評価装置 Download PDF

Info

Publication number
JP2011177839A
JP2011177839A JP2010044713A JP2010044713A JP2011177839A JP 2011177839 A JP2011177839 A JP 2011177839A JP 2010044713 A JP2010044713 A JP 2010044713A JP 2010044713 A JP2010044713 A JP 2010044713A JP 2011177839 A JP2011177839 A JP 2011177839A
Authority
JP
Japan
Prior art keywords
virtual surface
force
virtual
robot
external force
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.)
Granted
Application number
JP2010044713A
Other languages
English (en)
Other versions
JP5398592B2 (ja
Inventor
Toyoo Oda
豊生 織田
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
Priority to JP2010044713A priority Critical patent/JP5398592B2/ja
Priority to US13/036,298 priority patent/US8442680B2/en
Publication of JP2011177839A publication Critical patent/JP2011177839A/ja
Application granted granted Critical
Publication of JP5398592B2 publication Critical patent/JP5398592B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

【課題】複数の接触対象面からロボットに外力が作用する状況でロボットの運動を行いながら、ロボットの運動状態を効率よく適切に評価する。
【解決手段】ロボット１の動作環境の複数の接触対象面ＦＬ，ＷＬ１，ＷＬ２を仮想面Ｓ3a，Ｓ2a，Ｓ2bで近似し、ロボット１の並進運動に係わる補償総並進外力を実現するために仮想面Ｓ3a，Ｓ2a，Ｓ2bからロボット１に作用させるべき並進力（仮想面必要並進力）を第１Ａ必要条件と第１Ｂ必要条件とを少なくとも満足するように算出する。この仮想面必要並進力に基づいて、ロボットの運動状態を評価する。
【選択図】図１１

Description

本発明は、脚式移動ロボットの運動状態を評価する装置に関する。
脚式移動ロボット（以下、単にロボットということがある）の動作制御を行なう技術としては、例えば、本願出願人が提案した特許文献１等に見られる技術が従来より知られている。この技術では、ロボットの目標運動で想定されている床形状と実際の床形状との誤差等に起因してロボットの姿勢が不安定になるのを防止するために、ロボットの動作中に、ロボットの姿勢に関する状態量（例えばロボットの上体の姿勢）が逐次観測される。さらに、その状態量の観測値と、ロボットの目標運動により規定される該状態量の目標値との偏差を“０”に近づけるためのフィードバック操作量として、ロボットに作用させる付加的床反力（目標運動を実現するための基本の床反力に付加する床反力）を決定する。そして、ロボットの実際の運動とロボットに実際に作用する床反力とを、それぞれロボットの目標運動と、上記付加的床反力を付加した目標床反力とに追従させるように制御することで、ロボットの運動が円滑に行われるようにしている。
特許第４２４６６３８号公報
ロボットに種々様々な作業を行なわせるためには、ロボットを単に床上で移動させるだけでなく、ロボットの外界に存する複数の接触対象面にロボットの複数の部位を接触させながら（例えば、ロボットの脚の先端部と腕の先端部とをそれぞれ床面と壁面とに接触させながら）、ロボットの所要の運動を行なわせることが要求される場合もある。
このような場合には、ロボットを単に床上で移動させる場合と異なり、ロボットの外界の複数の接触対象面からロボットの複数の部位に外力が作用することとなる。
従って、このような場合には、ロボットを適切に動作させるために、複数の接触対象面のそれぞれから作用させるべき外力に関する目標（目標外力や、その外力の作用点の目標位置）を適切に設定し、ロボットの実際の運動を目標運動に追従させつつ、ロボットに複数の接触対象面からそれぞれ作用する外力を目標とする外力に追従させるように、ロボットの動作制御を行なう必要がある。そして、この場合、外力に関する目標は、ロボットの所要の運動状態量の実際の値（観測値）が目標値からずれるのを抑制するように調整しつつ設定することが望ましい。
ところが、上記のように複数の接触対象面からそれぞれロボットの外力が作用する場合には、ロボットに作用する外力が床反力だけである場合と異なり、ロボットの所要の運動状態量の実際の値（観測値）が目標値からずれた場合に、そのずれを低減すれために、複数の接触対象面のそれぞれからロボットに作用する外力をどのような外力に調整すべきかが問題となる。
そして、この場合、ロボットに実際に作用させる外力を、本来の目標運動（上記運動状態量が目標値に一致することを前提とする運動）を実現するためにロボットに作用させるべき外力に、上記運動状態量のずれを低減するための付加的な外力を付加することとなるため、その付加的な外力を、ロボットの円滑な運動を損なうことなくロボットに付加することができるか等のロボットの運動状態の評価を行なうことが必要となる場合が多々ある。
しかるに、従来は、上記の如く複数の接触対象面からロボットに外力が作用する状況でロボットの運動を行ないながら、ロボットに作用させるべき外力を、ロボットの所定の運動状態量に応じて操作する技術の検討が十分になされていないのが実状である。ひいては、このような外力操作を行なう場合に、ロボットの円滑な運動を損なうことなく外力を操作し得るかどうか等を適切に評価し得る技術の検討も十分になされていないのが実状である。
本発明はかかる背景に鑑みてなされたものであり、複数の接触対象面からロボットに外力が作用する状況でのロボットの運動中に、該ロボットの所定の運動状態量に応じてロボットに作用させべき外力を操作する場合に、その操作による影響を考慮しつつ、該ロボットの運動状態を効率よく適切に評価することできる運動状態評価装置を提供することを目的とする。
本発明の脚式移動ロボットの運動状態評価装置は、上記の目的を達成するために、脚式移動ロボットの動作環境に存する互いに異なる複数の接触対象面に該ロボットの複数の部位を接触させながら、該ロボットの運動を行なわせるための該ロボットの目標運動に該ロボットの実際の運動を追従させるように該ロボットの動作制御を行っている状態での該ロボットの運動状態を評価する運動状態評価装置であって、
相互の姿勢関係があらかじめ定められた複数の仮想面から成る仮想面群を用い、該仮想面群の複数の仮想面が前記複数の接触対象面に一致又は近似する面になるように、該仮想面群を前記ロボットの動作環境の空間に仮想的に設定する仮想面群設定手段と、
前記目標運動に基づいて、該目標運動を実現するために前記ロボットに作用させるべきトータルの外力のうちの並進力成分である基本必要総並進外力を決定する基本必要総並進外力決定手段と、
前記ロボットの所定の運動状態量の観測値と、前記目標運動における該運動状態量の目標値との偏差である運動状態量偏差を逐次算出し、該運動状態量偏差に基づいて、該運動状態量偏差を“０”に近づけるために前記ロボットに付加的に作用させるべき並進力である並進外力補償量を決定する並進外力補償量決定手段と、
前記決定された基本必要総並進外力に前記決定された並進外力補償量を付加してなる補償総並進外力を実現するために前記仮想面群の複数の仮想面のそれぞれから前記ロボットに作用させるべき並進力である仮想面必要並進力を算出する手段であり、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に垂直な成分である仮想面垂直抗力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分を除く成分に一致するという第１Ａ必要条件と、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に平行な成分である仮想面摩擦力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分に一致するという第１Ｂ必要条件と少なくとも満足するように、各仮想面における仮想面必要並進力を算出する仮想面必要並進力算出手段と、
少なくとも前記算出された仮想面必要並進力に基づいて、前記ロボットの運動状態を評価する運動状態評価手段とを備えたことを特徴とする（第１発明）。
なお、本発明（後述の第２〜第５発明を含む）において、前記ロボットの動作環境に存する互いに異なる複数の接触対象面というのは、その複数の接触対象面に含まれる任意の２つの接触対象面（又はその２つの接触対象面をそれぞれ包含する平面）が互いに交差するか、又は、互いに間隔を存して平行もしくはほぼ平行に対向するような複数の接触対象面を意味する。この場合、各接触対象面は、それに接触させるロボットの部位に比して広い面積を有する面（例えば、通常の床面の如き面）である必要はなく、例えば、該部位と同程度又はそれよりも小さい面積を有する局所的な面であってもよい。
また、前記目標運動において、各接触対象面に接触させるロボットの部位は、１つの部位である必要はなく、２つ以上の部位であってもよい。この場合において、ある接触対象面に接触させるロボットの部位が２つ以上である場合には、該接触対象面からロボットに作用させるべき前記目標外力は、該接触対象面からロボットの当該２つ以上の部位のそれぞれに作用させる外力の合力の目標値を意味する。
前記第１発明によれば、ロボットの運動状態の評価を行なうために、相互の姿勢関係があらかじめ定められた複数の仮想面から成る仮想面群が、前記複数の接触対象面の代用的な面として使用される。そして、この仮想面群は、前記仮想面群決定手段によって、該仮想面群の複数の仮想面が前記複数の接触対象面に一致又は近似する面になるように、前記ロボットの動作環境の空間に仮想的に設定される。
なお、前記仮想面群設定手段の処理において、前記仮想面群をロボットの動作環境の空間に仮想的に設定するということは、該仮想面群を構成する各仮想面の、当該空間での配置を決定すること、より詳しくは、当該空間での各仮想面の位置と姿勢（空間的な向き）とを決定することを意味する。
また、前記目標運動を実現するために前記ロボットに作用させるべきトータルの外力のうちの並進力成分である基本必要総並進外力が前記基本必要総並進外力決定手段によって決定される。
ここで、前記基本必要総並進外力は、換言すれば、前記目標運動によって発生するロボット全体の並進慣性力（慣性力の並進力成分）と、該ロボット全体に作用する重力との合力に釣り合う並進力である。この場合、ロボットの目標運動によって、ロボットの各部（各リンク）の運動とロボットの全体重心点の運動とが規定されることとなるので、ロボットの適当な幾何学モデル（剛体リンクモデル）を用いることで、ロボット全体の上記並進慣性力を前記目標運動に基づいて決定できる。また、ロボット全体に作用する重力は、ロボットの全体質量と重力加速度との積である。従って、前記目標運動に基づいて、前記基本必要総並進外力を決定できる。
なお、本発明では、前記目標運動は、例えば、ロボットに要求される運動形態（ロボットの脚リンクの先端部等の動かし方や、接触対象面への接触のさせ方等）に即して生成すればよい。
また、第１発明では、前記並進外力補償量決定手段によって、前記運動状態量偏差（所定の運動状態量の観測値と目標値との偏差）を“０”に近づけるために前記ロボットに付加的に作用させるべき並進力である並進外力補償量が、前記運動状態量偏差に基づいて決定される。
ここで、上記運動状態量は、ロボットに作用させる並進力によって操作可能な種類の運動状態量である。このような運動状態量としては、例えば、ロボットの運動の安定性を確保する上で、所要の目標値に極力、制御することが望ましいと考えられる状態量（例えば、ロボットの全体重心点の位置等）を採用することができる。該運動状態量は、基本的には、目標運動で実現しようとするロボットの動作形態や、その動作形態におけるロボットの全体の姿勢、又は特定部位の姿勢の安定性等を考慮して、適宜選定しておけばよい。
また、前記並進外力補償は、例えば、前記運動状態量偏差から適宜のフィードバック制御則により決定することができる。
そして、第１発明では、前記決定された基本必要総並進外力に前記決定された並進外力補償量を付加してなる補償総並進外力を実現するために前記仮想面群の複数の仮想面のそれぞれから前記ロボットに作用させるべき並進力である仮想面必要並進力が前記仮想面必要並進力決定手段によって決定される。なお、各仮想面は、各接触対象面に対応しているので、各仮想面における仮想面必要並進力は、該仮想面に対応する接触対象面からロボットに作用させるべき並進力に対応するものである。
ここで、該仮想面必要並進力決定手段が算出する、各仮想面における仮想面必要並進力は、換言すれば、それらの合力が、前記補償総並進外力に一致するような並進力を意味する。そして、各仮想面における仮想面必要並進力は、該仮想面に垂直な成分である前記仮想面垂直抗力成分と該仮想面に平行な成分である前記仮想面摩擦力成分との一方又は両方から構成される。
この場合、本発明では、前記複数の接触対象面からロボットに外力を作用させることに対応して、前記仮想面群の複数の仮想面からロボットに外力を作用させることとなるので、前記補償総並進外力を実現するための各仮想面における仮想面必要並進力の組合せは、一般には、無数の態様を採り得る。
但し、各仮想面に対応する接触対象面からロボットに作用させ得る並進力のうちの摩擦力成分（接触対象面に平行な成分）が過大になり、該接触対象面で発生可能な摩擦力の上限値に近づくと、該接触対象面とロボットとの間の滑りが発生し易くなる。このため、前記目標運動は、各接触対象面からロボットに作用すべき摩擦力をできるだけ小さくできるように生成されていることが望ましい。
従って、各接触対象面に対応する仮想面における仮想面必要並進力は、できるだけ、仮想面摩擦力成分を含まないか、もしくは、該仮想面摩擦力成分の大きさを小さくすることを指針として、算出されることが望ましいと考えられる。換言すれば、補償総並進外力が、できるだけ、各仮想面における仮想面垂直抗力成分の合力によって実現され得ることを指針として、仮想面必要並進力を算出することが望ましいと考えられる。
そこで、第１発明では、前記仮想面必要並進力算出手段は、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に垂直な成分である仮想面垂直抗力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分を除く成分に一致するという第１Ａ必要条件と、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に平行な成分である仮想面摩擦力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分に一致するという第１Ｂ必要条件と少なくとも満足するように、各仮想面における仮想面必要並進力を算出する。
これにより、前記仮想面必要並進力算出手段は、可能な限り、各仮想面における仮想面垂直抗力成分の合力によって前記補償総並進外力を実現すると共に、仮想面摩擦力成分をできるだけ小さくするように、各仮想面における仮想面必要並進力を算出することとなる。
一例を例示すると、前記複数の接触対象面が、例えば互いに交差する３つの接触対象面である場合、ひいては、これらの接触対象面に対応する３つの仮想面が互いに交差する仮想面である場合には、前記仮想面必要並進力算出手段により算出される各仮想面必要並進力は、仮想面垂直抗力成分のみにより構成され、仮想面摩擦力成分はいずれの仮想面についても“０”となる。
そして、第１発明では、前記運動状態評価手段は、上記の如く算出された仮想面必要並進力に基づいて、前記ロボットの運動状態を評価する。すなわち、該運動状態の評価は、前記第１Ａ必要条件及び第２Ａ必要条件を少なくとも満足することを指針として算出された、各仮想面における仮想面必要並進力に基づいて行なわれる。これにより、前記ロボットの運動状態が、前記補償総並進外力を実現するために、各接触対象面でロボットに作用する摩擦力をできるだけ小さくできる運動状態（換言すれば、各接触対象面での滑りを発生することなくロボットの円滑な運動を行い得る運動状態）であるか否かを評価することが可能となる。
すなわち、ロボットの円滑な運動を損なうことなく、前記並進外力補償量によってロボットに作用させる外力を適切に操作することが可能であるか否かを評価することが可能となる。
また、前記仮想面必要並進力算出手段の処理は、相互の姿勢関係があらかじめ定まっている複数の仮想面群を使用する処理であると共に、並進力に関する前記第１Ａ必要条件と第１Ｂ必要条件とを少なくとも満足するという比較的単純な指針に基づいて各仮想面における仮想面必要並進力を算出する処理である。
このため、前記仮想面必要並進力算出手段の処理は、さほど複雑な処理を必要せずに行なうことができる。
よって、第１発明によれば、数の接触対象面からロボットに外力が作用する状況でのロボットの運動中に、該ロボットの所定の運動状態量に応じてロボットに作用させべき外力を操作する場合に、その操作による影響を考慮しつつ、該ロボットの運動状態を効率よく適切に評価することできる。
前記第１発明では、より具体的には、例えば次のような態様を採用することが好ましい。すなわち、前記運動状態評価手段は、各仮想面における仮想面必要並進力のうちの仮想面摩擦力成分の大きさが、少なくとも該仮想面における仮想面垂直抗力成分に応じて設定した第１所定値以下になるという第２必要条件を、前記算出された仮想面必要並進力が満足するか否かを判断する第１判断手段を備え、少なくとも、該第１判断手段の判断結果が否定的となり、且つ、該第１Ａ必要条件及び第１Ｂ必要条件と、前記第２必要条件とを満足させ得るように前記算出された仮想面必要並進力を修正することができない場合に、前記ロボットの運動状態が不適切であると評価することが好ましい（第２発明）。
ここで、前記補償総並進外力を実現するために、各仮想面に対応する接触対象面からロボットに摩擦力を作用させる必要が生じる場合もあるが、その摩擦力の大きさは、該各接触対象面で発生可能な摩擦力の上限値以下に留める必要がある。そして、この上限値は、該接触対象面における垂直抗力成分の影響を受け、該垂直抗力成分の大きさが小さいほど、該上限値も小さくなる。
そこで、第２発明では、前記算出された仮想面必要並進力が前記第２必要条件を満足するか否かを前記第１判断手段により判断する。
この第１判断手段の判断結果が否定的となる場合に、その判断結果が否定的となる仮想面において、第１Ａ必要条件及び第１Ｂ必要条件と、前記第２必要条件とを満足させ得るように前記算出された仮想面必要並進力を修正することができない場合には、前記補償総並進外力を適切に実現するために、第１判断手段の判断結果が否定的となる仮想面に対応する接触対象面に、過大な摩擦力を発生させる必要があり、該接触対象面におけるロボットの滑りを生じる恐れがあると考えられる。
そこで、第２発明では、少なくとも、前記第１判断手段の判断結果が否定的となり、且つ、該第１Ａ必要条件及び第１Ｂ必要条件と、前記第２必要条件とを満足させ得るように前記算出された仮想面必要並進力を修正することができない場合に、前記ロボットの運動状態が不適切であると評価する。
これにより、いずれかの接触対象面でのロボットの滑りが生じる恐れのある場合のロボットの運動状態が不適切なものとして評価されることとなる。そして、その評価結果を利用して、ロボットの目標運動を修正したり、あるいは、ロボットの運動を停止させる等の処置を採ることが可能となる。
なお、前記第２必要条件における第１所定値は、仮想面で発生可能な摩擦力の大きさの上限値に相当するものである。この第１所定値は、例えば、各仮想面に対応する接触対象面における垂直抗力成分を該仮想面における仮想面垂直抗力成分に一致させた場合に該接触対象面で発生可能な摩擦力の大きさの上限値に一致するか、またはそれよりも小さめの値に設定することが好ましい。
前記第２発明において、前記仮想面群が、前記第１判断手段の判断結果が否定的となる仮想面に対して、該仮想面と間隔を存して対向する仮想面を含む場合、すなわち、前記複数の接触対象面が互いに間隔を存して対向する２つの接触対象面を含み、且つ、その２つの接触対象面のいずれかに対応する仮想面において、前記第１判断手段の判断結果が否定的となる場合には、互いに対向する２つの仮想面における互いに逆向きの仮想面垂直抗力成分の大きさを同じ量だけ増加させることによって、前記第１Ａ必要条件を満足しつつ、それらの仮想面における仮想面垂直抗力成分の大きさを増加させることが可能である。ひいては、それらの仮想面における仮想面摩擦力成分の大きさの上限値を増加させることが可能である。
一方、前記第１判断手段の判断結果が否定的となる仮想面に対向する仮想面が存在しない場合には、該仮想面における仮想面垂直抗力成分の大きさを前記第１Ａ必要条件を満足しつつ増加させることはできない。ひいては、前記第１Ａ必要条件及び第１Ｂ必要条件を満足しつつ、第２必要条件を満足し得るように、第１判断手段の判断結果が否定的となった仮想面における仮想面必要並進力を修正することはできないこととなる。
そこで、前記第２発明では、前記運動状態評価手段は、前記第１判断手段の判断結果が否定的となった場合において、該判断結果が否定的となった仮想面が、前記仮想面群のうちの互いに間隔を存して対向する２つの仮想面である対向仮想面に属する仮想面であるか否かを判断する第２判断手段を備え、前記第１判断手段の判断結果と前記第２判断手段の判断結果とがいずれも否定的となる場合に、前記ロボットの運動状態が不適切であると判断することが好ましい（第３発明）。
この第３発明によれば、前記第１判断手段の判断結果と前記第２判断手段の判断結果とがいずれも否定的となる場合は、上記の如く、前記第１Ａ必要条件及び第１Ｂ必要条件を満足しつつ、第２必要条件を満足し得るように、第１判断手段の判断結果が否定的となった仮想面における仮想面必要並進力を修正することはできない場合である。そして、この場合に、前記ロボットの運動状態が不適切であると判断されることとなる。
これにより、ロボットの運動状態が、前記第１Ａ必要条件及び第１Ｂ必要条件と、第２必要条件とを満足し得る仮想面必要並進力を設定し得る運動状態であるか否を適正に判断しつつ、該運動状態の評価を行なうことができる。その結果、ロボットの運動状態の評価の信頼性を高めることができる。
前記第３発明において、２つの対向仮想面における仮想面垂直抗力成分のうち、大きさが小さい方の仮想面垂直抗力成分を第１仮想面垂直抗力成分、大きい方の仮想面垂直抗力成分を第２仮想面垂直抗力成分としたとき、第１仮想面垂直抗力成分と、第２仮想面垂直抗力成分のうちの第１仮想面垂直抗力成分と大きさの等しい成分とは、ロボットの運動に寄与しない内力として機能するものとなる。そして、この内力の大きさが過大になると、ロボットのアクチュエータが発生可能な動力のうち、上記内力の発生のために必要な負担分が大きくなり、ロボットの運動を変化させるために利用し得るアクチュエータの動力が不足し易いものとなる。
そこで、第３発明においては、前記運動状態評価手段は、前記第２判断手段の判断結果が肯定的となった場合において、前記第１判断手段の判断結果が否定的となった仮想面を含む２つの対向仮想面における前記算出された仮想面必要並進力のうちの仮想面垂直抗力成分を、前記２つの対向仮想面のそれぞれにおける仮想面垂直抗力成分のうち、小さい方の垂直抗力成分の大きさがあらかじめ設定された第２所定値以下であるという第３必要条件と、前記第１Ａ必要条件及び第２必要条件とを満足させ得るように修正することができるか否かを判断する第３判断手段を備え、前記第１判断手段の判断結果と前記対向仮想面判断手段の判断結果と前記第３判断手段の判断結果とがそれぞれ、否定的、肯定的、否定的となる場合に、前記ロボットの運動状態が不適切であると判断することが好ましい（第４発明）。
この第４発明によれば、前記第１判断手段の判断結果と前記対向仮想面判断手段の判断結果と前記第３判断手段の判断結果とがそれぞれ、否定的、肯定的、否定的となる場合に、前記ロボットの運動状態が不適切であると判断するので、前記第１Ａ必要条件、第１Ｂ必要条件及び第２必要条件を満足し得る仮想面必要並進力を設定するために前記内力の大きさが過大なものとならざるを得ない場合に、ロボットの運動状態を不適切なものであると評価することができる。
また、本発明の脚式移動ロボットの運動状態評価装置では、前記複数の接触対象面が互いに間隔を存して対向する２つの接触対象面を含む場合に、次のような形態を採用することもできる。すなわち、本発明は、脚式移動ロボットの動作環境に存する互いに異なる複数の接触対象面に該ロボットの複数の部位を接触させながら、該ロボットの運動を行なわせるための該ロボットの目標運動に該ロボットの実際の運動を追従させるように該ロボットの動作制御を行っている状態での該ロボットの運動状態を評価する運動状態評価装置であって、
相互の姿勢関係があらかじめ定められた複数の仮想面から成る仮想面群を用い、該仮想面群の複数の仮想面が前記複数の接触対象面に一致又は近似する面になるように、該仮想面群を前記ロボットの動作環境の空間に仮想的に設定する仮想面群設定手段と、
前記目標運動に基づいて、該目標運動を実現するために前記ロボットに作用させるべきトータルの外力のうちの並進力成分である基本必要総並進外力を決定する基本必要総並進外力決定手段と、
前記ロボットの所定の運動状態量の観測値と、前記目標運動における該運動状態量の目標値との偏差である運動状態量偏差を逐次算出し、該運動状態量偏差に基づいて、該運動状態量偏差を“０”に近づけるために前記ロボットに付加的に作用させるべき並進力である並進外力補償量を決定する並進外力補償量決定手段と、
前記決定された基本必要総並進外力に前記決定された並進外力補償量を付加してなる補償総並進外力を実現するために前記仮想面群の複数の仮想面のそれぞれから前記ロボットに作用させるべき並進力である仮想面必要並進力を算出する手段であり、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に垂直な成分である仮想面垂直抗力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分を除く成分に一致するという第１Ａ必要条件と、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に平行な成分である仮想面摩擦力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分に一致するという第１Ｂ必要条件と、各仮想面における仮想面必要並進力のうちの仮想面摩擦力成分の大きさが、少なくとも該仮想面における仮想面垂直抗力成分に応じて設定した第１所定値以下になるという第２必要条件とを少なくとも満足するように、各仮想面における仮想面必要並進力を算出する仮想面必要並進力算出手段と、
少なくとも前記算出された仮想面必要並進力に基づいて、前記ロボットの運動状態を評価する運動状態評価手段とを備え、
前記運動状態評価手段は、前記仮想面群のうち、互いに間隔を存して対向する前記２つの接触対象面に対応する２つの仮想面である対向仮想面のそれぞれにおける仮想面垂直抗力成分のうち、小さい方の垂直抗力成分の大きさがあらかじめ設定された第２所定値以下であるという第３必要条件を、前記対向仮想面に関して前記算出された仮想面必要並進力が満足するか否かを判断する第４判断手段を備え、
該第４判断手段の判断結果が否定的となり、且つ、前記第１Ａ必要条件と、前記第３必要条件とを満足させ得るように、前記対向仮想面に関して前記算出された仮想面必要並進力のうちの仮想面垂直抗力成分を修正することができない場合に、前記ロボットの運動状態が不適切であると評価することを特徴とする（第５発明）。
この第５発明では、前記仮想面群設定手段、基本必要総並進外力決定手段、及び並進外力補償量決定手段の処理は、第１発明と同じである。ただし、第５発明では、前記複数の接触対象面が、互いに間隔を存して対向する２つの接触対象面を含むので、前記仮想面群も、互いに間隔を存して対向する２つの対向仮想面を、前記２つの接触対象面に対応する仮想面として含むこととなる。
そして、第５発明では、前記仮想面必要並進力算出手段は、前記第１Ａ必要条件及び第１Ｂ必要条件に加えて、前記第２必要条件をも満足するように各仮想面における仮想面必要並進力を算出する。これにより、前記仮想面必要並進力算出手段は、可能な限り、各仮想面における仮想面垂直抗力成分の合力によって前記補償総並進外力を実現すると共に、仮想面摩擦力成分の大きさが前記第２必要条件を満足するように（第１所定値以下に収まるように）、各仮想面における仮想面必要並進力を算出することとなる。
この場合、第５発明では、前記仮想面群に２つの対向仮想面が含まれるので、前記補償総並進外力が、全ての仮想面に平行な成分を含む場合に、前記第２必要条件を満足するために、前記２つの対向仮想面間に前記内力を発生させるようにこれらの対向仮想面における仮想面必要並進力が算出される場合がある。
そこで、第５発明では、前記運動状態評価手段は、前記第４判断手段の判断処理、すなわち、前記第４発明における第３判断手段と同じ判断処理を実行する。そして、該運動状態評価手段は、第４判断手段の判断結果が否定的となり、且つ、前記第１Ａ必要条件と、前記第３必要条件とを満足させ得るように、前記対向仮想面に関して前記算出された仮想面必要並進力のうちの仮想面垂直抗力成分を修正することができない場合に、前記ロボットの運動状態が不適切であると評価する。
これにより、第５発明によれば、前記第４発明と同様に、前記第１Ａ必要条件、第１Ｂ必要条件及び第２必要条件を満足し得る仮想面必要並進力を設定するために前記内力の大きさが過大なものとならざるを得ない場合に、ロボットの運動状態を不適切なものであると評価することができる。
補足すると、以上説明した第１〜第５発明において、前記目標運動を実現するために前記ロボットに作用させるべきトータルの外力のうちの前記仮想面群に対して固定された所定の基準点周りでのモーメント成分である基本必要総モーメント外力を決定する基本必要総モーメント外力決定手段を備えると共に、ロボットの所定の第２運動状態量の観測値と、前記目標運動における該第２運動状態量の目標値との偏差である第２運動状態量偏差を逐次算出し、該第２運動状態量偏差に基づいて、該第２運動状態量偏差を“０”に近づけるために前記ロボットに付加的に作用させるべき前記基準点周りのモーメントであるモーメント外力補償量を決定するモーメント外力補償量決定手段を備えるようにしてもよい。なお、この場合、第２運動状態量は、前記並進外力補償量に関する運動状態量と異なる種類のものでもよいが、同一の種類のものであってもよい。
そして、仮想面必要並進力算出手段の処理では、前記第１Ａ必要条件及び第１Ｂ必要条件を満足しつつ、前記必要総モーメント外力に前記モーメント外力補償量を付加してなる補償総モーメント外力をも実現し得るように、各仮想面における仮想面必要並進力を算出してもよい。例えば、前記仮想面必要並進力算出手段の処理で算出する各仮想面における仮想面必要並進力を、各接触対象面からロボットへの外力の作用点に対応する仮想面上の点として、各仮想面上に設定された外力作用点に作用させた場合に、前記所定の基準点周りに発生するトータルのモーメントが前記補償総モーメント外力に一致するという条件を回転運動条件を加味し、前記第１Ａ必要条件及び第１Ｂ必要条件と、この回転運動条件とを満足するように、各仮想面における仮想面必要並進力を算出するようにしてもよい。
本発明の実施形態における脚式移動ロボットの機構的な外力構成を示す図。 図１のロボットに備えた制御ユニットの機能とセンサ群とを示すブロック図。 図３（ａ）〜（ｃ）は、図１のロボットの目標歩容の一例としての壁登り歩容におけるロボットの瞬時的な動作状態を時系列的に示す図。 図４（ａ），（ｂ）は、図３（ａ）〜（ｃ）の動作状態の後におけるロボットの瞬時的な動作状態を時系列的に示す図。 図５（ａ）〜（ｃ）は壁登り歩容における外力作用点の設定位置の経時的変化の例を示すグラフ。 壁登り歩容における外力作用点の存在許容領域の面積の経時的変化の例を示すグラフ。 図２に示す外力目標生成部の、第１実施形態における処理を示すフローチャート。 図２に示す外力目標生成部の、第１実施形態における処理を示すフローチャート。 図２に示す外力目標生成部の第１実施形態における処理を示すフローチャート。 図７のＳ０１で設定する仮想面を説明するための図。 図１１（ａ）は図７のＳ０５の処理により決定される仮想面必要並進力（仮想面垂直抗力成分及び仮想面摩擦力成分）の例を示す図、図１１（ｂ）は図７のＳ１３までの処理により決定される仮想面必要並進力（仮想面垂直抗力成分及び仮想面摩擦力成分）の例を示す図。 図８のＳ１９の処理を説明するための図。 図８のＳ２５の処理を説明するための図。 図２に示す外力目標生成部の、第２実施形態における処理を示すフローチャート。 図２に示す外力目標生成部の、第２実施形態における処理を示すフローチャート。 図２に示す外力目標生成部の、第３実施形態における処理を示すフローチャート。 図２に示す外力目標生成部の、第４実施形態における処理を示すフローチャート。 図２に示す外力目標生成部の、第４実施形態における処理を示すフローチャート。 図１９（ａ）〜（ｅ）は図１のロボットの目標運動の他の例におけるロボットの瞬時的な動作状態を時系列的に示す図。 図２０（ａ）〜（ｄ）は図１のロボットの目標運動の他の例におけるロボットの瞬時的な動作状態を時系列的に示す図。
［第１実施形態］
本発明の第１実施形態を図１〜図１３を参照して以下に説明する。
まず、図１を参照して、本実施形態における脚式移動ロボット１（以降、単にロボット１という）の機構的な概略構成を説明する。
このロボット１は、基体３と、この基体３から延設された複数のリンク機構５とを有する。各リンク機構５は、ロボット１の脚として機能し得る機構である。そして、リンク機構５の個数は、本実施形態の例では４つである。
なお、本実施形態の説明において、リンク機構５がロボット１の脚として機能し得るということは、該リンク機構５の先端部を、ロボット１の外界（動作環境）の床あるいは壁等の接触対象面に接触させた場合に、該リンク機構５が、ロボット１の自重（より正確には、ロボット１に作用する重力とロボット１の運動によって発生する慣性力との合力）の全部又は一部を支える外力を接触対象面から受けることができることを意味する。
各リンク機構５は、複数の要素リンク７と、これらの要素リンク７を基体３側から順番に連接する複数の関節９とから構成されている。この場合、各リンク機構５の先端部を構成する要素リンク７（以降、これを先端部リンク７ａ、又は単にリンク機構５の先端部という）が、該リンク機構５を脚として機能させる場合に、ロボット１の外界の床あるいは壁等の接触対象面に接触させる部分である。そして、各先端部リンク７ａは、板状に形成されており、その表面（外界との接触面）には図示を省略するゴム材等の弾性樹脂材が装着されている。
各リンク機構５の各関節９は、例えば公知の構造の回転型の関節であり、それぞれ、１つ又は複数の自由度を有する。この場合、各リンク機構５に含まれる全ての関節９のトータルの自由度数が“６”以上の自由度数となるように、各リンク機構５毎の各関節９の自由度数が設定されている。このため、基体３に対する各先端部リンク７ａの空間的な位置と姿勢（空間的な向き）とは、それぞれ３自由度を有する。なお、各リンク機構５には、回転型の関節の他に、直動型の関節が含まれていてもよい。
また、図１では図示を省略するが、ロボット１には、各関節９をそれぞれ駆動する電動モータ等の複数の関節アクチュエータ１１（図２に示す）が搭載されている。そして、各リンク機構５の各関節９は、それに対応する関節アクチュエータ１１から、図示しない減速機等を含む動力伝達機構を介して駆動力が伝達されるようになっている。
以上が本実施形態におけるロボット１の機構的な概略構成である。
補足すると、図１に例示するロボット１では、各リンク機構５の要素リンク７のサイズや個数、関節９の個数、トータルの自由度数等を含めた各リンク機構５の構造が、全てのリンク機構５で同じであるように記載されているが、それらの構造は、全てのリンク機構５で同じである必要はない。
また、図１では、ロボット１が、２つのリンク機構５ａ，５ｂを脚として機能させて平地を移動させる２脚移動ロボット（人型ロボットに類似するロボット）であるように記載されているが、例えば全てのリンク機構５を脚として機能させて平地を移動させるようなロボット（例えば４脚ロボット）であってもよい。
また、リンク機構５の個数は、４個である必要ななく、例えば、３個もしくは５個以上であってもよい。
次に、図２を参照して、以上の如く構成されたロボット１には、ロボット１の動作制御に利用されるセンサ群１３と、ＣＰＵ、ＲＡＭ、ＲＯＭ、関節アクチュエータ１１の駆動回路等を含む電子回路ユニットにより構成された制御ユニット２１とが搭載されている。
センサ群１３は、本実施形態の例では、ロボット１の代表リンク（代表部位）としての基体３の空間的な姿勢を計測するための姿勢センサ１５と、各リンク機構５の先端部に作用する外力を計測するための力センサ１７と、各関節９の変位量（本実施形態では回転角）を計測するための関節変位センサ１９とを備える。
この場合、姿勢センサ１５は、例えばジャイロセンサ等の角速度センサ（レートセンサ）と加速度センサとから構成され、図１に示す如く基体３に搭載されている。また、力センサ１７は、例えば３軸方向の並進力及び３軸周りのモーメントを検出可能な６軸力センサにより構成され、図１に示す如く、各リンク機構５の最も先端側の関節９と先端部リンク７ａとの間に介装されている。また、関節変位センサ１９は、例えば各関節９に装着されたエンコーダやポテンショメータ等により構成される。
制御ユニット２１は、ロボット１の適所、例えば基体３に搭載されている。この制御ユニット２１は、実装されるプログラム等により実現される主要な機能として、ロボット１の目標運動を逐次生成して出力する目標運動生成部２５と、この目標運動とセンサ群１３の出力とを用いて、ロボット１に外界から作用させる外力に関する目標を逐次生成する外力目標生成部２７と、上記目標運動と外力に関する目標とに応じてロボット１の動作制御（関節アクチュエータ１１の駆動制御）を行なう動作制御部２９とを備える。
目標運動生成部２５及び外力目標生成部２７の処理の詳細は後述するが、目標運動生成部２５が生成する目標運動（瞬時値）は、各関節９の目標変位量と、ロボット１の代表リンク（本実施形態では基体３）のグローバル座標系での目標位置及び目標姿勢とから構成される。なお、代表リンク（基体３）の目標位置は、より詳しくは、該代表リンクに設定された代表点の目標位置である。また、グローバル座標系は、ロボット１の外界に対して固定される座標系である。
また、外力目標生成部２７が生成する、外力に関する目標（瞬時値）は、１つ以上のリンク機構５の先端部リンク７ａを外界の接触対象面に接触させる場合に該接触対象面からロボット１に作用させるべき外力の目標値（目標外力）と、その外力の作用点の目標位置としての目標外力作用点とから構成される。この場合、目標外力は、本実施形態では、該外力のうちの並進力成分である並進外力の目標値（目標並進力）と、該外力のうち、外界の接触対象面に垂直な方向の軸周りでのねじり力（モーメント外力）の目標値（目標ねじり力）とから構成される。
なお、接触対象面からロボット１に作用させるべき外力の作用点というのは、その接触対象面からロボットに作用する外力の全体によって、該作用点の周りに発生するモーメントのうち、該接触対象面に平行な軸周りの成分が“０”となるような点を意味する。その作用点は、ロボット１を単に床上で移動させる場合には、所謂、床反力中心点に相当する点である。このことは、後述する仮想面上の外力作用点についても同様である。
補足すると、本実施形態では、前記目標運動生成部２５においては、目標運動を生成する処理に加えて、前記目標外力作用点の存在許容領域と暫定的な目標外力作用点である暫定外力作用点とを設定する処理も実行される。
また、ロボット１のあるリンク機構５のトータルの自由度数が６自由度である場合には、基体３に対する該リンク機構５の先端部リンク７ａの位置及び姿勢を指定すれば、該リンク機構５の各関節９の変位量が一義的に決定されることとなる。従って、６自由度のリンク機構５については、該リンク機構５の各関節９の目標変位量の代わりに、該リンク機構５の先端部リンク７ａの目標位置及び目標姿勢を、前記目標運動の構成要素として用いてもよい。
さらに、必要に応じて、ロボット１の所定の運動状態量の目標値、例えば、ロボット１の全体重心点の位置、速度、加速度の目標値、あるいは、ロボット１の基体３以外の特定の部位の位置、姿勢の目標値を、目標運動生成部２５で生成する目標運動の構成要素に含めるようにしてもよい。
また、本実施形態では、外力目標生成部２７は、目標運動生成部２５が生成した目標運動を評価する機能をも有する。そして、外力目標生成部２７は、生成された目標運動が適切である場合に、目標外力と目標外力作用点とを決定する処理を逐次実行し、該目標運動が不適切であると評価されるときには、目標外力と目標外力作用点とを決定する処理を中止する。
動作制御部２９は、目標運動生成部２５が生成した目標運動と外力目標生成部２７が生成した目標外力にロボット１の実際の動作を追従させるようにロボット１の各関節９をそれに対応する関節アクチュエータ１１を介して制御する。この制御は例えば、公知のコンプラインアンス制御により行わる。
次に、前記目標運動生成部２５及び外力目標生成部２７の処理を詳細に説明する。なお、以降の説明では、４つのリンク機構５を区別する場合には、図１に示す如く参照符号５ａ，５ｂ，５ｃ，５ｄを付する。
本実施形態における制御ユニット２１は、は、種々様々な動作環境でロボット１の動作制御を行うことができる。
ただし、本実施形態における制御ユニット２１の制御処理、特に、外力目標生成部２７の処理は、ロボット１の目標運動が、ロボット１の外界（動作環境）に存する互いに異なる複数の接触対象面にロボット１の複数の部位を接触させながら、ロボット１の運動を行なわせるような目標運動である場合に特徴を有する。
そこで、以降の説明では、本実施形態の理解の便宜上、複数の接触対象面にロボット１の複数のリンク機構５の先端部リンク７ａを接触させながら、ロボット１の運動を行なわせるための一例の目標運動を参考的に提示する。そして、その一例の目標運動に係わる処理の説明を適宜行いつつ、目標運動生成部２５及び外力目標生成部２７の処理を説明する。
以降の本実施形態の説明で参考的に例示する目標運動に係わるロボット１の動作環境は、ロボット１の外界に存する互いに異なる接触対象面として、例えば図１に示すように、床面ＦＬと、この床面ＦＬからほぼ垂直に起立する２つの壁面ＷＬ１，ＷＬ２とを備える動作環境である。この場合、２つの壁面ＷＬ１，ＷＬ２は、互いに間隔を存して平行もしくはほぼ平行に対向する接触対象面である。
そして、本実施形態の説明で参考的に例示する目標運動は、２つの壁面ＷＬ１，ＷＬ２の間で、床面ＦＬ上から壁面ＷＬ１，ＷＬ２をよじ登らせるようにロボット１を動作させる目標運動である。以降、この目標運動を壁登り歩容ということがある。
この壁登り歩容におけるロボット１の動作形態の概要を図３（ａ），（ｂ），（ｃ）及び図４（ａ），（ｂ）を参照して以下に説明しておく。図３（ａ），（ｂ），（ｃ）及び図４（ａ），（ｂ）は、壁登り歩容におけるロボット１の瞬時的な動作状態（時刻t1〜t5での動作状態）を時系列順に示している。
なお、これらの図では、便宜上、ロボット１の各リンク機構５のリンク要素７及び関節９の図示を省略し、各リンク機構５をその基端部（基体３側の端部）と先端部とを結ぶ線分として記載している。この場合、図面上は、各リンク機構５の先端部は点となるが、実際には、前記した板状の先端部リンク７ａである。
また、これらの図における矢印Ｆ1〜Ｆ10は、各図のロボット１の動作状態で、接触対象面ＦＬ又はＷＬ１又はＷＬ２からロボット１に作用する外力（並進外力）の例を視覚的に示している。この場合、各並進外力Ｆ1〜Ｆ10の始点が接触対象面ＦＬ又はＷＬ１又はＷＬ２からロボット１への該並進外力の作用点（外力作用点）に相当する。
また、これらの図において、接触対象面ＦＬ又はＷＬ１又はＷＬ２上に記載している丸枠領域AR1〜AR12は、各図のロボット１の動作状態で、接触対象面ＦＬ又はＷＬ１又はＷＬ２からロボット１への外力作用点の概略的な存在可能領域を視覚的に示している。その存在可能領域は、単一のリンク機構５の先端部だけが接触している接触対象面では、その単一のリンク機構５の先端部リンク７ａと接触対象面との接触面内の領域である。また、複数のリンク機構５の先端部が接触している接触対象面での外力作用点の存在可能領域は、それらの複数のリンク機構５の先端部リンク７ａのそれぞれと接触対象面との各接触面内の領域をひとまとめに連接してなる領域（所謂、支持多角形に相当する領域）である。
以下、これらの図を参照して壁登り歩容を説明すると、図３（ａ）は壁登り歩容の初期状態を示している。この初期状態では、ロボット１の２つのリンク機構５ａ，５ｂの先端部を床面ＦＬに接触（接地）させた状態で、ロボット１が壁面ＷＬ１，ＷＬ２の間で床面ＦＬ上に起立する。また、ロボット１の壁登り歩容の動作を開始するために、ロボット１は、残りのリンク機構５ｃ，５ｄのうちの壁面ＷＬ１側のリンク機構５ｃの先端部を該壁面ＷＬ１に接触させると共に、壁面ＷＬ２側のリンク機構５ｄの先端部を該壁面ＷＬ２に接触させる。
この場合、図３（ａ）の初期状態では、ロボット１の自重（より正確には、ロボット１に作用する重力とロボット１の運動によって発生する慣性力との合力）を支えるための外力として、例えば、矢印Ｆ1で示す外力が、床面ＦＬの領域AR1からロボット１に作用する。なお、図示例では、壁面ＷＬ１，ＷＬ２からロボット１に作用する外力は“０”である。
次いで、ロボット１の動作状態は、図３（ｂ）に示す状態に移行する。この図３（ｂ）の動作状態は、図３（ａ）の初期状態で壁面ＷＬ１，ＷＬ２に接触させたリンク機構５ｃ，５ｄの先端部をそれぞれ壁面ＷＬ１，ＷＬ２に押し付けつつ、リンク機構５ａ，５ｂのうちの一方（図示例では、リンク機構５ａ）の先端部を床面ＦＬ上から浮上させることによって、図３（ａ）の初期状態から移行する動作状態である。
この場合、図３（ｂ）の動作状態では、ロボット１の自重を支えるための外力として、例えば、床面ＦＬの領域AR4から矢印Ｆ2で示す外力がロボット１に作用すると共に、壁面ＷＬ１の領域AR5と壁面ＷＬ２の領域AR6とからそれぞれ矢印Ｆ3，Ｆ4で示す外力（上向きの摩擦力成分を有する外力）がロボット１に作用する。
次いで、ロボット１の動作状態は、図３（ｃ）に示す状態に移行する。この図３（ｃ）の動作状態は、図３（ｂ）の動作状態で壁面ＷＬ１，ＷＬ２にそれぞれ押し付けたリンク機構５ｃ，５ｄの先端部の押し付け力を増加させ、さらに、図３（ｂ）の動作状態で床面ＦＬに接触させていたリンク機構５ｂを床面ＦＬ上から浮上させる（ひいては、リンク機構５ａ，５ｂの両方を床面ＦＬ上から浮上させる）ことによって、図３（ｂ）の動作状態から移行する動作状態である。
この場合、図３（ｃ）の動作状態では、ロボット１の自重を支えるための外力として、例えば、壁面ＷＬ１の領域AR7と、壁面ＷＬ２の領域AR8とから、それぞれ矢印Ｆ5，Ｆ6で示す外力（上向きの摩擦力成分を有する外力）がロボット１に作用する。
次いで、ロボット１の動作状態は、図４（ａ）に示す状態に移行する。この図４（ａ）の動作状態は、図３（ｃ）の動作状態までに床面ＦＬから浮上させたリンク機構５ａ，５ｂのうちのリンク機構５ａの先端部を、リンク機構５ｃの先端部の下側で壁面ＷＬ１に接触させると共に、リンク機構５ｂの先端部を、リンク機構５ｄの先端部の下側で壁面ＷＬ２に接触させることによって、図３（ｃ）の動作状態から移行する動作状態である。
この場合、図４（ａ）に示した動作状態は、リンク機構５ａ，５ｂをそれぞれ壁面ＷＬ１，ＷＬ２に接触させた直後の状態である。この状態では、例えば、壁面ＷＬ１の領域AR9のうち、リンク機構５ｃの先端部寄りの点を外力作用点として、矢印Ｆ7で示す外力（上向きの摩擦力成分を有する外力）がロボット１に作用すると共に、壁面ＷＬ２の領域AR10のうち、リンク機構５ｄの先端部寄りの点を外力作用点として、矢印Ｆ8で示す外力（上向きの摩擦力成分を有する外力）がロボット１に作用する。
次いで、ロボット１の動作状態を、図４（ａ）に示した如くリンク機構５ａ，５ｃを壁面ＷＬ１に接触させ、且つ、リンク機構５ｂ，５ｄを壁面ＷＬ２に接触させた状態に維持したまま、下側のリンク機構５ａ，５ｂのそれぞれの壁面ＷＬ１，ＷＬ２への押し付け力を増加させていくと共に、上側のリンク機構５ｃ，５ｄのそれぞれの壁面ＷＬ１，ＷＬ２への押し付け力を減少させていく。
これにより、壁面ＷＬ１からロボット１への外力作用点を、領域AR9のうちのリンク機構５ａの先端部寄りの箇所に近づけていくと共に、壁面ＷＬ２からロボット１への外力作用点を、領域AR10のうちのリンク機構５ｂの先端部寄りの箇所に近づけていく。そして、最終的には、壁面ＷＬ１からロボット１への外力作用点を、リンク機構５ａの先端部と壁面ＷＬ１との接触面内に移動させると共に、壁面ＷＬ２からロボット１への外力作用点を、リンク機構５ｂの先端部と壁面ＷＬ２との接触面内に移動させる。
次いで、ロボット１の動作状態は、図４（ｂ）に示す状態に移行する。この図４（ｂ）の動作状態は、図４（ａ）の動作状態で、上記の如く壁面ＷＬ１，ＷＬ２からロボット１への外力作用点を移動させた後に、リンク機構５ａ，５ｂをそれぞれ壁面ＷＬ１，ＷＬ２に押し付けた状態を維持したまま、リンク機構５ｃ，５ｄの先端部のうちの一方（図示例では、リンク機構５ｃの先端部）を壁面ＷＬ１から離反させることによって、図４（ａ）の動作状態から移行する動作状態である。
この場合、図４（ｂ）に示した動作状態では、ロボット１の自重を支えるための外力として、壁面ＷＬ１の領域AR11から矢印Ｆ9で示す外力（上向きの摩擦力成分を有する外力）がロボット１に作用すると共に、壁面ＷＬ２の領域AR12から矢印Ｆ10で示す外力（上向きの摩擦力成分を有する外力）がロボット１に作用する。
その後は、リンク機構５ｄの先端部も壁面ＷＬ２から離反される。そして、壁面ＷＬ１，ＷＬ２から離反されたリンク機構５ｃ，５ｄの先端部が、それぞれ、図４（ａ）の動作状態よりも高所で壁面ＷＬ１，ＷＬ２に接触される。そして、図３（ｂ）以降の動作と同様の動作の繰り返しによって、ロボット１が壁面ＷＬ１，ＷＬ２をよじ登っていく。
以上が、壁登り歩容の概略的な形態である。
このような壁登り歩容等の目標運動を生成する目標運動生成部２５には、制御ユニット２１にあらかじめ記憶保持された移動指令データ、あるいは、外部から無線通信などにより制御ユニット２１に入力される移動指令データが与えられると共に、ロボット１の外界に存在する接触対象面等に関する環境情報が与えられる。
上記移動指令データは、例えば、ロボット１の移動開始時刻や、移動経路、移動の仕方等を指定するデータである。また、上記環境情報は、例えば、ロボット１の外界の接触対象面（床面ＦＬ、壁面ＷＬ１，ＷＬ２等）のロボット１に対する相対位置及び相対姿勢を認識するために必要な情報や、各接触対象面の性状（摩擦係数等）を認識するために必要な情報等から構成される。
なお、上記環境情報は、制御ユニット２１に外部から無線通信等により入力される情報、又は制御ユニット２１にあらかじめ記憶保持された情報でもよいが、ロボット１に搭載した図示しない撮像カメラ等の環境認識用のセンサの出力を基に、制御ユニット２１で認識された情報であってもよい。
そして、目標運動生成部２５は、これらの移動指令データと環境情報とに基づいて、ロボット１の運動を制約する条件（ロボット１の目標運動が満たすべき条件）を設定し、その条件を満足させるように、逆運動学の演算処理によってロボット１の目標運動を逐次生成しつつ出力する。
この場合、ロボット１の運動を制約する条件は、基本的には、該ロボット１の要求される運動形態に応じて適宜設定される。その制約条件としては、例えば、各リンク機構５の先端部の運動を制約する条件（各リンク機構５の先端部リンク７ａを外界の接触対象面に接触させる時刻の目標、その接触時における接触対象面上の接触位置の目標、その接触時における先端部リンク７ａの姿勢の目標、外界の接触対象面に接触させていない先端部リンク７ａの、ある時刻又は期間における位置及び姿勢の目標等）と、基体２の運動を制約する条件（ある時刻又は期間における基体２の位置及び姿勢の目標等）とを使用することができる。
なお、基体２の運動を制約する条件に代えて、もしくは、該条件に加えて、ロボット１の運動に関する所定の状態量を制約する条件（例えばロボット１の全体の並進運動量又は角運動量の目標等）を使用するようにしてもよい。また、該制約条件には、一般には、ロボット１の関節９の可動範囲や動作速度（関節９の変位量の変化速度）の許容範囲等、機構的な制約条件も含まれる。
前記壁登り歩容の生成を行なう場合には、目標運動生成部２５は、図３及び図４を参照して説明した時系列的な形態で、ロボット１の各リンク機構５の先端部が接触対象面ＦＬ，ＷＬ１，ＷＬ２のいずれかに接触する動作が行なわれるように、ロボット１の運動を制約する条件（例えば、各リンク機構５の先端部の運動を制約する条件と、基体３の運動を制約する条件とを含む制約条件）を決定する。そして、目標運動生成部２５は、この制約条件を満足させるように、逆運動学の演算処理によってロボット１の目標運動の時系列を生成する。なお、目標運動は、不連続に（ステップ状に）変化することが無いように生成される。
また、目標運動生成部２５は、上記の如く決定した目標運動に基づいて、各接触対象面（１つ又は複数のリンク機構５の先端部リンク７ａを接触させている面）における外力作用点の存在許容領域と、暫定外力作用点とを決定する。
この場合、目標運動生成部２５は、まず、上記の如く生成した目標運動に基づいて、各接触対象面における外力作用点の存在許容領域を設定する。より詳しくは、目標運動生成部２５は、上記の如く生成した目標運動において、１つのリンク機構５の先端部リンク７ａだけを接触させる接触対象面においては、該接触対象面と先端部リンク７ａとの接触面内に外力作用点の存在許容領域を設定する。その存在許容領域は、接触対象面と先端部リンク７ａとの接触面内で、その接触面の境界に近づき過ぎないような領域に設定される。
また、２つ以上のリンク機構５の先端部リンク７ａを接触させる接触対象面においては、目標運動生成部２５は、該接触対象面と各先端部リンク７ａとの接触面を連接してなる領域（所謂、支持多角形の領域）内に外力作用点の存在許容領域を設定する。その存在許容領域は、支持多角形の領域内で、該支持多角形の領域の境界に近づき過ぎないような領域に設定される。
そして、目標運動生成部２５は、上記の如く設定した外力作用点の存在許容領域内の点（例えば、該存在許容範囲内の中央点）を暫定外力作用点として決定する。なお、各接触対象面上の暫定外力作用点は、該接触対象面にいずれかのリンク機構５が接触する状態が連続的に継続する期間内において、該作用点の位置が不連続に（ステップ状に）変化することが無いように決定される。
目標運動生成部２５が図３及び図４に例示した壁登り歩容の生成を行なう場合には、暫定外力作用点は、例えば、図５（ａ），（ｂ），（ｃ）に例示する時系列パターンで生成される。なお、図５（ａ）〜（ｃ）における横軸の時刻t1〜t5は、それぞれ順番に、図３（ａ）、図３（ｂ）、図３（ｃ）、図４（ａ）、図４（ｂ）の動作状態に対応する時刻を示している。
図５（ａ）〜（ｃ）に示す例では、床面ＦＬ上の暫定外力作用点の位置（壁面ＷＬ１，ＷＬ２に垂直な方向での位置）は、時刻t1から時刻t2の直前までに壁面ＷＬ１側から壁面ＷＬ２側に連続的に移動していくように決定される。
また、壁面ＷＬ１上の暫定外力作用点の位置（高さ方向での位置）は、時刻t3と時刻ｔ4との間の途中時刻まで一定の位置（壁面ＷＬ１とリンク機構５ｃの先端部との接触面内の位置）に維持された後、該途中時刻から時刻t4の直前まで、下方に連続的に移動していくように決定される。次いで、壁面ＷＬ１上の暫定外力作用点の位置は、時刻t4と時刻t5との間の途中時刻まで一定の位置（リンク機構５ｃの先端部の壁面ＷＬ１への接触面とリンク機構５ａの先端部の壁面ＷＬ１への接触面との間の中間位置）に維持された後、時刻t5の直前の時刻まで、下方に連続的に移動していき、さらに、時刻t5の前後の期間で一定の位置（壁面ＷＬ１とリンク機構５ａの先端部との接触面内の位置）に維持されるように決定される。
また、壁面ＷＬ２上の暫定外力作用点の位置（高さ方向での位置）は、時刻t3と時刻ｔ4との間の途中時刻まで一定の位置（壁面ＷＬ２とリンク機構５ｄの先端部との接触面内の位置）に維持された後、該途中時刻から時刻t4の直前の時刻まで、下方に連続的に移動していき、その後、時刻t5の直後の時刻までの期間で一定の位置（リンク機構５ｄの先端部の壁面ＷＬ２への接触面とリンク機構５ｂの先端部の壁面ＷＬ２への接触面との間の中間位置）に維持されるように決定される。
なお、この場合、床面ＦＬと壁面ＷＬ１，ＷＬ２のそれぞれにおける外力作用点の存在許容領域は、その面積が、例えば図６に示すようなパターンで連続的に変化するように設定される。
補足すると、目標運動生成部２５が生成する目標運動は、基本的には、ロボット１に行なわせようとする運動に関する要求を形式的に（少なくとも運動学的に）実現し得るように生成されたものであればよい。換言すれば、該目標運動は、動力学的な実現性が厳密に保障されたものでなくてもよい。従って、該目標運動を実現するためにロボット１に作用させるべき外力が、実際にはロボット１に作用させることが困難となる場合や、該外力が好適な範囲を逸脱するようなものとなる場合（該外力が過大になり過ぎる場合等）もあり得る。
また、目標運動は、必ずしもロボット１の動作中にリアルタイムで生成する必要はない。例えば、事前に適宜のコンピュータによって作成した目標運動と外力作用点の存在許容領域とを、制御ユニット２１にあらかじめ記憶保持しておくか、あるいは、無線通信等により制御ユニット２１に入力し、外力目標生成部２７及び動作制御部２９に逐次出力するようにしてもよい。このようにした場合には、目標運動生成部２５は不要である。
次に、外力目標生成部２７の処理を詳細に説明する。この外力目標生成部２７には、目標運動生成部２５から出力された目標運動、暫定外力作用点及び外力作用点の存在許容領域が入力される。さらに、外力目標生成部２７には、前記環境情報も入力される。
そして、外力目標生成部２７は、これらの入力データを用いて、図７〜図９のフローチャートに示す処理を実行することによって、外力に関する目標としての目標外力と目標外力作用点とを決定する。図７〜図９のフローチャートに示す処理は、制御ユニット２１の各演算処理周期の時刻で、ロボット１の運動状態の評価を行いつつ、目標外力及び目標外力作用点の瞬時値を決定するための処理を示しており、この処理を所定の周期で逐次実行することによって、ロボット１の運動状態が適切である場合に、目標外力と目標外力作用点とが逐次決定される。
なお、外力目標生成部２７の処理に関する以降の説明においては、図７〜図９のフローチャートの処理により今現在、決定しようとする目標外力及び目標外力作用点の瞬時値に対応する時刻を今回時刻という。また、今回時刻の１つ前の時刻を前回時刻、次の時刻を次回時刻という。
以下説明すると、外力目標生成部２７は、まず、Ｓ０１の処理を実行する。このＳ０１では、外力目標生成部２７は、目標運動と環境情報とを基に、今回時刻での目標外力及び目標外力作用点を決定するための演算処理に用いる作業用の仮想面を、ロボット１の外界の各接触対象面（目標運動における今回時刻でいずれかのリンク機構５の先端部を接触させる接触対象面）に一致又は近似させるように設定する。
ここで、本実施形態では、外力目標生成部２７の処理のアルゴリズムに汎用性を持たせると共に該アルゴリズムの構築を行い易くするために図１０に示す如く、相互の姿勢関係があらかじめ定められた６つの平面Ｓ1a，Ｓ2a，Ｓ3a，Ｓ1b，Ｓ2b，Ｓ3bが、作業用の仮想面として使用し得る面として用意されている。そして、外力目標生成部２７の処理では、ロボット１の目標運動を実現するために該ロボット１に各接触対象面から作用すべき外力は、各接触対象面に対応する仮想面からロボット１に作用する外力であると見なされる。
この場合、本実施形態では、６つの仮想面のうちの仮想面Ｓ1a，Ｓ2a，Ｓ3aは相互に直交する平面とされ、仮想面Ｓ1b，Ｓ2b，Ｓ3bは、それぞれ仮想面Ｓ1a，Ｓ2a，Ｓ3aに平行な平面とされている。
また、互いに平行に対向する２つの仮想面は、それぞれが発生し得る垂直抗力が互いに逆向き（各仮想面からこれに対向する仮想面に向かう向き）であるとされる。例えば、図１０に示す如く、３軸直交座標系（ＸＹＺ座標系）を想定した場合において、Ｘ軸に直交する仮想面Ｓ1a，Ｓ1bがそれぞれ発生可能な垂直抗力Ｎ_1a，Ｎ_1bの向きは、それぞれＸ軸方向の正の向き（Ｓ1aからＳ1bに向かう向き）、Ｘ軸方向の負の向き（Ｓ1bからＳ1aの向かう向き）である。このことは、Ｙ軸に直交する仮想面Ｓ2a，Ｓ2bの組、Ｚ軸に直交する仮想面のＳ3a，Ｓ3bの組についても同様である。
そして、Ｓ０１の処理では、外力目標生成部２７は、今回時刻での外界の各接触対象面（詳しくは、各接触対象面のうちのロボット１のリンク機構５の先端部との接触面）に、それぞれ、仮想面Ｓ1a，Ｓ2a，Ｓ3a，Ｓ1b，Ｓ2b，Ｓ3bのいずれか１つを対応付ける。そして、外力目標生成部２７は、今回時刻での各接触対象面に対応付けた仮想面が、それに対応する接触対象面に一致又は近似するように、今回時刻での接触対象面と同数の仮想面を、ロボット１の外界（前記環境情報により認識される外界）に対して仮想的に設定する。なお、外界に仮想面を設定するということは、外界における仮想面の配置位置及び姿勢を決定することを意味する。
この場合、今回時刻での外界の接触対象面が複数となる場合には、各接触対象面（各接触対象面のうちのロボット１のリンク機構５の先端部との接触面）とこれに対応する仮想面との間の姿勢差（空間的な角度差）が、いずれの接触対象面についてもできるだけ“０”又はそれに近いものとなるように、外界における仮想面の配置（接触対象面と同数の仮想面から成る仮想面群の配置）が決定される。例えば、各接触対象面毎の上記姿勢差の空間的な各成分（３軸周りの角度差成分）の２乗値又は絶対値を、今回時刻での全ての接触対象面に関して加え合わせてなる値（又は該２乗値又は絶対値の平均値）が最小となるように、今回時刻での全ての接触対象面と同数の仮想面から成る仮想面群の配置が決定される。
従って、本実施形態では、今回時刻での外界の接触対象面が複数となる場合に、Ｓ０１で設定される複数の仮想面（仮想面群）は、接触対象面と同数の仮想面により構成され、その相互の姿勢関係は、任意の２つの仮想面が互いに直交するか、又は互いに平行に対向するものとなる。
なお、今回時刻での接触対象面が前回時刻での接触対象面と同一の接触対象面を有する場合には、今回時刻において、その同一の接触対象面に対応付けられる仮想面は、前回時刻と同じ仮想面に維持される。
以上のＳ０１の処理によって、ロボット１の目標運動が前記壁登り歩容である場合には、例えば、次のように仮想面が設定される。すなわち、図３（ａ）又は図３（ｂ）に示した動作状態の時刻では、６つの仮想面Ｓ1a，Ｓ2a，Ｓ3a，Ｓ1b，Ｓ2b，Ｓ3bのうちの互いに平行な２つの仮想面を含む３つの仮想面、例えば、仮想面Ｓ3a，Ｓ2a，Ｓ2bがそれぞれ接触対象面としての床面ＦＬ、壁面ＷＬ１、壁面ＷＬ２に対応付けられる（図中の括弧付きの参照符号を参照）。そして、これらの仮想面Ｓ3a，Ｓ2a，Ｓ2bがそれぞれ床面ＦＬ、壁面ＷＬ１、壁面ＷＬ２に一致又はほぼ一致する面になるように、ロボット１の外界における仮想面Ｓ3a，Ｓ2a，Ｓ2bの配置が決定される。
また、図３（ｃ）、図４（ａ）、図４（ｂ）の動作状態の時刻では、図３（ａ），（ｂ）の動作状態での壁面ＷＬ１，ＷＬ２にそれぞれ対応付けられた仮想面Ｓ2a，Ｓ2bが、そのまま、壁面ＷＬ１，ＷＬ２にそれぞれ対応付けられる（図中の括弧付きの参照符号を参照）。そして、これらの仮想面Ｓ2a，Ｓ2bがそれぞれ壁面ＷＬ１，ＷＬ２に一致又はほぼ一致するように、ロボット１の外界における仮想面Ｓ2a，Ｓ2bの配置が決定される。
なお、以降の本実施形態の説明では、Ｓ０１で設定される仮想面のうち、互いに平行に対向する２つの仮想面を対向仮想面ということがある。この対向仮想面の組は、本実施形態では、仮想面Ｓ1a，Ｓ1bの組、仮想面Ｓ2a，Ｓ2bの組、仮想面Ｓ3a，Ｓ3bの組のいずれかである。そして、これらの各組の対向仮想面を総称的に表記する場合に、対向仮想面Ｓna，Ｓnb（ｎ＝１又は２又は３）、あるいは、単に対向仮想面Ｓna，Ｓnbと表記することがある。
図５の説明に戻って、外力目標生成部２７は、次に、Ｓ０２の処理を実行する。このＳ０２では、外力目標生成部２７は、目標運動生成部２５が作成した目標運動を基に、この目標運動を実現するために、今回時刻でロボット１に作用させるべきトータルの外力である必要総外力のうちの並進力成分である必要総並進外力Ｆallと、該必要総外力のうちの所定の基準点周りのモーメント成分である必要総モーメント外力Ｍallとを決定する。
ここで、上記所定の基準点（以降、モーメント基準点という）は、ロボット１の外界に対して固定された点（例えば、外界の接触対象面又はこれに対応する仮想面上に設定された点）である。このモーメント基準点は、目標運動の全期間で一定の点に維持してもよいが、目標運動の所定の期間毎に適宜更新するようにしてもよい。
なお、本実施形態における外力目標生成部２７の処理では、必要総並進外力Ｆall、必要総モーメント外力Ｍall等の並進力もしくはモーメント、あるいは、空間的な位置、姿勢等の変数（ベクトル量）は、Ｓ０１で設定される仮想面に対して固定されたグローバル座標系（例えば、各仮想面に対して図１０に示すような位置及び姿勢関係で設定される３軸直交座標系（ＸＹＺ座標系））で記述される。
上記必要総並進外力Ｆall及び必要総モーメント外力Ｍallは、より具体的には次のように決定される。すなわち、必要総並進外力Ｆallを決定する場合には、外力目標生成部２７は、ロボット１の目標運動を基に、ロボット１の幾何学モデル（剛体リンクモデル）を用いて、ロボット１の全体重心点の目標位置の２階微分値である目標重心加速度（今回時刻での目標重心加速度）を算出する。なお、ロボット１の全体重心点の目標位置、あるいは、目標重心加速度は、前記目標運動生成部２５で目標運動の要素として算出しておくようにしてもよい。
そして、外力目標生成部２７は、この目標重心加速度とロボット１の全体質量とから算出される並進慣性力（ロボット１の目標運動によって発生する慣性力の並進力成分）とロボット１に作用する重力との合力に釣り合う並進力を必要総並進外力Ｆallとして算出する。
なお、目標運動によって発生するロボット１の全体の並進慣性力は、例えば、ロボット１の各リンク３，７毎の重心点の並進慣性力を加え合わせることによって算出するようにしてもよい。
また、必要総モーメント外力Ｍallを決定する場合には、外力目標生成部２７は、ロボット１の目標運動を基に、ロボット１の幾何学モデル（剛体リンクモデル）を用いて、ロボット１の目標運動によって該ロボット１の全体重心点の周りに発生する今回時刻での慣性力モーメント（慣性力のモーメント成分）と、該目標運動におけるロボット１の全体重心点の運動（並進運動）が前記モーメント基準点周りに発生する今回時刻での慣性力モーメントとの総和の慣性力モーメントを算出する。そして、外力目標生成部２７は、この総和の慣性力モーメントに釣り合うモーメントを今回時刻での必要総モーメント外力Ｍallとして算出する。
なお、ロボット１の目標運動によって発生する並進慣性力の時系列と、前記モーメント基準点周りの慣性力モーメントの時系列とを前記目標運動生成部２５で算出しておいてもよい。そして、今回時刻での並進慣性力の値と慣性力モーメントの値とを目標運動生成部２５から外力目標生成部２７に入力するようにしてもよい。
上記の如く必要総並進外力Ｆall及び必要総モーメント外力Ｍallを算出した後、外力目標生成部２７は、次にＳ０３の処理を実行する。このＳ０３では、外力目標生成部２７は、ロボット１の並進運動に係わる所定種類の第１運動状態量の実際の値（センサ群１３の出力に基づく観測値）と、目標運動により規定される該第１運動状態量の目標値との偏差を解消する（該偏差を“０”に近づける）ために、ロボット１に付加的に作用させるべき並進力である並進外力補償量と、ロボット１の回転運動に係わる所定種類の第２運動状態量の実際の値（前記センサ群１３の出力に基づく観測値）と、目標運動により規定される該第２運動状態量の目標値との偏差を解消する（該偏差を“０”に近づける）ために、ロボット１に付加的に作用させるべきモーメント（前記モーメント基準点周りのモーメント）であるモーメント外力補償量とを決定する。
ここで、目標運動で想定されたロボット１の動作環境と、実際の動作環境との誤差等に起因して、ロボット１の実際の運動状態と目標運動により規定される運動状態とには誤差が生じる。上記並進外力補償量とモーメント外力補償量とは、ロボット１の動作状態を安定させるために、このような運動状態の誤差を解消もしくは低減するために、ロボット１に付加的に作用させる外力を意味する。
この場合、並進外補償量に係わる前記第１運動状態量は、ロボット１に作用させる外力のうちの並進力の調整によって操作可能な運動状態量である。また、モーメント外力補償量に係わる前記第２運動状態量は、ロボット１に作用させる外力のうちのモーメントの調整によって操作可能な運動状態量である。これらの運動状態量は、基本的には、目標運動により実現しようとするロボット１の動作状態を安定させる上で好適と考えられる種類の運動状態量であればよい。
具体的には、本実施形態では、第１運動状態量として、例えば、ロボット１の全体重心点の位置が用いられる。また、第２運動状態量として、例えば、ロボット１の全体重心点周りの角運動量が用いられる。
そして、第１運動状態量の実際の値を目標値に近づけるための並進外力補償量は次のように決定される。
すなわち、外力目標生成部２７は、入力される目標運動を基に、ロボット１の幾何学モデル（剛体リンクモデル）を用いて、今回時刻でのロボット１の全体重心点の目標位置（以降、目標全体重心点位置という）を算出する。また、外力目標生成部２７は、前記センサ群１３の関節変位センサ１９の出力を基に、今回時刻でのロボット１の全体重心点の実際の位置の観測値（以降、実全体重心点位置という）を算出する。そして、外力目標生成部２７は、これらの目標全体重心点位置と実全体重心点位置との偏差ΔＰgを算出し、この偏差ΔＰgを“０”に収束させるようにフィードバック制御則により並進外力補償量Ｆadを算出する。
この場合、本実施形態では、外力目標生成部２７は、例えば、ＰＤ則（比例・微分則）を用いて、次式２１により、Ｆadを算出する。

Ｆad＝Ｋf1＊ΔＰg＋Ｋf2＊ΔＰg' ……式２１

この式２１におけるΔＰg'は、ΔＰgの１階微分値、Ｋf1、Ｋf2はそれぞれあらかじめ設定されたゲイン値である。なお、本明細書では、「＊」は乗算記号として使用する。この場合、ベクトル同士の乗算演算における「＊」は、外積（ベクトル積）を意味するものとする。
また、第２運動状態量の実際の値を目標値に近づけるためのモーメント外力補償量は次のように決定される。
すなわち、外力目標生成部２７は、入力される目標運動を基に、ロボット１の幾何学モデル（剛体リンクモデル）を用いて、ロボット１の目標運動によって該ロボット１の全体重心点の周りに発生する今回時刻での角運動量の目標値（以降、目標角運動量という）を算出する。また、外力目標生成部２７は、前記センサ群１３の関節変位センサ１９の出力と姿勢センサ１５の出力とを基に、ロボット１の幾何学モデル（剛体リンクモデル）を用いて、ロボット１の実際の運動によって該ロボット１の実際の全体重心点周りに発生する今回時刻での角運動量の観測値（以降、実角運動量という）を算出する。そして、外力目標生成部２７は、これらの目標角運動量と実角運動量との偏差ΔＬgを算出し、この偏差ΔＬgを“０”に収束させるようにフィードバック制御則によりモーメント外力補償量Ｍadを算出する。
この場合、本実施形態では、外力目標生成部２７は、例えば、ＰＤ則（比例・微分則）を用いて、次式２２により、Ｍadを算出する。

Ｍad＝Ｋm1＊ΔＬg＋Ｋm2＊ΔＬg'＋Ｐg＊Ｆad ……式２２

この式２２におけるΔＬg'は、ΔＬgの１階微分値、Ｋm1、Ｋm2はそれぞれあらかじめ設定されたゲイン値である。また、Ｐgは、今回時刻でのロボット１の全体重心点の位置ベクトル（前記モーメント基準点に対する位置ベクトル）である。そして、Ｐg＊Ｆadは、この位置ベクトルＰgと、前記式２２により算出された並進外力補償量Ｆadとのベクトル積である。本実施形態では、並進外力補償量Ｆadをロボット１に付加的に作用させることに起因して生じるロボット１の全体重心点の並進運動によって、モーメント（Ｐg＊Ｆad）が発生する。このため、式２２では、このモーメント（Ｐg＊Ｆad）がモーメント外力補償量Ｍadのバイアス分として付加されている。
補足すると、本実施形態では、並進外補償量Ｆadに係わる第１運動状態量と、モーメント外力補償量Ｍadに係わる第２運動状態量として、異なる種類のものを使用したが、それらの運動状態量として、同じ種類の運動状態量（例えば基体３の姿勢等）を用いてもよい。 上記の如く、Ｓ０３の処理を実行した後、外力目標生成部２７は、次にＳ０４の処理を実行する。このＳ０４では、外力目標生成部位２７は、Ｓ０２で算出した必要総並進外力Ｆallに、Ｓ０３で算出した並進外力補償量Ｆadを付加してなる補償総並進外力Ｆall_ad（＝Ｆall＋Ｆad）を算出すると共に、Ｓ０２で算出した必要総モーメント外力Ｍallに、Ｓ０３で算出したモーメント外力補償量Ｍadを付加してなる補償総モーメント外力Ｍall_ad（＝Ｍall＋Ｍad）を算出する。
上記補償総並進外力Ｆall_adは、ロボット１全体の実際の並進運動を目標運動における並進運動に追従させつつ、前記偏差ΔＰg（第１運動状態量の目標値と実際の値との偏差）を“０”に近づけるために、ロボット１に付加すべきトータルの並進力としての意味を持つ。また、上記補償総モーメント外力Ｍall_adは、ロボット１全体の実際の回転運動を目標運動における回転運動に追従させつつ、前記偏差ΔＬg（第２運動状態量の目標値と実際の値との偏差）を“０”に近づけるために、ロボット１に付加すべきトータルのモーメントとしての意味を持つ。
上記の如く補償総並進外力Ｆall_ad及び補償総モーメント外力Ｍall_adを算出した後、外力目標生成部２７は、次に、Ｓ０５〜Ｓ１５の処理を実行する。このＳ０５〜Ｓ１５の処理は、補償総並進外力Ｆall_adを実現する（ロボット１に実際に作用するトータルの並進外力が補償総並進外力Ｆall_adに一致するようにする）ために、Ｓ０１で設定した各仮想面からロボット１に作用させるべき並進力である仮想面必要並進力を決定する処理である。この各仮想面における仮想面必要並進力は、該仮想面に垂直な成分である仮想面垂直抗力成分と、該仮想面に平行な成分である仮想面摩擦力成分とから構成される。なお、Ｓ０５〜Ｓ１５の処理によって決定される仮想面必要並進力は暫定値であり、後述のＳ１９以降の処理によって修正される場合がある。また、Ｓ０５〜Ｓ１５の処理には、決定する仮想面必要並進力に基づいて、ロボット１の運動状態の評価を行なう処理も含まれる。
以下、Ｓ０５〜Ｓ１５の処理を具体的に説明すると、外力目標生成部２７は、まず、Ｓ０５の処理を実行する。このＳ０５では、外力目標生成部２７は、Ｓ０４で決定した補償総並進外力Ｆall_adに応じて、各仮想面における仮想面必要総並進力のうちの、該仮想面に垂直な成分（垂直抗力成分）である仮想面垂直抗力成分Ｎ_iと、該仮想面に平行な成分（摩擦力成分）である仮想面摩擦力成分Ｆ_iとを決定する。
なお、本実施形態の説明では、参照符号Ｎ_i，Ｆ_i等における添え字“ｉ”は、今回時刻におけるＳ０１で設定された仮想面のうちの任意の仮想面の識別符号を意味する。そして、この添え字“ｉ”を付した参照符号は、識別符号ｉの仮想面に関連するものの参照符号であることを意味する。この場合、本実施形態の説明では、仮想面Ｓ1a，Ｓ2a，Ｓ3a，Ｓ1b，Ｓ2b，Ｓ3bのそれぞれの識別符号は、仮想面を表す参照符号中の“Ｓ”の添え字、すなわち、1a，2a，3a，1b，2b，3bであるとする。そして、ある特定の仮想面に関連する参照符号には、その特定の仮想面の添え字と同じ添え字を付する。例えば、仮想面Ｓ2aにおける仮想面垂直抗力成分の参照符号を“Ｎ_2a”と表記する。
この場合、外力目標生成部２７は、今回時刻のＳ０１で設定した全ての仮想面における仮想面必要並進力の合力がＳ０４で決定した補償総並進外力Ｆall_adに一致するという第１必要条件を満足するように、各仮想面における仮想面必要並進力を構成する仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとを決定する。
より詳しくは、本実施形態におけるＳ０５の処理では、上記第１必要条件を満足するために、外力目標生成部２７は、今回時刻で設定した全ての仮想面における仮想面垂直抗力成分Ｎ_iの合力が、補償総並進外力Ｆall_adのうち、当該全ての仮想面に対して平行な成分を除く成分に一致するという第１Ａ必要条件と、当該全ての仮想面における仮想面摩擦力成分Ｆ_iの合力が、補償総並進外力Ｆall_adのうち、当該全ての仮想面に対して平行な成分に一致するという第１Ｂ必要条件とを満足するように、各仮想面における仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとを決定する。
なお、Ｓ０５の処理では、今回時刻で設定した仮想面が、互いに平行に対向する２つの対向仮想面Ｓna，Ｓnb（ｎ＝１又は２又は３）を含んでおり、且つ、補償総並進外力Ｆall_adが、これらの対向仮想面Ｓna，Ｓnbに垂直な成分Ｆall_ad_nを有するような場合には、外力目標生成部２７は、これらの対向仮想面Ｓna，Ｓnbのうち、Ｆall_ad_nと同じ向きの垂直抗力を発生可能な対向仮想面における仮想面垂直抗力成分Ｓna又はＳnbを、Ｆall_ad_nに一致させると共に、他方の対向仮想面における仮想面垂直抗力成分Ｓnb又はＳnaを“０”に設定する。
また、Ｓ０５の処理では、今回時刻で設定した仮想面が複数であり、且つ、補償総並進外力Ｆall_adが全ての仮想面に平行な成分を有する場合には、外力目標生成部２７は、上記第１Ａ必要条件を満たすように、各仮想面における仮想面垂直抗力成分Ｎ_iを決定した上で、前記第１Ｂ必要条件を満たしつつ、各仮想面における仮想面摩擦力成分Ｆ_iの大きさが、該仮想面で発生可能な摩擦力の上限値に応じた大きさとなるように（詳しくは該仮想面で発生可能な摩擦力の上限値が大きいほど、仮想面摩擦力成分Ｆ_iの大きさが大きくなるように）、各仮想面の仮想面摩擦力成分Ｆ_iを決定する。
具体的には、外力目標生成部２７は、今回時刻で設定した各仮想面の摩擦係数μ_iを、前記環境情報（詳しくは、該仮想面に対応する接触対象面の摩擦係数に関する環境情報）に基づいて設定する。この場合、各仮想面の摩擦係数μ_iは、該仮想面に対応する接触対象面の実際の摩擦係数と同一もしくはほぼ同一の値に設定してもよいが、余裕を見込んで、実際の摩擦係数よりも小さめに設定しておくようにしてもよい。
なお、各仮想面の摩擦係数μ_iの設定は、制御処理周期毎の各時刻で行なう必要はない。例えば、外力目標生成部２７の処理を開始する前に、各接触対象面に対応付ける仮想面の摩擦係数を前記環境情報に基づいて事前に決定して記憶保持しておき、その記憶保持した摩擦係数から、Ｓ０１で設定した各仮想面に対応させる摩擦係数を選定してもよい。
さらに、外力目標生成部２７は、各仮想面において、その仮想面に対応する摩擦係数μ_iを仮想面垂直抗力成分Ｎ_iの大きさ｜Ｎ_i｜に乗じてなる値（＝μ_i＊｜Ｎ_i｜）を、その仮想面で発生可能な摩擦力の上限値（以降、単に摩擦力上限値という）として設定する。
なお、本明細書では、「＊」は乗算記号として使用する。この場合、ベクトル同士の乗算演算における「＊」は、外積（ベクトル積）を意味するものとする。
そして、外力目標生成部２７は、上記の如く設定した摩擦力上限値が大きい仮想面ほど、仮想面摩擦力成分Ｆ_iの大きさがより大きくなるように、各仮想面における仮想面摩擦力成分Ｆ_iを決定する。
例えば、上記第１Ｂ必要条件を満たしつつ、各仮想面の仮想面摩擦力成分Ｆ_iの大きさの相互の比率が、各仮想面の摩擦力上限値の相互の比率に一致するように、各仮想面の仮想面摩擦力成分Ｆ_iが決定される。なお、この場合、例えば、Ｆall_adのうちの全ての仮想面に平行な成分を、最も大きな摩擦力上限値を有する仮想面の仮想面摩擦力成分に一致させ、他の仮想面の仮想面摩擦力成分を“０”に設定するようにしてもよい。
ロボット１の目標運動が前記壁登り歩容である場合には、以上説明したＳ０５の処理によって、各仮想面における仮想面垂直抗力成分Ｎ_i及び仮想面摩擦力成分Ｆ_iは例えば、次のように決定されることとなる。
例えば、図３（ｂ）に示した動作状態の時刻t2において、補償総並進外力Ｆall_ad（＝Ｆall＋Ｆad）が、図１１（ａ）に示す如く床面ＦＬに対応する仮想面Ｓ3aに垂直な成分Ｆall_ad_zと、壁面ＷＬ１，ＷＬ２にそれぞれ対応する仮想面（対向仮想面）Ｓ2a，Ｓ2bに垂直な成分Ｆall_ad_yと、これらの仮想面Ｓ3a，Ｓ2a，Ｓ2bの全てに平行な成分Ｆall_ad_xを有する状況を想定する。
この状況においては、Ｓ０５の処理では、仮想面Ｓ3aの仮想面垂直抗力成分Ｎ_3aと仮想面Ｓ2aの仮想面垂直抗力成分Ｎ_2aとがそれぞれ、Ｆall_ad_z、Ｆall_ad_yに一致する値に決定されると共に、仮想面Ｓ2bの仮想面垂直抗力成分Ｎ_2bが“０”に決定される。これにより前記第１Ａ必要条件を満足する各仮想面垂直抗力成分Ｎ_3a，Ｎ_2a，Ｎ_2bが決定される。なお、ここでは、μ_3a＊｜Ｎ_3a｜＞μ_2a＊｜Ｎ_2a｜であるとする。
そして、仮想面Ｓ3aの仮想面摩擦力成分Ｆ_3aと仮想面Ｓ2aの仮想面摩擦力成分Ｆ_2aとの合力（＝Ｆ_3a＋Ｆ_2a）がＦall_ad_xに一致し、且つ、｜Ｆ_3a｜＞｜Ｆ_2a｜となるように（例えば｜Ｆ_2a｜／｜Ｆ_3a｜＝μ_2a＊｜Ｎ_2a｜／（μ_3a＊｜Ｎ_3a｜）となるように）、仮想面Ｓ3aの仮想面摩擦力成分Ｆ_3aと仮想面Ｓ2aの仮想面摩擦力成分Ｆ_2aとが決定されると共に、仮想面Ｓ2bの仮想面摩擦力成分Ｆ_2bが“０”に決定される。これにより前記第１Ｂ必要条件を満足する各仮想面摩擦力成分Ｆ_3a，Ｆ_2a，Ｆ_2bが決定される。
なお、壁登り歩容における図３（ｃ）の動作状態以降の時刻では、補償総並進外力Ｆall_adが例えば図１１（ａ）に示した場合と同様であるとした場合、Ｓ０５の処理では、仮想面Ｓ2aの仮想面垂直抗力成分Ｎ_2aが、Ｆall_adのうちのＦall_ad_yに一致し、且つ、仮想面摩擦力成分Ｆ_2aが、Ｆall_adのうちのＦall_ad_zとＦall_ad_xとの合力に一致するように仮想面垂直抗力成分Ｎ_2a及び仮想面摩擦力成分Ｆ_2aが決定されると共に、仮想面Ｓ2bの仮想面垂直抗力成分Ｎ_2b及び仮想面摩擦力成分Ｆ_2bはいずれも“０”に決定される。
図５のフローチャートの説明に戻って、以上のようにＳ０５の処理を実行した後、外力目標生成部２７は、Ｓ０７の処理を実行する。このＳ０７では、外力目標生成部２７は、今回時刻のＳ０１で設定した全ての仮想面のそれぞれにおいて、仮想面摩擦力成分Ｆ_iの大きさが仮想面垂直抗力成分Ｎ_iの大きさに応じて設定される所定の上限値としての前記摩擦力上限値以下になるという第２必要条件を満足するか否かを判断する。すなわち、外力目標生成部２７は、Ｓ０１で設定した全ての仮想面のそれぞれにおいて、前記の如く決定した摩擦力上限値（＝μ_i＊｜Ｎ_i｜）を用い、｜Ｆ_i｜≦μ_i＊｜Ｎ_i｜であるか否かを判断する。
外力目標生成部２７は、Ｓ０７の判断結果が肯定的である場合には、各仮想面における仮想面必要並進力（暫定値）を決定する処理を終了し、図８に示すＳ１９以降の処理を実行する。この場合、Ｓ０５で決定された、各仮想面における仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとの組が、そのまま仮想面必要並進力（暫定値）として決定されることとなる。
一方、Ｓ０７の判断結果が否定的である場合には、外力目標生成部２７は、次にＳ０９の処理を実行する。このＳ０９では、外力目標生成部２７は、Ｓ０７の判断結果が否定的となる仮想面が、前記対向仮想面Ｓna又はＳnb（ｎ＝１又は２又は３）であるか否かを判断する。
このＳ０９の判断結果が否定的となる状況では、Ｓ０７の判断結果が否定的となる仮想面における仮想面垂直抗力成分の大きさを、前記第１Ａ必要条件を満たしつつ増加させることができず、ひいては該仮想面における仮想面摩擦力成分の大きさを、前記摩擦力上限値以下で増加させることができない。そこで、この場合には、外力目標生成部２７は、Ｓ１７において、ロボット１の運動状態が不適切である（目標運動の修正等を行なう必要がある）とし、図７〜図９のフローチャートの処理（目標外力及び目標外力作用点を決定する処理）を中止する。
従って、本実施形態では、Ｓ０５において前記第１Ａ必要条件及び第１Ｂ必要条件を満足するように仮想面必要並進力（仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとの組）を決定した上で、Ｓ０７、Ｓ０９の判断処理によってロボット１の運動状態が評価される。そして、Ｓ０７及びＳ０９の判断結果がいずれも否定的となる場合に、ロボット１の運動状態が不適切であると評価されることとなる。
なお、Ｓ１７でロボット１の運動状態が不適切であると評価される場合、外力目標生成部２７は、目標運動生成部２５にエラー情報を出力する。そして、目標運動生成部２５は、そのエラー情報に応じて、目標運動を作成し直したり、あるいは、ロボット１の運動を停止させるような目標運動を作成する。
一方、Ｓ０９の判断結果が肯定的となる状況では、互いに平行な対向仮想面Ｓna，Ｓnb（ｎ＝１又は２又は３）の仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさを、前記第１Ａ必要条件を満足しつつ（Ｎ_na＋Ｎ_nbを一定に保ちつつ）、増加させることができる。すなわち、Ｎ_naとＮ_nbとは、互いに逆向きの垂直抗力であるので、それらの大きさを同じ量だけ増加させても、Ｎ_naとＮ_nbとの総和は変化しない。
そこで、Ｓ０９の判断結果が肯定的となる場合には、外力目標生成部２７は、次に、Ｓ１１の処理を実行する。このＳ１１では、外力目標生成部２７は、対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさの増加量ＩＮ_nを、前記第２必要条件を満足させ得るように決定する。
具体的には、外力目標生成部２７は、対向仮想面Ｓna，Ｓnbのうちの、Ｓ０７の判断結果が否定的となった対向仮想面において、その仮想面摩擦力成分F_i（＝Ｆ_na又はＦ_nb）の大きさから、Ｓ０７の判断処理で用いた摩擦力上限値（＝μ_i＊｜Ｎ_i｜）を差し引いたものを、摩擦係数μ_iで除算してなる値を、上記増加量ＩＮ_nとして算出する。
すなわち、外力目標生成部２７は、次式０１により、増加量ＩＮ_nを算出する。

ＩＮ_n＝（｜Ｆ_i｜−μ_i＊｜Ｎ_i｜）／μ_i ……式０１

次いで、外力目標生成部２７は、Ｓ１３の処理を実行する。このＳ１３では、外力目標生成部２７は、対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分Ｎ_na，Ｎ_nbをそれぞれ、上記の如く決定した増加量ＩＮ_nだけ、Ｓ０５の処理で決定した値の大きさよりも増加させ、その増加後の値を改めて、対向仮想面Ｓna，Ｓnbのそれぞれの仮想面垂直抗力成分Ｎ_na，Ｎ_nbとして決定する。
このＳ１３までの処理によって、第１Ａ必要条件、第１Ｂ必要条件及び第２必要条件を満足する仮想面必要並進力が決定されることとなる。
次いで、外力目標生成部２７は、Ｓ１５の処理を実行する。このＳ１５では、外力目標生成部２７は、Ｓ１３で大きさを増加させた仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさのうちの小さい方の大きさ（＝ｍｉｎ（｜Ｎ_na｜，｜Ｎ_nb｜））があらかじめ設定された所定値ＩＦＣ_n以下になるという第３必要条件を満足するか否かを判断する。
ここで、ｍｉｎ（｜Ｎ_na｜，｜Ｎ_nb｜）は、ロボット１の全体の並進運動に寄与しない内力に相当するものである。このような内力は、その大きさが大きくなると、ロボット１の関節アクチュエータ１１が発生可能な動力（駆動トルク）のうち、該内力を発生させるために必要な負担分が増大し、ロボット１の所望の運動を行なうための利用し得る関節アクチュエータ１１の動力（ロボット１の全体の並進運動を変化させるために利用し得る動力）が不足し易くなる。そこで、本実施形態では、この内力を所定値ＩＦＣ_n以下に制限するために、Ｓ１５の判断処理を実行する。
なお、この所定値ＩＦＣ_n（以降、内力上限値ＩＦＣ_nという）は、例えば対向仮想面Ｓna，Ｓnbにより発生する内力の向き（対向仮想面Ｓna，Ｓnbの法線方向）に応じて設定される。ただし、内力上限値ＩＦＣ_nを、内力の向きによらずに固定的な値に設定するようにしてもよい。
このＳ１５の判断結果が肯定的である場合には、外力目標生成部２７は、Ｓ０７の判断結果が肯定的である場合と同様に、各仮想面における仮想面必要並進力（暫定値）を決定する処理を終了し、図８に示すＳ１９以降の処理を実行する。
この場合、Ｓ０７の判断結果が否定的となった仮想面を含む対向仮想面Ｓna，Ｓnaを除く各仮想面については、Ｓ０５で決定された仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとの組が、そのまま仮想面必要並進力（暫定値）として決定されることとなる。
そして、上記対向仮想面Ｓna，Ｓnaのそれぞれにおいては、Ｓ１３で増加させた仮想面垂直抗力成分Ｎ_i（Ｎ_na，Ｎ_nb）と、Ｓ０５で決定された仮想面摩擦力成分Ｆ_i（Ｆ_na，Ｆ_nb）との組が、仮想面必要並進力（暫定値）として決定されることとなる。
また、Ｓ１５の判断結果が否定的となる状況では、内力に関する第３必要条件を満足しつつ、前記補償総並進外力Ｆall_adを実現するために必要な外力をロボット１に作用させることができないか、もしくは困難となる。このため、Ｓ１５の判断結果が否定的となる場合には、外力目標生成部２７は、Ｓ０９の判断結果が否定的となる場合と同様に、Ｓ１７において、ロボット１の運動状態が不適切である（目標運動を修正等を行なう必要がある）とし、図７〜図９のフローチャートの処理を中止する。
補足すると、本実施形態では、Ｓ０１で設定される仮想面が互いに平行な対向仮想面Ｓna，Ｓnb（ｎ＝１又は２又は３）を含む場合に、Ｓ０５の処理で決定される対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分Ｎ_na，Ｎ_nbのうちの一方は“０”であるので、これらのＮ_na，Ｎ_nbの組は常に前記第３必要条件を満足する。従って、Ｓ０７の判断結果が肯定的である場合に、Ｓ１５の判断処理を行う必要は無い。
以上のＳ０５〜Ｓ１５の処理によって、Ｓ０９又はＳ１５の判断結果が否定的となる場合（ロボット１の運動状態が不適切である場合）を除いて、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足するように、各仮想面の仮想面必要並進力（暫定値）を構成する仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとの組が決定されることとなる。これにより、第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足しつつ、ロボット１の目標運動におけるロボット１の全体の並進運動（全体重心点の並進運動）を実現するための必要総並進外力Ｆallに並進外力補償量Ｆadを付加してなる補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（暫定値）が決定されることとなる。
従って、本実施形態では、Ｓ１３までの処理によって、第１Ａ必要条件、第１Ｂ必要条件及び第２必要条件を満足する仮想面必要並進力を決定した上で、Ｓ１５の判断処理によって、再度、ロボット１の運動状態が評価される。そして、このＳ１５の判断結果が否定的となる場合に、ロボット１の運動状態が不適切であると評価されることとなる。
また、Ｓ０７、Ｓ０９、Ｓ１５の判断結果がいずれも肯定的となる場合には、第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足し得る仮想面必要並進力を決定できることとなるので、ロボット１の運動状態は、少なくとも前記補償総並進外力を支障なく実現し得るように、ロボット１に外力を作用させることができる適切な運動状態であると言えることとなる。
ロボット１の目標運動が前記壁登り歩容である場合には、以上説明したＳ０５〜Ｓ１５の処理によって仮想面垂直抗力成分Ｎ_i及び仮想面摩擦力成分Ｆ_iは例えば、次のように決定されることとなる。
例えば、前記壁登り歩容のうちの図３（ｂ）に示す動作状態の時刻t2において、Ｓ０５の処理によって、前記した図１１（ａ）に示した如く、各仮想面における仮想面垂直抗力成分Ｎ_i及び仮想面摩擦力成分Ｆ_i（ｉ＝3a，2a，2b）が決定された場合を想定する。この場合、仮想面Ｓ3aにおける仮想面摩擦力成分Ｆ_3aと、仮想面Ｓ2aにおける仮想面摩擦力成分Ｆ_2aとが、前記第２必要条件を満たしている場合（Ｓ０７の判断結果が肯定的になる場合）には、Ｓ１５までの処理によって最終的に決定される、各仮想面における仮想面必要並進力(Ｎ_i，Ｆ_i)は、Ｓ０５で決定されたものに一致する。
一方、例えば、仮想面Ｓ2aにおける仮想面摩擦力成分Ｆ_2aが前記第２必要条件を満たしていない場合には、図１１（ｂ）に示す如く、該仮想面Ｓ2aを含む対向仮想面Ｓ2a，Ｓ2bのそれぞれの仮想面垂直抗力成分Ｎ_2a，Ｎ_2bが、Ｓ０５で決定された値よりも、Ｓ１１で決定される増加量ＩＮ_2だけ増加してなる値に決定される。また、仮想面Ｓ3aの仮想面垂直抗力成分Ｎ_3a及び仮想面摩擦力成分Ｆ_3aと、仮想面Ｓ2a，Ｓ2bのそれぞれの仮想面摩擦力成分Ｆ2a，Ｆ2bの大きさは、Ｓ０５で決定された値と同じ値に決定される。
補足すると、本実施形態では、Ｓ０１で設定される仮想面が互いに平行な２つの対向仮想面Ｓna，Ｓnb（ｎ＝１又は２又は３）を含む場合に、Ｓ０５の処理によって、一方の対向仮想面Ｓna又はＳnbの仮想面垂直抗力成分及び仮想面摩擦力成分はいずれも常に“０”に決定される。但し、Ｓ０５の処理において、補償総並進外力Ｆall_adが対向仮想面Ｓna，Ｓnbに垂直な成分を有する場合に、前記第１Ａ必要条件及び第３必要条件を満足する範囲で、両方の対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分を“０”でない値に決定してもよい。そして、この場合において、補償総並進外力Ｆall_adが全ての仮想面に平行な成分を有する場合に、前記第１Ｂ必要条件を満足する範囲内で両方の対向仮想面Ｓna，Ｓnbの仮想面摩擦力成分を“０”でない値に設定するようにしてもよい。
なお、Ｓ０５の処理において、上記の如く、両方の対向仮想面Ｓna，Ｓnbの仮想面摩擦力成分を“０”でない値に設定するようにした場合には、その両方の対向仮想面Ｓna，Ｓnbにおいて、Ｓ０７の判断結果が否定的となる場合もあり得る。このような場合には、対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分の増加量ＩＮ_nは、例えば次のように決定することができる。すなわち、各対向仮想面Ｓna，Ｓnb毎に、前記したＳ１１の処理によって暫定的に増加量ＩＮ_nを算出し、それらの暫定的な増加量ＩＮ_nのうちの大きい方を、対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分の増加量ＩＮ_nとして決定する。
以上説明したＳ１５までの処理において、Ｓ０７又はＳ１５の判断結果が肯定的である場合（各仮想面における適切な仮想面必要並進力（暫定値）が決定された場合）には、外力目標生成部２７は、次に、図８のフローチャートに示すＳ１９の処理を実行する。このＳ１９では、外力目標生成部２７は、Ｓ１５までに決定された仮想面必要並進力（暫定値）を各仮想面における仮想面上暫定外力作用点に作用させた場合（各仮想面における外力作用点を仮想面上暫定外力作用点に一致させた場合）に、該仮想面必要並進力によって前記モーメント基準点周りに発生するモーメントである仮想面必要並進力依存モーメントＭsを算出する。
ここで、上記仮想面上暫定外力作用点は、前記目標運動生成部２５で生成された今回時刻での各接触対象面上の暫定外力作用点を、あらかじめ定められた所定の規則に従って、該接触対象面に対応する仮想面上に投影してなる該仮想面上の外力作用点である。
この場合、本実施形態では、上記投影のための規則は次のように設定されている。すなわち、図１２に示す如く、ある接触対象面上の外力作用点を点Ｐr_i、該接触対象面に対応する仮想面上の外力作用点を点Ｐs_iとしたとき、仮想面上の外力作用点Ｐs_iは、例えば、接触対象面上の外力作用点Ｐr_iを通って、仮想面に垂直な直線（外力作用点Ｐr_iから仮想面への垂線）が該仮想面と交わる点に一致するものとされる。
上記仮想面上暫定外力作用点は、このような規則に従って、今回時刻での各接触対象面上の暫定外力作用点を該接触対象面に対応する仮想面上に投影してなる該仮想面上の外力作用点である。
Ｓ１９の処理では、外力目標生成部２７は、上記の如く決定される仮想面上暫定外力作用点の前記モーメント基準点に対する位置ベクトルを用いて、次式０３によって、各仮想面の仮想面上暫定外力作用点に仮想面必要並進力（Ｎ_i，Ｆ_i）が作用した場合に、前記モーメント基準点の周りに発生する仮想面必要並進力依存モーメントＭsを算出する。

Ｍs＝Σ(Irp_i＊Ｎ_i)＋Σ((Irp_i＋Poff_i)＊Ｆ_i) ……式０３

この式０３におけるIrp_iは、各仮想面（今回時刻のＳ０１で設定された各仮想面）の仮想面上暫定外力作用点の前記モーメント基準点に対する位置ベクトル、Poff_iは仮想面上暫定外力作用点に対する接触対象面上の暫定外力作用点の位置ベクトル（又は該位置ベクトルのうちの仮想面に垂直な方向の成分ベクトル）である。
さらに、(Irp_i＊Ｎ_i)は、各仮想面における仮想面上暫定外力作用点の位置ベクトルＩrp_iと仮想面垂直抗力成分Ｎ_iとのベクトル積、すなわち、Ｎ_iが仮想面暫定外力作用点に作用した場合にモーメント基準点周りに発生するモーメントである。
そして、Σ(Irp_i＊Ｎ_i)は、各仮想面毎のモーメント(Irp_i＊Ｎ_i)の、全ての仮想面（今回時刻のＳ０１で設定される全ての仮想面）についての総和、すなわち、各仮想面における仮想面垂直抗力成分Ｎ_iに起因してモーメント基準点周りに発生するトータルのモーメントを意味する。
また、((Irp_i＋Poff_i)＊Ｆ_i)は、各仮想面における仮想面上暫定外力作用点の位置ベクトルＩrp_iと仮想面摩擦力成分Ｆ_iとのベクトル積（Ｉrp_i＊Ｆ_i）、すなわち、Ｆ_iが仮想面暫定外力作用点に作用した場合にモーメント基準点周りに発生するモーメントと、仮想面上暫定外力作用点に対する接触対象面上の暫定外力作用点の位置ベクトルPoff_iとＦ_iとのベクトル積（Poff_i＊Ｆ_i）、すなわち、Ｆ_iが接触対象面上の暫定外力作用点の周りに発生するモーメントとの総和のモーメントである。
そして、Σ((Irp_i＋Poff_i)＊Ｆ_i)は、各仮想面毎のモーメント((Irp_i＋Poff_i)＊Ｆ_i)の、全ての仮想面（今回時刻のＳ０１で設定される全ての仮想面）についての総和、すなわち、各仮想面における仮想面摩擦力成分Ｆ_iに起因してモーメント基準点周りに発生するトータルのモーメントを意味する。
ここで、上記モーメント（Poff_i＊Ｆ_i）に関して補足すると、接触対象面とこれに対応する仮想面とは、一般には同一面とはならないので、多くの場合、図１２に示したように、接触対象面上の外力作用点Ｐr_iとこれに対応する仮想面上の外力作用点Ｐs_iとの位置ずれが生じる。そして、このような状況で、各仮想面における仮想面必要並進力が仮想面上暫定外力作用点に作用した場合にモーメント基準点周りに発生するモーメントと、該仮想面必要並進力と同じ並進力が該仮想面に対応する接触対象面上の暫定外力作用点に作用した場合にモーメント基準点周りに発生するモーメントとを比較すると、それらのモーメントには、上記位置ずれに起因する差異が生じる。この場合、接触対象面とこれに対応する仮想面とは、それらの法線方向が概ね同方向となるので、各仮想面毎の上記差異は、主に、仮想面摩擦力成分Ｆ_iに依存するものとなり、上記モーメント（Poff_i＊Ｆ_i）にほぼ一致する。
そこで、本実施形態では、上記位置ずれの影響を補償して、Ｍsの信頼性を高めるために、上記モーメント（Poff_i＊Ｆ_i）を付加した式０３によって、仮想面必要並進力依存モーメントＭsを算出するようにしている。
なお、接触対象面上の暫定外力作用点と、これに対応する仮想面上暫定外力作用点との位置ずれが十分に微小なものとなる場合には、式０３から、上記モーメント（Poff_i＊Ｆ_i）の項を省略した式によって、仮想面必要並進力依存モーメントＭsを算出するようにしてもよい。
以上のＳ１９の処理を、ロボット１の目標運動が前記壁登り歩容である場合に関して例示的に説明すると、例えば図１１（ｂ）に示した如く、仮想面必要並進力が決定された状況においては、図中に示す仮想面垂直抗力成分Ｎ_2a，Ｎ_2b，Ｎ_3aと仮想面摩擦力成分Ｆ_2a，Ｆ_3aとによって、モーメント基準点（例えば仮想面Ｓ2aとＳ3aとの交線上の点）の周りに発生するモーメントＭsが上記式０３によって算出されることとなる。この場合、図１１（ｂ）に示す例では、仮想面Ｓ2a，Ｓ2b，Ｓ3aは、それぞれ接触対象面ＷＬ１，ＷＬ２，ＦＬに一致（又はほぼ一致）するので、式０３における各仮想面Ｓ2a，Ｓ2b，Ｓ3a毎のPoff_i（Poff_2a，Poff_2b，Poff_3a）はいずれも“０”でよい。
次いで、外力目標生成部２７は、モーメント補償量を決定するための処理であるＳ２１〜Ｓ３７の処理を実行する。ここで、この処理の概要を説明しておく。
上記の如くＳ１９で算出された仮想面必要並進力依存モーメントＭsが、仮に、Ｓ０４で算出した補償総モーメント外力Ｍall_adに一致もしくはほぼ一致するような場合には、Ｓ１５までの処理で決定された仮想面必要並進力（暫定値）と、目標運動生成部２５で生成された暫定外力作用点に対応する仮想面上暫定外力作用点とは、ロボット１全体の並進運動に係わる補償総並進外力Ｆall_adを実現できるだけでなく、ロボット１全体の回転運動（モーメント基準点周りの角運動量を変化させる運動）に係わる補償層モーメント外力Ｍall_adをも実現し得る外力として機能し得るものとなる。
しかるに、Ｓ１５までの処理では、ロボット１全体の回転運動に関する動力学については考慮されていないので、一般には、補償総モーメント外力Ｍall_adと仮想面必要並進力依存モーメントＭsとの偏差（以下、モーメント偏差errＭという）は“０”もしくはそれに近い値とはならない。
Ｓ２１〜Ｓ３７の処理によって決定するモーメント補償量は、このモーメント偏差errＭを解消する（“０”に近づける）ための操作量（外力に関する目標の操作量）である。
本実施形態では、Ｓ２１〜Ｓ３７の処理によって決定するモーメント補償量には、３種類の補償量（第１〜第３補償量）があり、その第１補償量は、１つ以上の仮想面における仮想面上外力作用点の位置の修正量（仮想面上暫定外力作用点からの修正量。以降、仮想面上外力作用点修正量ということがある）により構成されるモーメント補償量である。この場合、第１補償量は、この第１補償量による修正後の仮想面上外力作用点に対応する接触対象面上の外力作用点が、前記存在許容領域内に存在するように決定される補償量である。
また、第２補償量は、２つ以上の仮想面における仮想面必要並進力（暫定値）の仮想面摩擦力成分の修正量（以降、仮想面摩擦力成分修正量ということがある）から構成されるモーメント補償量である。この場合、第２補償量は、それを構成する仮想面摩擦力成分修正量の総和（合力）が“０”となるように決定される補償量である。
また、第３補償量は、１つ以上の仮想面に垂直な軸周りのモーメント外力として該仮想面からロボット１に付加的に作用させるねじり力（以降、仮想面ねじり力ということがある）から構成されるモーメント補償量である。
なお、上記第２補償量が、２つ以上の仮想面における仮想面摩擦力成分修正量から構成されるのは、該第２補償量による修正後における仮想面必要並進力の合力が前記第１必要条件を満足する必要があるからである。
ここで、上記第１〜第３補償量のうち、第１補償量は、Ｓ１５までの処理で決定した仮想面必要並進力（暫定値）の修正を必要とせずに、前記モーメント偏差を解消し、又は低減する機能を有する。従って、第１補償量によって、前記モーメント偏差を解消できるときには、目標運動を実現するための今回時刻での仮想面必要並進力として、Ｓ１５までの処理で決定した仮想面必要並進力（暫定値）をそのまま使用することができる。
一方、前記第２補償量又は第３補償量は、仮想面からロボット１に作用させる外力に、仮想面摩擦力成分修正量、又は仮想面ねじり力を追加的に付加するものであるから、該仮想面で発生可能な摩擦力の限界の制約を受ける。そして、その制約を満たすために、対向仮想面Ｓna，Ｓnb（ｎ＝１又は２又は３）における仮想面垂直抗力成分Ｎ_na，Ｎ_nbの修正（ひいては、前記内力の修正）が必要となる場合もある。さらに、これらの仮想面垂直抗力成分Ｎ_na，Ｎ_nbの修正に起因して、一般には、前記モーメント基準点周りに発生するモーメントＭsも変化する。
そこで、本実施形態では、外力目標生成部２７は、前記モーメント偏差errＭを解消するためのモーメント補償量として、第１〜第３補償量のうちの第１補償量を優先的に決定する。そして、外力目標生成部２７は、この第１補償量によってモーメント偏差を解消できない場合（より詳しくは、モーメント偏差errＭの全体を解消し得るように第１補償量を決定した場合に、その第１補償量による修正後の仮想面上外力作用点に対応する接触対象面上の外力作用点が前記存在許容領域を逸脱する場合）に、第１補償量を制限する。さらに、モーメント偏差errＭのうち、制限した第１補償量により解消できない部分を第２補償量及び第３補償量によって解消するように、第２補償量及び第３補償量の組を決定する。
以上が、Ｓ２１〜Ｓ３７の処理（モーメント補償量の決定処理）の概要である。
以下、このモーメント補償量の決定処理を具体的に説明すると、外力目標生成部２７は、まず、Ｓ２１の処理を実行する。このＳ２１では、外力目標生成部２７は、Ｓ０４で算出した補償総モーメント外力Ｍall_adと、Ｓ１９で算出した仮想面必要並進力依存モーメントＭsとの偏差であるモーメント偏差errM（＝Ｍall_ad−Ｍs）を算出する。
次いで、外力目標生成部２７は、Ｓ２３の処理を実行する。このＳ２３では、外力目標生成部２７は、仮想面上外力作用点の位置の変化（仮想面上暫定外力作用点からの変化）に対する仮想面必要並進力依存モーメントＭsの変化の感度を表現するヤコビアンＪを算出する。
ここで、各仮想面上の外力作用点の位置の変化量（ベクトル）をΔrp_i、各仮想面上の外力作用点を仮想面上暫定外力作用点からΔrp_iだけ変化させたときの、接触対象面上の外力作用点（仮想面上の外力作用点を通って該仮想面に垂直な直線が該接触対象面と交わる点）の位置の変化量（ベクトル）をΔPoff_i、各仮想面上の外力作用点を仮想面上暫定外力作用点からΔrp_iだけ変化させたときの仮想面必要並進力依存モーメントＭsの変化量（ベクトル）をΔＭsとおく。このとき、前記式０３に基づいて、次式０５の関係式が得られる。

ΔＭs＝Σ(Δrp_i＊(Ｎ_i＋Ｆi_)＋ΔPoff_i＊Ｆ_i) ……式０５

この場合、ΔPoff_iは、Δrp_iの関数値（詳しくは、仮想面とこれに対応する接触対象面との間の姿勢差（空間的な角度差）と、Δrp_iとから一義的に規定される値）となるので、式０５は、次式０７に書き換えることができる。

ΔＭs＝Ｊ＊（Δrp_i） ……式０７

この式０７における（Δrp_i）は、全ての仮想面（今回時刻のＳ０１で設定した全ての仮想面）に係わるΔrp_iを成分とする縦ベクトルである。そして、式０７におけるＪが、仮想面上外力作用点の位置の変化（仮想面上暫定外力作用点の位置からの変化）に対する仮想面必要並進力依存モーメントＭsの変化の感度を表現するヤコビアン（行列）である。
そこで、Ｓ２３の処理では、外力目標生成部２７は、各仮想面の仮想面必要並進力Ｎ_i，Ｆ_iと、式０５とに基づいてヤコビアンＪを算出する。なお、この場合、ΔPoff_iと、Δrp_iとの間の関係は、各仮想面とこれに対応する接触対象面との姿勢差に基づいて決定される。
次いで、外力目標生成部２７は、Ｓ２５の処理を実行する。このＳ２５処理は、式０７のΔＭsをＳ２１で算出したモーメント偏差errＭに一致させた場合に、式０７の関係を満たす（Δrp_i）を、errＭを解消するための各仮想面における仮想面上外力作用点修正量Δrpc_iの組として算出する処理である。
ここで、式０７におけるヤコビアンＪは、一般には正則行列ではない。そこで、外力目標生成部２７は、Ｓ２３で求めたヤコビアンＪの擬似逆行列Ｊinvを算出し、この擬似逆行列Ｊinvを、モーメント偏差errＭに乗じることによって、各仮想面の仮想面上外力作用点修正量Δrpc_iを算出する。この場合、擬似逆行列Ｊinvは、例えば、各仮想面に対応するΔrpc_iの二乗値又は絶対値の平均値が最小になるように決定される。
なお、例えば、各仮想面に対応する接触対象面における外力作用点の存在許容領域の面積等に応じて、各仮想面に対応するΔrpc_iの重み付けをしておき、各仮想面に対応するΔrpc_iの二乗値又は絶対値の重み付き平均値が最小になるように擬似逆行列Ｊinvを決定するようにしてもよい。
次いで、外力目標生成部２７は、Ｓ２７の処理を実行する。このＳ２７では、外力目標生成部２７は、各仮想面上の外力作用点の位置を、仮想面上暫定外力作用点の位置Irp_iからＳ２５で求めたΔrpc_iによって修正した場合に、全ての仮想面において、その修正後の仮想面上外力作用点の位置（Irp_i＋Δrpc_i）が、外力作用点存在領域条件を満足するか否かを判断する。
ここで、上記外力作用点存在領域条件は、Δrpc_iによる修正後の各仮想面の仮想面上外力作用点の位置が、目標運動生成部２５で生成された今回時刻での各接触対象面の外力作用点の存在許容領域に対応する仮想面上の存在許容領域（該接触対象面上の外力作用点の存在許容領域を仮想面上に投影してなる領域）内に存在するという条件である。この場合、接触対象面上の外力作用点の存在許容領域の、仮想面上への投影は、図１２に示す如く、接触対象面上の外力作用点の仮想面上への投影の場合と同様に行なわれる。
なお、外力作用点存在領域条件は、Δrpc_iによる修正後の各仮想面の仮想面上外力作用点を、該仮想面に対応する接触対象面に逆投影してなる点が、該接触対象面上の外力作用点の存在許容領域内に存在するという条件と等価である。
Ｓ２７の判断結果が肯定的である場合には、Ｓ１５までの処理で決定された各仮想面の仮想面必要並進力を修正せずとも、各仮想面の外力作用点の位置を仮想面上暫定外力作用点から修正する（ひいては各接触対象面の外力作用点の位置を暫定外力作用点から修正する）だけで、前記モーメント偏差errＭを解消できることとなる。
そこで、この場合には、外力目標生成部２７は、Ｓ２９の処理を実行し、今回時刻での図７〜図９のフローチャートの処理を終了する。このＳ２９の処理では、外力目標生成部２７は、今回時刻での各接触対象面からロボット１への目標外力と目標外力作用点とを確定する。
具体的には、外力目標生成部２７は、Ｓ１５までの処理で決定した各仮想面における仮想面必要並進力（Ｎ_i，Ｆ_i）を、該仮想面とこれに対応する接触対象面との姿勢差に応じて、該接触対象面からロボット１に作用させる並進力に変換し、この並進力を目標外力の構成要素である並進外力の目標値として決定する。
この場合、各仮想面毎の上記変換は、例えば次のように行なわれる。すなわち、外力目標生成部２７は、各仮想面の姿勢（法線ベクトルの向き）を該仮想面に対応する接触対象面の姿勢（法線ベクトルの向き）に変換する回転変換行列Ｒθを、これらの仮想面と接触対象面との姿勢差に基づき算出する。そして、外力目標生成部２７は、この回転変換行列Ｒθを仮想面必要並進力（ベクトル）に乗じることによって、該仮想面必要並進力を、接触対象面からロボット１への並進外力の目標値に変換する。
従って、本実施形態では、各接触対象面からロボット１に作用させるべき並進外力の目標値（目標並進力）は、該接触対象面に対応する仮想面における仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとそれぞれ同じ大きさの垂直抗力成分（接触対象面に垂直な成分）と摩擦力成分（接触対象面に平行な成分）とから構成される並進外力として決定される。
また、外力目標生成部２７は、Ｓ２５で決定したΔrpc_iをモーメント補償量として確定する。そして、外力目標生成部２７は、このΔrpc_iによる修正後の各仮想面の仮想面上外力作用点を、該仮想面に対応する接触対象面上に逆投影してなる点（本実施形態では、修正後の仮想面上外力作用点を通って該仮想面に垂直な直線が、該仮想面に対応する接触対象面と交わる点）を、該接触対象面上の目標外力作用点として決定する。
なお、Ｓ２９の処理では、目標外力の構成要素のうちの、各接触対象面のねじり力の目標値（目標ねじり力）は、いずれの接触対象面についても“０”とされる。
一方、前記Ｓ２７の判断結果が否定的である場合には、モーメント偏差errＭを解消するための各仮想面における仮想面上外力作用点修正量Δrpc_iを、前記外力作用点存在領域条件を満足するように制限する必要がある。
そこで、外力目標生成部２７は、次に、Ｓ３１の処理を実行する。このＳ３１では、外力目標生成部２７は、外力作用点存在領域条件を満足するように、各仮想面における仮想面上外力作用点修正量Δrpc_iを制限してなる仮想面上外力作用点制限修正量Δrpc_lim_iを第１補償量として決定する。
この場合、外力作用点存在領域条件を満足する仮想面については、Ｓ２５で決定された修正量Δrpc_iがそのまま、仮想面上外力作用点制限修正量Δrpc_lim_iとして決定される。
一方、外力作用点存在領域条件を満足しない仮想面については、外力目標生成部２７は、次のように仮想面上外力作用点制限修正量Δrpc_lim_iを決定する。
図１３を参照して、修正前の仮想面上外力作用点（接触対象面上の暫定外力作用点を仮想面上に投影してなる点）をＰs1_i、この修正前の仮想面上外力作用点Ｐs1_iをＳ２５で決定した仮想面上外力作用点修正量Δrpc_iにより修正してなる点をＰs2_iとおく。この場合、外力作用点存在領域条件を満足しない仮想面については、修正後の仮想面上外力作用点Ｐs2_iが、図示の如く、仮想面上の外力作用点許容領域から逸脱することとなる。
なお、図１３では、図示の便宜上、仮想面上の外力作用許容領域を単純な楕円状の領域として記載しているが、その領域の形状は他の形状であってもよいことはもちろんである。
このとき、外力目標生成部２７は、上記仮想面上外力作用点制限修正量Δrpc_lim_iにより点Ｐs1_iを修正してなる点が、例えば、修正前の点Ｐs1_iとΔrpc_iによる修正後の点Ｐs2_iとを結ぶ線分上で、仮想面上の外力作用点許容領域の境界に存する点Ｐs_lim_iに一致するように、仮想面上外力作用点制限修正量Δrpc_lim_iを決定する。
なお、上記のようにΔrpc_lim_iを決定することに代えて、例えば、仮想面上外力作用点制限修正量Δrpc_lim_iにより点Ｐs1_iを修正してなる点が、仮想面上の外力作用点許容領域の境界にする点のうち、Δrpc_iによる修正後の点Ｐs2_iに最も近い点（点Ｐs2_iとの距離が最小となる点）に一致するように、仮想面上外力作用点制限修正量Δrpc_lim_iを決定してもよい。
以降の説明では、上記の如くＳ３１で決定される仮想面上外力作用点制限修正量Δrpc_lim_iによる修正後の各仮想面上の外力作用点を、仮想面上制限修正後外力作用点という。
以上の如くＳ３１の処理を実行した後、外力目標生成部２７は、Ｓ３３の処理を実行する。このＳ３３では、外力目標生成部２７は、前記モーメント偏差errＭのうち、Ｓ２９で決定した各仮想面における仮想面上外力作用点制限修正量Δrpc_lim_iによって解消できない偏差成分としての残偏差成分errＭ'を算出する。
具体的には、外力目標生成部２７は、制限前の仮想面上外力作用点修正量Δrpc_iと仮想面上外力作用点制限修正量Δrpc_lim_iとの差（＝Δrpc_i−Δrpc_lim_i）である仮想面上外力作用点修正誤差Δrpc_err_iを算出する。そして、外力目標生成部２７は、前記式０５におけるΔrp_iを、Δrpc_err_iに置き換えてなる次式０９によって、残偏差成分errＭ’を算出する。

errＭ'＝Σ(Δrpc_err_i＊(Ｎ_i＋Ｆi_)＋ΔPoff_i＊Ｆ_i) ……式０９

この場合、式０９におけるΔPoff_iは、Δrpc_err_iに応じて決定される値であり、前記式０５におけるΔPoff_iとΔrp_iとの間の関係に従って、Δrp_i＝Δrpc_err_iとしたときの、ΔPoff_iの値として決定される。
なお、例えば、前記式０５のΔrp_iを、Δrpc_limt_iに置き換えた式によって算出されるモーメント変化量ΔＭs、すなわち、各仮想面上の外力作用点の位置を仮想面上暫定外力作用点からΔrpc_limt_iだけ修正した場合に生じるモーメント基準点周りのモーメント変化量を算出し、このモーメント変化量をモーメント偏差errＭから差し引くことによって、残偏差成分errＭ'を算出するようにしてもよい。この場合、ΔPoff_iは、前記式０５におけるΔPoff_iとΔrp_iとの間の関係に従って、Δrp_i＝Δrpc_limt_iとしたときの、ΔPoff_iの値として決定すればよい。
以上の如くerrＭのうちの残偏差成分errＭ'を算出した後、次に、外力目標生成部２７は、図９に示すＳ３５、Ｓ３７の処理を順次実行することによって、第２補償量としての前記仮想面摩擦力成分修正量ｆ_iと第３補償量としての仮想面ねじり力Ｒ_iとを決定する。
Ｓ３５では、各仮想面（Ｓ０１で設定した各仮想面）に任意の値の前記仮想面摩擦力成分修正量ｆ_iと前記仮想面ねじり力Ｒ_iとを付加した場合（Δrpc_lim_iによる修正後の仮想面上制限修正後外力作用点にｆ_iとＲ_iを追加的に作用させた場合）にそれらのｆ_i，Ｒ_iによって前記モーメント基準点周りに発生するモーメントＭfrと、ｆ_i，Ｒ_iとの間の関係を次式１１により表現するヤコビアン（行列）Ｊfrを算出する。

Ｍfr＝Ｊfr＊(f_i R_i)T ……式１１

この式１１における(f_i R_i)Tは、ｆ_i及びＲ_iを成分とする縦ベクトルである。ここで、前記仮想面摩擦力成分修正量ｆ_iは、それらの総和（合力）が“０”になるように決定されるべきモーメント補償量である。
従って、仮想面摩擦力成分修正量ｆ_iのうち、任意の１つの仮想面に対応する仮想面摩擦力成分修正量は、他の残りの仮想面摩擦力成分修正量の総和の符号を反転させてなる並進力として一義的に定まる。このため、式１１における縦ベクトル(f_i R_i)Tの成分としてのｆ_iは、任意の１つの仮想面に対応するｆ_i（以降、これをｆ_i0とおく）を除いたものである。そして、ヤコビアンＪfrは、ｆ_i0が他のｆ_iの総和の符号を反転させてなる並進力であるとして、この並進力によるモーメント基準点周りのモーメント成分が式１１の右辺の演算により算出されるＭfrに含まれるように決定される。
次いで、Ｓ３７では、外力目標生成部２７は、式１１のＭfrを残偏差成分errＭ'に一致させた場合に、式１１の関係を満たすｆ_i及びＲ_iの組(f_i R_i)Tを算出する。
ここで、式１１におけるヤコビアンＪfrは、一般には正則行列ではないので、外力目標生成部２７は、Ｓ３７で求めたヤコビアンＪfrの擬似逆行列Ｊfr_invを算出し、この擬似逆行列Ｊfr_invを、残偏差成分errＭ'に乗じることによって、ｆ_i及びＲ_iの組を算出する。この場合、擬似逆行列Ｊfr_invは、例えば、式１１の縦ベクトル(f_i R_i)Tを組成するｆ_i及びＲ_iのそれぞれの２乗値又は絶対値の平均値が最小になるように決定される。なお、上記ｆ_i0は、上記の如く算出したｆ_iの総和の符号を反転させてなる値として決定される。
補足すると、上記擬似逆行列Ｊfr_invは、例えば、式１１の縦ベクトル(f_i R_i)Tを組成するｆ_i及びＲ_iのそれぞれの２乗値又は絶対値の重み付き平均値が最小になるように決定してもよい。例えば、前記摩擦力上限値が大きい仮想面ほど、その仮想面におけるｆ_iの大きさが相対的に大きくなるように、各ｆ_iに対応する重みを設定し、その重みを用いた上記重み付き平均値が最小になるように、Ｊfr_invを決定するようにしてもよい。
また、例えば、Ｓ０１で設定された仮想面が対向仮想面Ｓna，Ｓnbを含む場合において、仮想面垂直抗力成分Ｎ_iの大きさが小さい方の対抗仮想面Ｓna又はＳnbにおける仮想面摩擦力成分修正量ｆ_na又はｆnbを“０”に設定するようにしてもよい。
前記目標運動が、前記壁登り歩容である場合においては、上記Ｓ３５、Ｓ３７の処理は、例えば次にように行なわれる。
例えば、図１１（ｂ）に示した動作状態において、モーメント偏差errＭのうちの残偏差成分errＭ'が存在する場合を想定する。そして、床面ＦＬ及び壁面ＷＬ１，ＷＬ２にそれぞれ対応する各仮想面Ｓ3a，Ｓ2a，Ｓ2bにおける仮想面上制限修正後外力作用点の位置ベクトル（モーメント基準点に対する位置ベクトル）をそれぞれrp_3a，rp_2a，rp_2bとおく。このとき、各仮想面Ｓ3a，Ｓ2a，Ｓ2bにおける仮想面上摩擦力成分修正量ｆ_3a，ｆ_2a，ｆ_2b及び仮想面ねじり力Ｒ_3a，Ｒ_2a，Ｒ_2bと、これらのｆ_3a，ｆ_2a，ｆ_2b，Ｒ_3a，Ｒ_2a，Ｒ_2bによってモーメント基準点周りに発生するモーメントＭfrとの間の関係は、次式１１ａにより表される。

Ｍfr＝rp_3a＊ｆ_3a＋rp_2a＊ｆ_2a＋rp_2b＊ｆ_2b＋Ｒ_3a＋Ｒ_2a＋Ｒ_2b
……式１１ａ


なお、式１１ａにおける（rp_3a＊ｆ_3a），（rp_2a＊ｆ_2a），（rp_2b＊ｆ_2b）はそれぞれベクトル積である。
この場合、仮想面摩擦力成分修正量に関しては、ｆ_3a＋ｆ_2a＋ｆ_2b＝０であるから、ｆ_2b＝−(ｆ_3a＋ｆ_2a)となる。従って、式１１ａは、例えばｆ_2bを含まない次式１１ｂに書き換えられる。

Ｍfr＝（rp_3a−rp_2b）＊ｆ_3a＋（rp_2a−rp_2b）＊ｆ_2a＋Ｒ_3a＋Ｒ_2a＋Ｒ_2b
……式１１ｂ

従って、Ｓ３５では、この式１１ｂの右辺を、座標成分で表して整理することで、前記式１１におけるヤコビアンＪfrが求められることとなる。
そして、Ｓ３７では、このヤコビアンＪfrの擬似逆行列Ｊfr_invが前記した如く算出され、このＪfr_invを、残偏差成分errＭ’に乗じることによって、ｆ_3a，ｆ_2a，Ｒ_3a，Ｒ_2a，Ｒ_2bが算出される。さらに、ｆ_3a，ｆ_2aから、ｆ_2b＝−(ｆ_3a＋ｆ_2a)という関係に従って、ｆ_3bが算出される。
補足すると、例えば、前記壁登り歩容における図３（ｃ）の動作状態以降の時刻、すなわち、仮想面が対向仮想面Ｓ2a，Ｓ2bの２つだけになる状況では、式１１ａの右辺から（rp_3a＊ｆ_3a）と、Ｒ_3aとを除去してなる式と、ｆ_2a＋ｆ_2b＝０という関係とに基づいて、上記と同様に、ヤコビアンＪfrを決定することができる。
以上のＳ３７までの処理によって、前記Ｓ２７の判断結果が否定的となる場合には、前記第１Ａ必要条件及び第１Ｂ必要条件を満足し、且つ、前記補償総モーメント外力Ｍall_adを実現し得る仮想面必要並進力（ｆ_iによる修正後の仮想面必要並進力）と、仮想面上外力作用点（Δrpc_lim_iによる修正後の仮想面上外力作用点）と、仮想面上ねじり力Ｒ_iとの組が実質的に決定されることとなる。ただし、この場合、ｆ_iによる仮想面必要並進力の修正が行なわれるので、その修正後の仮想面必要並進力の仮想面摩擦力成分は、前記第２必要条件を満足するとは限らない。また、仮想面上ねじり力Ｒ_iは、それを付加する仮想面とロボット１との間の摩擦力、ひいては、該仮想面に対応する接触対象面とロボット１との間の摩擦力を必要とする。
そこで、以上の如く仮想面摩擦力成分修正量ｆ_iと仮想面ねじり力Ｒ_iとを決定した後、次に、外力目標生成部２７は、Ｓ３９の判断処理を実行する。このＳ３９では、外力目標生成部２７は、各仮想面において、ｆ_iによる修正後の仮想面摩擦力成分Ｆ_i（Ｓ１５までの処理で決定されたＦ_iとｆ_iとの総和の摩擦力成分）が、前記第２必要条件を満足するか否かを判断すると共に、Ｒ_iの大きさが、仮想面垂直抗力成分Ｎ_iの大きさに応じて設定される所定の上限値以下になるという第４必要条件を満足するか否かを判断する。
ここで、上記第４必要条件における所定の上限値は、Ｒ_iを付加する仮想面の摩擦力によって発生可能なねじり力の大きさの上限値として、各仮想面毎に設定される値である。この上限値（以降、ねじり力上限値という）は、本実施形態では、各仮想面に対応する接触対象面の性状に関する環境情報に基づいて各仮想面毎に設定した係数μr_i（以降、ねじり力係数という）を、仮想面垂直抗力成分Ｎ_iの大きさ｜Ｎ_i｜に乗じてなる値（＝μr_i＊｜Ｎ_i｜）に設定される。
なお、本実施形態では、外力目標生成部２７の処理を開始する前に、各接触対象面に対応付ける仮想面のねじり力係数が前記環境情報に基づいて事前に決定されると共に記憶保持される。そして、Ｓ３９では、その記憶保持したねじり力係数から、Ｒ_iを付加する仮想面におけるねじり力係数が選定される。
補足すると、各仮想面におけるねじり力係数μr_iは、該仮想面に対応する接触対象面の性状に関する環境情報だけでなく、該仮想面における仮想面摩擦力成分のＦ_i大きさや、ロボット１と接触対象面との接触面の大きさ等を考慮して、ロボット１の動作中の各時刻で決定するように設定してもよい。
Ｓ３９の判断結果が肯定的である場合には、外力目標生成部２７は、Ｓ４１の処理を実行し、今回時刻での図７〜図９のフローチャートの処理を終了する。このＳ４１の処理では、外力目標生成部２７は、今回時刻での各接触対象面からロボット１の目標外力と目標外力作用点とを確定する。
具体的には、外力目標生成部２７は、Ｓ１５までの処理で決定した各仮想面における仮想面必要並進力（Ｎ_i，Ｆ_i）と、Ｓ３７の処理で決定した仮想面摩擦力成分修正量ｆ_iとから、今回時刻での各仮想面における仮想面必要並進力を確定する。この場合、Ｓ１５までの処理で決定した仮想面垂直抗力成分Ｎ_iがそのまま該仮想面における仮想面垂直抗力成分として確定されると共に、Ｓ１５までの処理で決定した仮想面摩擦力成分Ｆ_iに仮想面摩擦力成分修正量ｆ_iを加え合わせてなる摩擦力成分が、該仮想面における仮想面摩擦力成分として確定される。
なお、ｆ_i＝０となる仮想面については、結果的には、Ｓ１５までの処理で決定した仮想面必要並進力（Ｎ_i，Ｆ_i）がそのまま該仮想面における仮想面必要並進力として確定されることとなる。
また、外力目標生成部２７は、Ｓ３７の処理で決定した仮想面ねじり力Ｒ_iを、このＲ_iに対応する仮想面におけるねじり力として確定する。
そして、外力目標生成部２７は、以上の如く確定した各仮想面における仮想面必要並進力を、該仮想面とこれに対応する接触対象面との姿勢差に応じて、該接触対象面からロボット１に作用させる並進力に変換し、この並進力を目標外力の構成要素である並進外力の目標値（目標並進力）として決定する。同様に、外力目標生成部２７は、各仮想面における仮想面ねじり力を、該仮想面に対応する接触対象面からロボット１に作用させるねじり力に変換し、この変換したねじり力を、目標外力の構成要素であるねじり力の目標値（目標ねじり力）として決定する。
なお、上記変換は、図８のＳ２９の処理に関して説明した変換と同じであり、上記姿勢差に応じて決定される前記回転変換行列Ｒθを用いて行なわれる。
また、外力目標生成部２７は、Ｓ２９の処理の場合と同様に、Ｓ３１で決定した仮想面上外力作用点制限修正量Δrpc_lim_iによる修正後の各仮想面上の外力作用点を該仮想面に対応する接触対象面上に逆投影してなる点を、該接触対象面上の目標外力作用点として決定する。
一方、Ｓ３９の判断結果が否定的である場合、すなわち、第２必要条件又は第４必要条件を満足しない仮想面が存在する場合には、前記補償総モーメント外力Ｍall_adを実現する上で、その仮想面における摩擦力が不足する。この場合には、外力目標生成部２７は、次にＳ４３の処理を実行する。このＳ４３では、外力目標生成部２７は、Ｓ３９の判断処理で、第２必要条件又は第４必要条件を満たさない仮想面が、対向仮想面Ｓna又はＳnb（ｎ＝１又は２又は３）であるか否かを判断する。
このＳ４３の判断結果が否定的となる状況では、第２必要条件又は第４必要条件を満足しない仮想面における仮想面垂直抗力成分の大きさを、前記第１Ａ必要条件を満たしつつ増加させることができず、ひいては該仮想面における仮想面摩擦力成分の大きさを、前記摩擦力上限値以下で増加させることができない。そこで、この場合には、外力目標生成部２７は、Ｓ４７において、ロボット１の運動状態が不適切である（目標運動の修正等を行なう必要がある）とし、図７〜図９のフローチャートの処理を中止する。なお、この場合、外力目標生成部２７は、目標運動生成部２５にエラー情報を出力する。そして、目標運動生成部２５は、そのエラー情報に応じて、目標運動を作成し直したり、あるいは、ロボット１の運動を停止させるような目標運動を作成する。
従って、本実施形態では、Ｓ３７までの処理によって、前記Ｓ２７の判断結果が否定的となる場合には、前記第１Ａ必要条件及び第１Ｂ必要条件を満足し、且つ、ロボット１の目標運動のうちのロボット１全体の回転運動を実現し得る仮想面必要並進力（ｆ_iによる修正後の仮想面必要並進力）と、仮想面上外力作用点（Δrpc_lim_iによる修正後の仮想面上外力作用点）と、仮想面上ねじり力Ｒ_iとの組を決定した上で、Ｓ３９，Ｓ４３の判断処理によって、ロボット１の運動状態が評価される。そして、このＳ３９及びＳ４３の判断結果がいずれも否定的となる場合に、ロボット１の運動状態が不適切であると評価されることとなる。
一方、Ｓ４３の判断結果が肯定的となる状況では、第２必要条件又は第４必要条件を満たさない仮想面を含む、互いに平行な対向仮想面Ｓna，Ｓnb（ｎ＝１又は２又は３）の仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさを、前記第１Ａ必要条件を満足しつつ（Ｎ_na＋Ｎ_nbを一定に保ちつつ）、増加させることができる。
そこで、Ｓ４３の判断結果が肯定的となる場合には、外力目標生成部２７は、次に、Ｓ４５の処理を実行する。このＳ４５では、外力目標生成部２７は、対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさの増加量ＩＮ_nを、前記第２必要条件及び第４必要条件を満足させ得るように決定する。
具体的には、外力目標生成部２７は、第２必要条件を満足しない仮想面を含む対向仮想面Ｓna，Ｓnbのそれぞれにおいて、前記仮想面摩擦力成分修正量ｆ_iによる修正後の仮想面摩擦力成分Ｆ_iの大きさから、Ｓ３９の判断処理で用いた摩擦力上限値（＝μ_i＊｜Ｎ_i｜）を差し引いたものを、摩擦係数μ_iで除算してなる値（＝（｜Ｆ_i｜−μ_i＊｜Ｎ_i｜）／μ_i）を、上記増加量ＩＮ_nの候補値として算出する（以下、このように算出されたＩＮ_nの候補値を摩擦力成分補償用候補値という）。この場合、この摩擦力成分補償用候補値ＩＮ_nは、第２必要条件を満足しない仮想面を含む対向仮想面Ｓna，Ｓnbのそれぞれ毎に算出される。
例えば、ロボット１の目標運動が前記壁登り歩容である場合において、壁面ＷＬ１，ＷＬ２にそれぞれ対応する対向仮想面Ｓ2a，Ｓ2bのうちの一方又は両方がＳ３９の判断処理で第２必要条件を満足しないものとなった場合には、これらの対向仮想面Ｓ2a，Ｓ2bのぞれぞれにおいて、ＩＮ_2の摩擦力成分補償用候補値（（｜Ｆ_2a｜−μ_2a＊｜Ｎ_2a｜）／μ_2a、（｜Ｆ_2b｜−μ_2b＊｜Ｎ_2b｜）／μ_2b）が算出される。
また、外力目標生成部２７は、第４必要条件を満足しない仮想面を含む対向仮想面Ｓna，Ｓnbのそれぞれにおいて、前記仮想面ねじり力Ｒ_iの大きさから、Ｓ３９の判断処理で用いたねじり力上限値（＝μr_i＊｜Ｎ_i｜）を差し引いたものを、ねじり力係数μr_iで除算してなる値（＝（｜Ｒ_i｜−μr_i＊｜Ｎ_i｜）／μr_i）を、上記増加量ＩＮ_nの候補値として算出する（以降、このように算出されたＩＮ_nの候補値をねじり力補償用候補値という）。この場合、摩擦力成分補償用候補値と同様に、ねじり力補償用候補値ＩＮ_nは、第４必要条件を満足しない仮想面を含む対向仮想面Ｓna，Ｓnbのそれぞれ毎に算出される。
そして、外力目標生成部２７は、摩擦力成分補償用候補値及びねじり力補償用候補値のうちの摩擦力成分補償用候補値だけを算出した対向仮想面Ｓna,Ｓnbについては、各対向仮想面Ｓna，Ｓnbのそれぞれの摩擦力成分補償用候補値のうちのいずれか大きい方を、該対向仮想面Ｓna，Ｓnbにおける仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさの増加量ＩＮ_nとして決定する。
また、外力目標生成部２７は、摩擦力成分補償用候補値及びねじり力補償用候補値のうちのねじり力補償用候補値だけを算出した対向仮想面Ｓna,Ｓnbについては、各対向仮想面Ｓna，Ｓnbのそれぞれのねじり力補償用候補値のうちのいずれか大きい方を、該対向仮想面Ｓna，Ｓnbにおける仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさの増加量ＩＮ_nとして決定する。
また、外力目標生成部２７は、摩擦力成分補償用候補値及びねじり力補償用候補値の両方を算出した対向仮想面Ｓna,Ｓnbについては、各対向仮想面Ｓna，Ｓnbのそれぞれの摩擦力成分補償用候補値及びねじり力補償用候補値のうちの最も大きい候補値を、該対向仮想面Ｓna，Ｓnbにおける仮想面垂直抗力成分の増加量ＩＮ_nとして決定する。
ここで、Ｓ４５で上記の如く決定した増加量ＩＮ_nだけ対向仮想面Ｓna,Ｓnbにおける仮想面垂直抗力成分Ｎ_na，Ｎ_nbを増加させた場合、対向仮想面Ｓna,Ｓnbに直交する方向の内力が増加することとなる。また、Ｎ_na，Ｎ_nbの増加に伴い、モーメント基準点周りに発生するモーメントが一般には変化してしまう。そこで、本実施形態では、外力目標生成部２７は、Ｓ４５の処理を実行した後、図７のＳ１３からの処理を改めて実行する。
以上が、本実施形態における外力目標生成部２７の処理の詳細である。
以上説明した外力目標生成部２７の処理によって、まず、Ｓ０５〜Ｓ１５の処理によって、ロボット１全体の並進運動に係わる前記補償総並進外力Ｆall_adを実現するために必要な仮想面必要並進力（Ｎ_i，Ｆ_i）が暫定的に決定される。この場合、前記モーメント基準点周りに発生するモーメントを考慮することなく、第１必要条件（第１Ａ必要条件、第１Ｂ必要条件）、第２必要条件、及び第３必要条件を満足することを指針として、仮想面必要並進力（Ｎ_i，Ｆ_i）が暫定的に決定される。この場合、各仮想面は、その相互の姿勢関係があらかじめ定まっているので、前記補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値を簡素なアルゴリズムによって効率よく決定することができる。
また、Ｓ０７、Ｓ０９の判断結果がいずれも否定的となる場合、あるいは、Ｓ０７、Ｓ０９、Ｓ１５の判断結果がそれぞれ、否定的、肯定的、否定的となる場合に、ロボット１の運動状態が不適切であると評価され、外力目標生成部２７の処理が中止される。このため、前記補償総並進外力Ｆall_adを実現するために、接触対象面とロボット１との間の摩擦力が過大になりやすいロボット１の運動状態、あるいは、内力が過大になりやすいロボット１の運動状態を、簡素なアルゴリズムで効率よく不適切であると評価することができる。ひいては、ロボット１の運動を安定に行なうことが困難となる状況で、該ロボット１の運動を継続してしまうような事態が発生するのを防止する（例えばロボット１の運動を停止する）ことができる。
そして、上記のように補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値を決定した上で、Ｓ１９〜Ｓ３７の処理（Ｓ２９の処理を除く）によって、ロボット１全体の回転運動に係わる補償総モーメント外力Ｍ all_adを実現するための付加的な操作量（モーメント補償量）として、前記仮想面上外力作用点修正量Δｒpc_iが決定され、あるいは、前記仮想面上外力作用点制限修正量Δｒpc_lim_iと仮想面摩擦力成分修正量Δｆ_iと仮想面ねじり力Ｒ_iとの組が決定される。これらの、モーメント補償量は、それによる修正対象の修正の前後で、仮想面上必要並進力の合力を変化させることのない操作量である。
このため、Ｓ０５〜Ｓ１５の処理によって決定した仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値と、Ｓ１９〜Ｓ３７の処理（Ｓ２９の処理を除く）によって決定したモーメント補償量とを単純に組合わせるだけで、補償総並進外力Ｆall_adと補償総モーメント外力Ｍall_adとの両方を適切に実現できる仮想面上必要並進力と仮想面上ねじり力と仮想面上外力作用点との組（仮想面上ねじり力が“０”になる場合を含む）を決定することができることとなる。そして、この仮想面上必要並進力と仮想面上ねじり力と仮想面上外力作用点との組から、各接触対象面からロボット１に作用させるべき目標外力（目標並進力及び目標ねじり力）と目標外力作用点とを効率よく適切に決定できることとなる。
なお、この場合、Ｓ３９、Ｓ４３の判断結果がいずれも否定的となる場合に、ロボット１の運動状態が不適切であると評価され、外力目標生成部２７の処理が中止される。このため、補償総並進外力Ｆall_adと補償総モーメント外力Ｍall_adとを実現するために、接触対象面とロボット１との間の摩擦力が過大になりやすいロボット１の運動状態を、効率よく不適切であると評価することができる。ひいては、ロボット１の運動を安定に行なうことが困難となる状況で、該ロボット１の運動を継続してしまうような事態が発生するのを防止する（例えばロボット１の運動を停止する）ことができる。
また、本実施形態では、外力目標生成部２７の処理によって、Ｓ０９、Ｓ１５、Ｓ４３のいずれかの判断結果が否定的となる場合（ロボット１の運動状態が不適切である場合）を除いて、今回時刻での各接触対象面に対応する各仮想面における最終的な仮想面必要並進力（仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとの組）は、結果的に、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足するように決定される。
そして、各仮想面に対応する接触対象面における並進外力の目標値（目標並進力）は、その垂直抗力成分（接触対象面に垂直な成分）と摩擦力成分（接触対象面に平行な成分）とが、それぞれ、該仮想面における仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとに一致するように決定される。
このため、各接触対象面からロボット１への目標並進力は、可能な限り、各接触対象面における目標並進力のうちの垂直抗力成分の合力によって前記補償総並進外力Ｆall_adを実現すると共に、該目標並進力のうちの摩擦力成分を、該接触対象面で発生可能な摩擦力の大きさの限界内で可能な限り小さくなるように、各接触対象面からロボット１への目標並進力を決定できる。
特に、本実施形態では、モーメント補償量として、仮想面上外力作用点修正量Δｒpc_i（第１補償量）が優先的に決定される。すなわち、Ｓ２７の判断結果が肯定的となる場合には、モーメント補償量には、仮想面摩擦力成分修正量ｆ_i及び仮想面ねじり力Ｒ_iのいずれも含まれない。このため、各仮想面における仮想面摩擦力成分Ｆ_iの大きさを、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足し得る範囲内で、必要最低限の大きさに留めることができる。ひいては、各接触対象面における目標並進力の摩擦力成分の大きさも必要最低限もしくはこれと同程度に留めることができる。
また、Ｓ０１で設定される仮想面が対向仮想面Ｓna，Ｓnbを含む場合において、Ｓ２７の判断結果が肯定的となる場合はもちろん、Ｓ３９の判断結果が肯定的となる場合においても、これらの対向仮想面Ｓna，Ｓnbの間でロボット１に発生する内力の大きさ（Ｎ_na，Ｎ_nbの大きさのうちの小さい方の大きさ）を、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足し得る範囲内で、必要最低限に留めることができる。ひいては、これらの対向仮想面Ｓna，Ｓnbに対応する２つの接触対象面（例えば、前記壁登り歩容における壁面ＷＬ１，ＷＬ２）の間でロボット１に発生する内力の大きさを必要最低限もしくはこれと同程度に留めることができる。このため、ロボット１の関節アクチュエータ１１が発生可能な動力（本実施形態では駆動トルク）のうち、該内力を発生するために必要な負担分を軽減することができるように対向仮想面Ｓna，Ｓnbに対応する２つの接触対象面を含む各接触対象面における目標並進力を決定できる。
ここで、以上説明した本実施形態と本願発明との対応関係を補足しておく。本実施形態ででは、制御ユニット２１の外力目標生成部２７が本発明における目標運動評価装置としての機能を有する。
そして、この外力目標生成部２７が実行する処理のうち、Ｓ０１の処理によって、本発明における仮想面群設定手段が実現される。
また、Ｓ０２の処理によって、本発明における基本必要総並進外力決定手段が実現される。
この場合、前記必要総並進外力Ｆalllが本発明における基本必要総並進外力に相当する。
また、Ｓ０３の処理によって、本発明における並進外力補償量決定手段が実現される。この場合、本実施形態では、本発明における運動状態量として、ロボット１の全体重心点の位置が使用され、前記偏差ΔＰgが本発明における運動状態量偏差に相当する。
また、Ｓ０５の処理によって、第１Ａ必要条件と第１Ｂ必要条件とを満足するように仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ０７〜Ｓ１７の処理によって、運動状態評価手段が実現される。この場合、Ｓ０７の判断処理によって、本発明における第１判断手段が実現される。また、Ｓ０９の判断処理によって、本発明における第２判断手段が実現される。また、Ｓ１５の判断処理によって、本発明における第３判断手段が実現される。
また、本実施形態では、それを別の観点でみると、Ｓ０５〜Ｓ３７の処理（Ｓ０９又はＳ１５の判断結果が否定的となる場合を除く）によって、第１Ａ必要条件と第１Ｂ必要条件とを少なくとも満足するように（詳しくは、第１Ａ必要条件と第１Ｂ必要条件とを満足しつつ、前記補償モーメント外力を実現し得るように）、仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ３７に続く、Ｓ３９〜Ｓ４５並びにＳ１３〜Ｓ１７の処理によって、運動状態評価手段が実現される。この場合、Ｓ３９の判断処理によって、本発明における第１判断手段が実現される。また、Ｓ４３の判断処理によって、本発明における第２判断手段が実現される。また、Ｓ１５の判断処理によって、本発明における第３判断手段が実現される。
また、本実施形態では、それを別の観点でみると、Ｓ０５〜Ｓ１３の処理（Ｓ０９の判断結果が否定的となる場合を除く）によって、あるいは、Ｓ０５〜Ｓ４５の処理（Ｓ０９又はＳ１５又Ｓ４３の判断結果が否定的となる場合を除く）とこれに続くＳ１３の処理とによって、第１Ａ必要条件と第１Ｂ必要条件と第２必要条件とを満足するように仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ１５及びＳ１７の処理によって、本発明における運動状態評価手段が実現されると共に、Ｓ１５の判断処理によって、本発明における第４判断手段が実現される。
［第２実施形態］
次に本発明の第２実施形態を図１４及び図１５を参照して説明する。なお、本実施形態は、外力目標生成部２７の処理の一部だけが第１実施形態と相違するものであるので、第１実施形態と同一事項については説明を省略する。
前記第１実施形態では、前記モーメント偏差errＭを解消するためのモーメント補償量を決定する処理（Ｓ２１〜Ｓ３７の処理）において、第１補償量としての仮想面上外力作用点修正量を優先的に決定するようにした。
ただし、例えば、第２補償量としての仮想面摩擦力成分修正量ｆ_i又は第３補償量としての仮想面ねじり力Ｒ_iを、仮想面上外力作用点修正量よりも優先的に決定するようにすることも可能である。本実施形態は、このようにモーメント補償量として、第２補償量又は第２補償量を優先的に決定する場合の一例を示す実施形態である。
本実施形態では、外力目標生成部２７の処理においては、Ｓ０１〜Ｓ２１までの処理は第１実施形態と同じである。そして、本実施形態では、外力目標生成部２７は、Ｓ２１の処理（モーメント偏差errＭを算出する処理）に続いて、図１４及び図１５フローチャートに示す処理を実行する。
以下説明すると、外力目標生成部２７は、Ｓ２１の処理の次にＳ６１の処理を実行する。このＳ６１では、外力目標生成部２７は、第１実施形態で説明したＳ３５の処理と同様の処理によって、仮想面摩擦力成分修正量ｆ_i（第２補償量）及び仮想面ねじり力Ｒ_i（第３補償量）と、これらのｆ_i，Ｒ_iによってモーメント基準点周りに発生するモーメントＭfrとの関係を前記式１１により表現するヤコビアンＪfrを決定する。ただし、本実施形態では、Ｓ６１において、ｆ_i，Ｒ_iを作用させる各仮想面上の外力作用点としては、仮想面上暫定外力作用点（目標運動生成部２５で生成された接触対象面上の暫定外力作用点を該接触対象面に対応する仮想面に投影してなる点）が使用される。
次いで、外力目標生成部２７は、Ｓ６３の処理を実行する。このＳ６３では、外力目標生成部２７は、前記式１１のＭfrをＳ２１で求めたモーメント偏差errＭに一致させた場合に、ｆ_i及びＲ_iの組(f_i R_i)Tを算出する。
なお、必ずしもｆ_i及びＲ_iの両方を算出する必要はなく、いずれか一方を“０”に設定するようにしてもよい。
この場合、外力目標生成部２７は、Ｓ６１で求めたヤコビアンＪfrの擬似逆行列Ｊfr_invを、第１実施形態におけるＳ３７の処理と同様の処理によって算出し、この擬似逆行列Ｊfr_invを、モーメント偏差errＭに乗じることによって、ｆ_i及びＲ_iの組(f_i R_i)Tを算出する。これにより、errＭを解消するために必要なｆ_i及びＲ_iの組が算出される。
以上のＳ６３までの処理によって、前記第１Ａ必要条件及び第１Ｂ必要条件を満足し、且つ、ロボット１全体の回転運動（モーメント基準点周りの角運動量を変化させる回転運動）に係わる前記補償総モーメント外力を実現し得る仮想面必要並進力（ｆ_iによる修正後の仮想面必要並進力）と、仮想面上外力作用点（＝仮想面上暫定外力作用点）と、仮想面上ねじり力Ｒ_iとの組が暫定的に決定されることとなる。ただし、この場合、ｆ_iによる仮想面必要並進力の修正が行なわれるので、その修正後の仮想面必要並進力の仮想面摩擦力成分は、前記第２必要条件を満足するとは限らない。また、仮想面上ねじり力Ｒ_iも第１実施形態で説明した第４必要条件を満足するとは限らない。
そこで、外力目標生成部２７は、次に、Ｓ６５の処理を実行する。このＳ６５では、外力目標生成部２７は、第１実施形態におけるＳ３９と同じ判断処理を実行する。すなわち、外力目標生成部２７は、各仮想面において、ｆ_iによる修正後の仮想面摩擦力成分Ｆ_i（Ｓ１５までの処理で決定されたＦ_iとｆ_iとの総和の摩擦力成分）が、前記第２必要条件を満足するか否かを判断すると共に、Ｒ_iの大きさが、前記第４必要条件を満足するか否かを判断する。
そして、この判断結果が肯定的である場合には、外力目標生成部２７は、Ｓ６７の処理を実行し、今回時刻での処理を終了する。このＳ６７の処理では、外力目標生成部２７は、第１実施形態におけるＳ４１と同じ処理によって、今回時刻での各接触対象面からロボット１に作用させる目標外力を確定する。
一方、本実施形態におけるＳ６７の処理では、外力目標生成部２７は、各接触対象面の目標外力作用点に関しては、目標運動生成部２５で生成された暫定外力作用点をそのまま目標外力作用点として確定する。
前記Ｓ６５の判断結果が否定的である場合には、外力目標生成部２７は、次にＳ６９の処理を実行する。このＳ６９では、外力目標生成部２７は、第２必要条件を満足するように、仮想面摩擦力成分修正量ｆ_iを制限してなる仮想面摩擦力成分制限修正量ｆ_lim_iを決定すると共に、第４必要条件を満足するように、仮想面ねじり力Ｒ_iを制限してなる仮想面制限ねじり力Ｒ_lim_iを決定する。
すなわち、外力目標生成部２７は、ｆ_lim_iによる修正後の仮想面摩擦力成分Ｆ_iが、Ｓ１５までの処理で決定した仮想面垂直抗力成分Ｎiに応じて設定した摩擦力上限値（＝μ_i＊｜Ｎ_i｜）以下になるようにｆ_lim_iを決定すると共に、Ｒ_lim_iがＳ１５までの処理で決定した仮想面垂直抗力成分Ｎiに応じて設定したねじり力上限値（＝μr_i＊｜Ｎ_i｜）以下になるようにＲ_lim_iを決定する。
この場合、ｆ_lim_iに関しては、第２必要条件を満足することに加えて、それらの総和（合力）が“０”に保たれるようにｆ_lim_iが決定される。
より具体的には、例えば、Ｓ６３で決定した各仮想面における仮想面摩擦力成分修正量ｆ_iのそれぞれに同じ値の、ある係数ｋを乗じてなる値を仮想面摩擦力成分制限修正量ｆ_lim_iに一致させるように、ｆ_lim_iを決定する。このようにすることでｆ_lim_iの総和（合力）は、ｆ_iの総和（＝０）のｋ倍、すなわち、“０”になる。この場合、係数ｋの値を未知数とし、各仮想面において、Ｓ１５までの処理で決定した修正前の仮想面摩擦力成分Ｆ_iにｋ＊ｆ_iを加え合わせてなる摩擦力の大きさ（＝｜Ｆ_i＋ｋ＊ｆ_i｜）が、第２必要条件を満たすように（｜Ｆ_i＋ｋ＊ｆ_i｜≦μ_i＊｜Ｎ_i｜となるように）、上記係数ｋの値を決定する。そして、この決定した係数ｋを、Ｓ６３で算出した各仮想面におけるｆ_iに乗じることによって、各仮想面におけるｆ_lim_iを決定する。
なお、Ｓ０１で設定された全ての仮想面において、ｆ_iによる修正後の仮想面摩擦力成分Ｆ_iが前記第２必要条件を満足している場合には、上記係数ｋの値は“１”とされる。従って、この場合には、Ｓ６３で算出した各仮想面におけるｆ_iがそのまま、ｆlim_iとして決定される。
また、各仮想面における仮想面制限ねじり力Ｒ_lim_iは例えば次のように決定される。すなわち、Ｓ６５で前記第４必要条件を満たさない各仮想面において、仮想面制限ねじり力Ｒ_lim_iは、その大きさがねじり力上限値（＝μr_i＊｜Ｎ_i｜）に一致するように決定される。また、第４必要条件を満たす各仮想面においては、Ｓ６３で算出された仮想面ねじり力Ｒ_iがそのまま仮想面制限ねじり力Ｒ_lim_iとして決定される。
なお、第４必要条件を満たさない各仮想面における仮想面制限ねじり力Ｒ_lim_iを、ねじり力上限値よりも若干小さい大きさのねじり力に決定するようにしてもよい。
上記の如く仮想面摩擦力成分制限修正量ｆ_lim_iと仮想面制限ねじり力Ｒ_lim_iとを決定した後、外力目標生成部２７は、次に、Ｓ７１の処理を実行する。このＳ７１では、外力目標生成部２７は、前記モーメント偏差errＭのうち、Ｓ６９で決定した各仮想面におけるｆ_lim_iとＲ_lim_iとによって解消できない偏差成分としての残偏差成分errＭ'を算出する。
具体的には、外力目標生成部２７は、各仮想面において、制限前の仮想面摩擦力成分修正量ｆ_iと仮想面摩擦力成分制限修正量ｆ_lim_iとの差Δｆ_i（＝ｆ_i−ｆ_lim_i）を算出すると共に、制限前の仮想面ねじり力Ｒ_iと仮想面制限ねじり力Ｒ_lim_iとの差ΔＲ_i（＝Ｒ_i−Ｒ_lim_i）とを算出する。そして、外力目標生成部２７は、前記式１１の右辺における縦ベクトル(f_i R_i)Tの成分ｆ_i，Ｒ_iをそれぞれに対応するΔｆ_i，ΔＲ_iに置き換え、且つ、前記式１１の左辺をerrＭ'に置き換えた式によって、残偏差成分errＭ’を算出する。
なお、ｆ_lim_i及びＲ_lim_iを、仮想面上暫定外力作用点に作用させた場合にモーメント基準点周りに発生するモーメントを算出し、このモーメントを、モーメント偏差errＭから差し引くことによって、残偏差成分errＭ'を算出するようにしてもよい。
次いで、外力目標生成部２７は、図１５のＳ７３の処理を実行する。このＳ７３では、外力目標生成部２７は、仮想面上外力作用点の位置の変化（仮想面上暫定外力作用点からの変化）に対する仮想面必要並進力依存モーメントＭsの変化の感度を表現するヤコビアンＪ（前記式０７の関係式におけるヤコビアンＪ）を、第１実施形態におけるＳ２３と同じ処理によって算出する。
次いで、外力目標生成部２７は、Ｓ７５の処理を実行する。このＳ７５では、外力目標生成部２７は、第１実施形態におけるＳ２５と同様の処理によって、前記式０７におけるΔＭs（仮想面必要並進力依存モーメントＭsの変化量）をＳ７１で算出した残偏差成分errＭ'に一致させた場合に、式０７の関係を満たす縦ベクトル（Δrp_i）を、errＭを解消するための各仮想面における仮想面上外力作用点修正量Δrpc_iの組として算出する。すなわち、外力目標生成部２７は、Ｓ７３で決定したヤコビアンＪの擬似逆行列ＪinvをＳ２５の処理と同様に算出し、このＪinvをerrＭ'に乗じることによって、各仮想面における仮想面上外力作用点修正量Δrpc_iの組を算出する。
次いで、外力目標生成部２７は、Ｓ７７の判断処理を実行する。このＳ７７の判断処理は、前記第１実施形態におけるＳ２７の判断処理と同じである。すなわち、外力目標生成部２７は、全ての仮想面において、Ｓ７５で決定したΔrpc_iによる修正後の仮想面上外力作用点の位置が外力作用点存在領域条件を満足するか否かを判断する。
このＳ７７の判断結果が肯定的である場合には、外力目標生成部２７は、Ｓ７９の処理を実行し、今回時刻での処理を終了する。このＳ７９の処理では、外力目標生成部２７は、今回時刻での各接触対象面からロボット１の目標外力と目標外力作用点とを確定する。
具体的には、外力目標生成部２７は、Ｓ１５までの処理で決定した各仮想面における仮想面必要並進力（Ｎ_i，Ｆ_i）と、Ｓ６９の処理で決定した仮想面摩擦力成分制限修正量ｆ_lim_iとから、今回時刻での各仮想面における仮想面必要並進力を確定する。この場合、Ｓ１５までの処理で決定した仮想面垂直抗力成分Ｎ_iがそのまま該仮想面における仮想面垂直抗力成分として確定されると共に、Ｓ１５までの処理で決定した仮想面摩擦力成分Ｆ_iに仮想面摩擦力成分制限修正量ｆ_lim_iを加え合わせてなる摩擦力成分が、該仮想面における仮想面摩擦力成分として確定される。
また、外力目標生成部２７は、Ｓ６９の処理で決定した仮想面制限ねじり力Ｒ_lim_iを、このＲ_lim_iに対応する仮想面における仮想面ねじり力として確定する。
そして、外力目標生成部２７は、以上の如く確定した各仮想面における仮想面必要並進力と仮想面ねじり力とを、第１実施形態におけるＳ２９又はＳ４１と同じ処理によって、該接触対象面からロボット１に作用させる並進力及びねじり力にそれぞれ変換し、この変換後の並進力とねじり力とをそれぞれ目標外力の構成要素である並進外力の目標値（目標並進力）、ねじり力の目標値（目標ねじり力）として決定する。
また、外力目標生成部２７は、第１実施形態におけるＳ２９の処理の場合と同様に、Ｓ７５で決定した仮想面上外力作用点修正量Δrpc_iによる修正後の各仮想面上の外力作用点を該仮想面に対応する接触対象面上に逆投影してなる点を、該接触対象面上の目標外力作用点として決定する。
前記Ｓ７７の判断結果が否定的となる状況では、外力作用点存在領域条件を満たし得る範囲内での仮想面上外力作用点の修正では、前記残偏差成分errＭ'を解消できないこととなる。このため、この場合には、各仮想面に付加する摩擦力又はねじり力をさらに増加させ得るように（ひいてはＳ６５での判断結果が肯定的になり得るように）、仮想面垂直抗力成分Ｎ_iの大きさを大きくする必要がある。
そこで、Ｓ７７の判断結果が否定的となる場合には、外力目標生成部２７は、次に、Ｓ８１の処理を実行する。このＳ７７では、外力目標生成部２７は、Ｓ６５の判断処理で、第２必要条件又は第４必要条件を満たさない仮想面が、対向仮想面Ｓna又はＳnb（ｎ＝１又は２又は３）であるか否かを判断する。
このＳ６５の判断結果が否定的となる状況では、Ｓ６５の判断処理で第２必要条件又は第４必要条件を満足しない仮想面における仮想面垂直抗力成分の大きさを、前記第１Ａ必要条件を満たしつつ増加させることができない。そこで、この場合には、外力目標生成部２７は、Ｓ８５において、ロボット１の運動状態が不適切である（目標運動の修正等を行なう必要がある）とし、今回時刻での処理を中止する。なお、この場合、外力目標生成部２７は、目標運動生成部２５にエラー情報を出力する。そして、目標運動生成部２５は、そのエラー情報に応じて、目標運動を作成し直したり、あるいは、ロボット１の運動を停止させるような目標運動を作成する。
従って、本実施形態では、Ｓ７７の判断結果が否定的となる場合に、Ｓ８１の判断処理によって、ロボット１の運動状態が評価される。そして、このＳ８１の判断結果が否定的となる場合に、ロボット１の運動状態が不適切であると評価されることとなる。
一方、Ｓ８１の判断結果が肯定的となる状況では、第２必要条件又は第４必要条件を満たさない仮想面を含む、互いに平行な対向仮想面Ｓna，Ｓnb（ｎ＝１又は２又は３）の仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさを、前記第１Ａ必要条件を満足しつつ（Ｎ_na＋Ｎ_nbを一定に保ちつつ）、増加させることができる。
そこで、Ｓ８１の判断結果が肯定的となる場合には、外力目標生成部２７は、次に、Ｓ８３の処理を実行する。このＳ８３では、外力目標生成部２７は、対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさの増加量ＩＮ_nを決定する。この場合、本実施形態では、Ｓ８３で決定する増加量ＩＮ_nは、あらかじめ定められた所定値に設定される。
ただし、この増加量ＩＮ_nを、例えば、第１実施形態におけるＳ４５と同様の処理によって決定するようにしてもよい。
次いで、外力目標生成部２７は、図７のＳ１３からの処理を改めて実行する。
以上が、本実施形態における外力目標生成部２７の処理の詳細である。
以上説明した外力目標生成部２７の処理によって、まず、Ｓ０５〜Ｓ１５の処理によって、第１実施形態と同様に、ロボット１全体の並進運動に係わる前記補償総並進外力Ｆall_adを実現するために必要な仮想面必要並進力（Ｎ_i，Ｆ_i）が暫定的に決定される。このため、前記補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値を簡素なアルゴリズムによって効率よく決定することができる。
また、第１実施形態と同様に、Ｓ０７、Ｓ０９の判断結果がいずれも否定的となる場合、あるいは、Ｓ０７、Ｓ０９、Ｓ１５の判断結果がそれぞれ、否定的、肯定的、否定的となる場合に、ロボット１の運動状態が不適切であると評価され、外力目標生成部２７の処理が中止される。このため、第１実施形態と同様に、前記補償総並進外力Ｆall_adを実現するために、接触対象面とロボット１との間の摩擦力が過大になりやすいロボット１の運動状態、あるいは、内力が過大になりやすいロボット１の運動状態を、簡素なアルゴリズムで効率よく不適切であると評価することができる。ひいては、ロボット１の運動を安定に行なうことが困難となる状況で、該ロボット１の運動を継続してしまうような事態が発生するのを防止する（例えばロボット１の運動を停止する）ことができる。
そして、本実施形態では、このように補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値を決定した上で、Ｓ１９、Ｓ２１、Ｓ６１〜Ｓ７５の処理（Ｓ６７の処理を除く）によって、ロボット１全体の回転運動に係わる補償総モーメント外力Ｍall_adを実現するための付加的な操作量（モーメント補償量）として、前記仮想面摩擦力成分修正量Δｆ_iと仮想面ねじり力Ｒ_iとの組が決定され、あるいは、前記仮想面摩擦力成分修正量Δｆ_iと仮想面ねじり力Ｒ_iと仮想面上外力作用点修正量Δｒpc_iとの組が決定される。
このため、第１実施形態の場合と同様に、Ｓ０５〜Ｓ１５の処理によって決定した仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値と、Ｓ１９、Ｓ２１、Ｓ６１〜Ｓ７５の処理（Ｓ６７の処理を除く）によって決定したモーメント補償量とを単純に組合わせるだけで、補償総並進外力Ｆall_adと補償総モーメント外力Ｍall_adとの両方を適切に実現できる仮想面上必要並進力と仮想面上ねじり力と仮想面上外力作用点との組（仮想面上ねじり力が“０”になる場合を含む）を決定することができることとなる。そして、この仮想面上必要並進力と仮想面上ねじり力と仮想面上外力作用点との組から、各接触対象面からロボット１に作用させるべき目標外力（目標並進力及び目標ねじり力）と目標外力作用点とを効率よく適切に決定できることとなる。
なお、この場合、Ｓ７７、Ｓ８１の判断結果がいずれも否定的となる場合に、ロボット１の運動状態が不適切であると評価され、外力目標生成部２７の処理が中止される。このため、前記第１Ａ必要条件及び第１Ｂ必要条件とを少なくとも満足しつつ、補償総モーメント外力Ｍall_adを実現することが困難となるようなロボット１の運動状態を不適切であると評価することができる。ひいては、ロボット１の運動を安定に行なうことが困難となる状況で、該ロボット１の運動を継続してしまうような事態が発生するのを防止する（例えばロボット１の運動を停止する）ことができる。
また、図７に示したＳ０９及びＳ１５、並びに図１５のＳ８１のいずれかの判断結果が否定的となる場合（ロボット１の運動状態が不適切である場合）を除いて、第１実施形態と同様に、今回時刻での各接触対象面に対応する各仮想面における最終的な仮想面必要並進力（仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとの組）は、結果的に、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足するように決定される。
そして、各仮想面に対応する接触対象面における並進外力の目標値（目標並進力）は、その垂直抗力成分（接触対象面に垂直な成分）と摩擦力成分（接触対象面に平行な成分）とが、それぞれ、該仮想面における仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとに一致するように決定される。
このため、第１実施形態と同様に、各接触対象面からロボット１への目標並進力は、可能な限り、各接触対象面における目標並進力のうちの垂直抗力成分の合力によって前記必要総並進外力を実現すると共に、該目標並進力のうちの摩擦力成分を、該接触対象面で発生可能な摩擦力の大きさの限界内で可能な限り小さくなるように、各接触対象面からロボットへの目標並進力を決定できる。
また、Ｓ０１で設定される仮想面が対向仮想面Ｓna，Ｓnbを含む場合において、Ｓ６５又はＳ７７の判断結果が肯定的となる場合に、第１実施形態と同様に、これらの対向仮想面Ｓna，Ｓnbの間でロボット１に発生する内力の大きさ（Ｎ_na，Ｎ_nbの大きさのうちの小さい方の大きさ）を、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足し得る範囲内で、必要最低限に留めることができる。従って、第１実施形態と同様に、ロボット１の関節アクチュエータ１１が発生可能な動力（本実施形態では駆動トルク）のうち、該内力を発生するために必要な負担分を軽減することができるように対向仮想面Ｓna，Ｓnbに対応する２つの接触対象面を含む各接触対象面における目標並進力を決定できる。
ここで、以上説明した本実施形態と本願発明との対応関係を補足しておく。本実施形態ででは、制御ユニット２１の外力目標生成部２７が本発明における目標運動評価装置としての機能を有する。
そして、この外力目標生成部２７が実行する処理のうち、Ｓ０１の処理によって、本発明における仮想面群設定手段が実現される。
また、Ｓ０２の処理によって、本発明における基本必要総並進外力決定手段が実現される。
この場合、前記必要総並進外力Ｆalllが本発明における基本必要総並進外力に相当する。
また、Ｓ０３の処理によって、本発明における並進外力補償量決定手段が実現される。この場合、本実施形態では、本発明における運動状態量として、ロボット１の全体重心点の位置が使用され、前記偏差ΔＰgが本発明における運動状態量偏差に相当する。
また、Ｓ０５の処理によって、第１Ａ必要条件と第１Ｂ必要条件とを満足するように仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ０７〜Ｓ１７の処理によって、運動状態評価手段が実現される。この場合、Ｓ０７の判断処理によって、本発明における第１判断手段が実現される。また、Ｓ０９の判断処理によって、本発明における第２判断手段が実現される。また、Ｓ１５の判断処理によって、本発明における第３判断手段が実現される。
また、本実施形態では、それを別の観点でみると、Ｓ０５〜Ｓ１３の処理（Ｓ０９の判断結果が否定的となる場合を除く）によって、あるいは、Ｓ０５〜Ｓ２１の処理（Ｓ０９又はＳ１５の判断結果が否定的となる場合を除く）とＳ６１〜Ｓ８３の処理（Ｓ８１の判断結果が否定的となる場合を除く）とこれに続くＳ１３の処理とによって、第１Ａ必要条件と第１Ｂ必要条件と第２必要条件とを満足するように仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ１５及びＳ１７の判断処理によって、本発明における運動状態評価手段が実現されると共に、Ｓ１５の判断処理によって、本発明における第４判断手段が実現される。
［第３実施形態］
次に本発明の第３実施形態を図１６を参照して説明する。なお、本実施形態は、外力目標生成部２７の処理の一部だけが第１実施形態と相違するものであるので、第１実施形態と同一事項については説明を省略する。
ロボット１の外界の接触対象面が、前記壁面ＷＬ１，ＷＬ２の如く、互いに間隔を存して対向する２つの接触対象面を有する場合、ひいては、Ｓ０１で設定される仮想面群が対向仮想面Ｓna，Ｓnbを含む場合には、これらの対向仮想面Ｓna，Ｓnbにおける仮想面垂直抗力成分Ｎ_na，Ｎ_nbの合力を一定に維持したまま、該対向仮想面Ｓna，Ｓnbの間の内力（＝ｍｉｎ（｜Ｎ_na｜，｜Ｎ_nb｜）を操作する（増減させる）ことによって、モーメント基準点周りに発生するモーメントを変化させることができる。従って、この内力は、モーメント偏差errＭ（又は残偏差成分errＭ'）を解消し、もしくは低減するためモーメント補償量として利用することもできる。
そこで、本実施形態では、Ｓ０１で設定される仮想面群が対向仮想面Ｓna，Ｓnbを含む場合に、Ｓ３３で算出される前記残偏差成分errＭ'を解消するためのモーメント補償量として、第２補償量（仮想面摩擦力成分修正量ｆ_i）及び第３補償量（仮想面ねじり力Ｒ_i）と、第４補償量としての内力修正量ΔＩＮとの組を決定する。
具体的には、本実施形態における外力目標生成部２７の処理のうち、前記Ｓ３３までの処理は、第１実施形態と同じである。そして、Ｓ３３の後の一部の処理が第１実施形態と相違する。
以下、図１６を参照して説明すると、外力目標生成部２７は、Ｓ３３の次に、Ｓ１０１の処理を実行する。このＳ１０１では、外力目標生成部２７は、Ｓ０１で設定した仮想面群に、対向仮想面Ｓna，Ｓnbが有るか否かを判断する。そして、この判断結果が否定的である場合には、外力目標生成部２７は、図９に示したＳ３５からの処理を第１実施形態と同様に実行する。
なお、本実施形態では、Ｓ１０１の判断結果が否定的となった場合において、その後、図９に示したＳ３５、Ｓ３７、Ｓ３９、Ｓ４３の処理を順次実行したとき、Ｓ４３の判断結果は常に否定的となる。従って、Ｓ１０１の判断結果が否定的となった場合の後の処理では、Ｓ４３及びＳ４５の処理は実質的に不要であり、Ｓ３９の判断結果が、否定的である場合に、直ちにＳ４７の処理を実行するようにしてもよい。
一方、Ｓ１０１の判断結果が肯定的である場合には、外力目標生成部２７は、次に、Ｓ１０３の処理を実行する。このＳ１０３では、各仮想面（Ｓ０１で設定した各仮想面）の仮想面上制限修正後外力作用点に任意の値の前記仮想面摩擦力成分修正量ｆ_iと前記仮想面ねじり力Ｒ_iとを付加し、且つ、各組の対向仮想面Ｓna，Ｓnbの仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさを任意の値の内力修正量ΔIN_nだけ変化させた場合に、それらのｆ_i，Ｒ_i，ΔIN_nによって前記モーメント基準点周りに発生するモーメントＭfrinと、ｆ_i，Ｒ_i，ΔIN_nとの間の関係を次式１３により表現するヤコビアン（行列）Ｊfrinを算出する。

Ｍfrin＝Ｊfrin＊(f_i R_i ΔIN_n)T ……式１３

この式１３における(f_i R_i ΔIN_n)Tは、ｆ_i，Ｒ_i及びΔIN_nを成分とする縦ベクトルである。なお、仮想面摩擦力成分修正量ｆ_iは、それらの総和（合力）が“０”になるように決定されるべきモーメント補償量であるので、式１３における縦ベクトル(f_i R_i ΔIN_n)Tの成分としてのｆ_iは、第１実施形態で説明した前記式１１におけるｆ_iと同様に、任意の１つの仮想面に対応するｆ_i（≡ｆ_i0）を除いたものである。また、Ｓ０１で設定した仮想面群に、対向仮想面Ｓna，Ｓnbの組が複数組含まれる場合には、その全ての組の対向仮想面Ｓna，Ｓnbに対応する内力修正量ΔIN_nが式１３における縦ベクトル(f_i R_i ΔIN_n)Tの成分として含まれる。
次いで、外力目標生成部２７は、Ｓ１０５の処理を実行する。このＳ１０５では、外力目標生成部２７は、式１３のＭfrinを、Ｓ３３で算出した残偏差成分errＭ'に一致させた場合に、式１３の関係を満たすｆ_i，Ｒ_i及びΔIN_nの組(f_i R_i ΔIN_n)Tを算出する。
すなわち、外力目標生成部２７は、Ｓ１０３で求めたヤコビアンＪfrinの擬似逆行列Ｊfrin_invを算出し、この擬似逆行列Ｊfrin_invを、残偏差成分errＭ'に乗じることによって、ｆ_i，Ｒ_i及びΔIN_nの組を算出する。この場合、擬似逆行列Ｊfrin_invは、第１実施形態で説明した図９のＳ３７の処理で擬似逆行列Ｊfr_invを算出する手法と同様に、例えば式１３の縦ベクトル(f_i R_i ΔIN_n)Tを組成するｆ_i，Ｒ_i，ΔIN_nのそれぞれの２乗値又は絶対値の平均値（又は重み付き平均値）が最小になるように決定される。また、式１３の縦ベクトル(f_i R_i ΔIN_n)Tから除いた上記ｆ_i0は、上記の如く算出したｆ_iの総和の符号を反転させてなる値として決定される。
なお、必ずしもｆ_i，Ｒ_i，ΔIN_nの全てを算出する必要はない。例えば、摩擦係数μ_iが比較的小さい仮想面におけるｆ_iを“０”に設定したり、ねじり力係数μr_iが比較的小さい仮想面におけるＲ_iを“０”に設定するようにしてもよい。
前記目標運動が、前記壁登り歩容である場合においては、上記Ｓ１０３、Ｓ１０５の処理は、例えば次にように行なわれる。
例えば、第１実施形態で説明した場合と同様に、図１１（ｂ）に示した動作状態において、床面ＦＬ及び壁面ＷＬ１，ＷＬ２にそれぞれ対応する各仮想面Ｓ3a，Ｓ2a，Ｓ2bにおける仮想面上制限修正後外力作用点の位置ベクトル（モーメント基準点に対する位置ベクトル）をそれぞれrp_3a，rp_2a，rp_2bとおく。このとき、各仮想面Ｓ3a，Ｓ2a，Ｓ2bにおける仮想面上摩擦力成分修正量ｆ_3a，ｆ_2a，ｆ_2b、仮想面ねじり力Ｒ_3a，Ｒ_2a，Ｒ_2b、並びに、仮想面Ｓ2a，Ｓ2b間の内力修正量ΔIN_2と、これらのｆ_3a，ｆ_2a，ｆ_2b，Ｒ_3a，Ｒ_2a，Ｒ_2b，ΔIN_2によってモーメント基準点周りに発生するモーメントＭfrinとの間の関係は、次式１３ａにより表される。

Ｍfrin＝rp_3a＊ｆ_3a＋rp_2a＊ｆ_2a＋rp_2b＊ｆ_2b＋Ｒ_3a＋Ｒ_2a＋Ｒ_2b
＋（rp_2a−rp_2b）＊ΔIN_2
……式１３ａ

なお、式１３ａにおける（rp_3a＊ｆ_3a），（rp_2a＊ｆ_2a），（rp_2b＊ｆ_2b），（rp_2a−rp_2b）＊ΔIN_2はそれぞれベクトル積である。この場合、式１３ａでは、ΔIN_2は、仮想面Ｓ2aから仮想面Ｓ2bに向かうベクトル（大きさがΔIN_2であるベクトル）として表現されている。
この場合、仮想面摩擦力成分修正量に関しては、ｆ_3a＋ｆ_2a＋ｆ_2b＝０であるから、ｆ_2b＝−(ｆ_3a＋ｆ_2a)となる。従って、式１３ａは、例えばｆ_2bを含まない次式１３ｂに書き換えられる。

Ｍfrin＝（rp_3a−rp_2b）＊ｆ_3a＋（rp_2a−rp_2b）＊ｆ_2a＋Ｒ_3a＋Ｒ_2a＋Ｒ_2b
＋（rp_2a−rp_2b）＊ΔIN_2
……式１３ｂ

従って、Ｓ１０３では、この式１３ｂの右辺を、座標成分で表して整理することで、前記式１３におけるヤコビアンＪfrinが求められることとなる。
そして、Ｓ１０５では、このヤコビアンＪfrinの擬似逆行列Ｊfrin_invが前記した如く算出され、このＪfr_invを、残偏差成分errＭ’に乗じることによって、ｆ_3a，ｆ_2a，Ｒ_3a，Ｒ_2a，Ｒ_2b，ΔIN_2が算出される。さらに、ｆ_3a，ｆ_2aから、ｆ_2b＝−(ｆ_3a＋ｆ_2a)という関係に従って、ｆ_3bが算出される。
以上のＳ１０５までの処理によって、前記Ｓ２７の判断結果が否定的となり、且つ、Ｓ１０１の判断結果が肯定的となる場合には、前記第１Ａ必要条件及び第１Ｂ必要条件を満足しつつ、前記補償総モーメント外力Ｍall_adを実現するためのモーメント補償量として、仮想面上外力作用点制限修正量Δrpc_lim_iに加えて、仮想面摩擦力成分修正量ｆ_i、仮想面ねじり力Ｒ_i及び内力修正量ΔIN_nの組が算出されることとなる。
次いで、外力目標生成部２７は、Ｓ１０７の判断処理を実行する。このＳ１０７では、外力目標生成部２７は、内力修正量ΔIN_nによる内力の修正を行なう対向仮想面Ｓna，Ｓnbにおいて、修正後の内力が前記第３必要条件を満足するか否かを判断する。より詳しくは、外力目標生成部２７は、対向仮想面Ｓna，Ｓnbにおいて、内力修正量ΔIN_nだけ大きさを変化させた仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさのうちの小さい方の大きさ（すなわちΔIN_nによる修正後の内力の大きさ）が、前記内力上限値ＩＦＣ_n以下であるか否かを判断する。
このＳ１０７の判断結果が否定的である場合には、外力目標生成部２７は、Ｓ１１７において、ロボット１の運動状態が不適切である（目標運動の修正等を行なう必要がある）とし、外力に関する目標を生成する処理を中止する。なお、この場合、外力目標生成部２７は、目標運動生成部２５にエラー情報を出力する。そして、目標運動生成部２５は、そのエラー情報に応じて、目標運動を作成し直したり、あるいは、ロボット１の運動を停止させるような目標運動を作成する。
また、Ｓ１０７の判断結果が肯定的である場合には、外力目標生成部２７は、図９のＳ３９と同じ判断処理（第２必要条件及び第４必要条件に関する判断処理）をＳ１０９で実行する。なお、この場合、対向仮想面Ｓna，Ｓnbにおける摩擦力上限値に関する仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさは、内力修正量ΔIN_nによる修正後の値（詳しくは図７のＳ１５までの処理で決定された仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさを、内力修正量ΔIN_nだけ変化させた後の値）である。
そして、Ｓ１０９の判断結果が肯定的である場合には、外力目標生成部２７は、図９のＳ４１と同じ処理をＳ１１１で実行し、今回時刻での各接触対象面からロボット１への目標外力と目標外力作用点とを確定する。
また、Ｓ１０９の判断結果が否定的である場合には、外力目標生成部２７は、図９のＳ４３と同じ判断処理をＳ１１３で実行する。そして、この判断結果が、否定的である場合には、外力目標生成部２７は、Ｓ１１７において、ロボット１の運動状態が不適切であるとして、外力目標生成部２７の処理（外力に関する目標を生成する処理）を中止する。
従って、本実施形態では、Ｓ１０７の判断結果が否定的となる場合、あるいは、１０９及びＳ１１３の判断結果がいずれも否定的となる場合に、ロボット１の運動状態が不適切であると評価されることとなる。
また、Ｓ１１３の判断結果が肯定的である場合には、図９のＳ４５と同じ処理をＳ１１５で実行し、対向仮想面Ｓna，Ｓnbにおける仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさの増加量IN_nを決定する。なお、Ｓ１１５で決定する増加量IN_nは、詳しくは、Ｓ１０９の判断処理で使用した仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさ（すなわち、内力修正量ΔIN_nによる修正後の値）からの増加量である。
次いで、外力目標生成部２７は、図７のＳ１３からの処理を改めて実行する。
なお、このようにＳ１３からの処理を改めて実行する場合には、Ｓ１５の判断結果が肯定的となる場合に、Ｓ１０１の判断処理を行うことなく（あるいは、Ｓ１０１の判断結果に依存することなく）、Ｓ３５からの処理を実行するようにしてもよい。
以上が、本実施形態における外力目標生成部２７の処理の詳細である。
以上説明した外力目標生成部２７の処理によって、第１実施形態と同様に、まず、Ｓ０５〜Ｓ１５の処理によって、ロボット１全体の並進運動に係わる前記補償総並進外力Ｆall_adを実現するために必要な仮想面必要並進力（Ｎ_i，Ｆ_i）が暫定的に決定される。このため、前記補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値を簡素なアルゴリズムによって効率よく決定することができる。
また、第１実施形態と同様に、Ｓ０７、Ｓ０９の判断結果がいずれも否定的となる場合、あるいは、Ｓ０７、Ｓ０９、Ｓ１５の判断結果がそれぞれ、否定的、肯定的、否定的となる場合に、ロボット１の運動状態が不適切であると評価され、外力目標生成部２７の処理が中止される。このため、第１実施形態と同様に、前記補償総並進外力Ｆall_adを実現するために、接触対象面とロボット１との間の摩擦力が過大になりやすいロボット１の運動状態、あるいは、内力が過大になりやすいロボット１の運動状態を、簡素なアルゴリズムで効率よく不適切であると評価することができる。ひいては、ロボット１の運動を安定に行なうことが困難となる状況で、該ロボット１の運動を継続してしまうような事態が発生するのを防止する（例えばロボット１の運動を停止する）ことができる。
そして、上記のように補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値を決定した上で、Ｓ１９〜Ｓ３７の処理（Ｓ２９の処理を除く）によって、ロボット１全体の回転運動に係わる補償総モーメント外力Ｍ all_adを実現するための付加的な操作量（モーメント補償量）として、前記仮想面上外力作用点修正量Δｒpc_iが決定され、あるいは、前記仮想面上外力作用点制限修正量Δｒpc_lim_iと仮想面摩擦力成分修正量Δｆ_iと仮想面ねじり力Ｒ_iとの組が決定され、あるいは、Δｒpc_lim_i、Δｆ_i及びＲ_iと内力修正量ΔIN_nとの組が決定される。
このため、第１実施形態と同様に、Ｓ０５〜Ｓ１５の処理によって決定した仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値と、Ｓ１９〜Ｓ３７の処理（Ｓ２９の処理を除く）、又は、Ｓ１９〜Ｓ３３（Ｓ２９の処理を除く）とＳ１０３〜１０５の処理とによって決定したモーメント補償量とを単純に組合わせるだけで、補償総並進外力Ｆall_adと補償総モーメント外力Ｍall_adとの両方を適切に実現できる仮想面上必要並進力と仮想面上ねじり力と仮想面上外力作用点との組（仮想面上ねじり力が“０”になる場合を含む）を決定することができることとなる。そして、この仮想面上必要並進力と仮想面上ねじり力と仮想面上外力作用点との組から、各接触対象面からロボット１に作用させるべき目標外力（目標並進力及び目標ねじり力）と目標外力作用点とを効率よく適切に決定できることとなる。
なお、この場合、Ｓ１０９、Ｓ１１３の判断結果がいずれも否定的となる場合に、ロボット１の運動状態が不適切であると評価され、外力目標生成部２７の処理が中止される。このため、前記第１Ａ必要条件及び第１Ｂ必要条件とを少なくとも満足しつつ、補償総モーメント外力Ｍall_adを実現することが困難となる状況でのロボット１の運動状態をを不適切であると評価することができる。ひいては、ロボット１の運動を安定に行なうことが困難となる状況で、該ロボット１の運動を継続してしまうような事態が発生するのを防止する（例えばロボット１の運動を停止する）ことができる。
また、図７に示したＳ０９及びＳ１５、並びに図１６のＳ１０７、Ｓ１１３のいずれかの判断結果が否定的となる場合（ロボット１の運動状態が不適切である場合）を除いて、第１実施形態と同様に、今回時刻での各接触対象面に対応する各仮想面における最終的な仮想面必要並進力（仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとの組）は、結果的に、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足するように決定される。
そして、各仮想面に対応する接触対象面における並進外力の目標値（目標並進力）は、その垂直抗力成分（接触対象面に垂直な成分）と摩擦力成分（接触対象面に平行な成分）とが、それぞれ、該仮想面における仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとに一致するように決定される。
このため、第１実施形態と同様に、各接触対象面からロボット１への目標並進力は、可能な限り、各接触対象面における目標並進力のうちの垂直抗力成分の合力によって前記補償総並進外力Ｆall_adを実現すると共に、該目標並進力のうちの摩擦力成分を、該接触対象面で発生可能な摩擦力の大きさの限界内で可能な限り小さくなるように、各接触対象面からロボットへの目標並進力を決定できる。
特に、本実施形態では、第１実施形態と同様に、モーメント補償量として、仮想面上外力作用点修正量Δｒpc_i（第１補償量）が優先的に決定されるため、各仮想面における仮想面摩擦力成分Ｆ_iの大きさを、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足し得る範囲内で、必要最低限の大きさに留めることができる。ひいては、各接触対象面における目標並進力の摩擦力成分の大きさも必要最低限もしくはこれと同程度に留めることができる。
また、Ｓ０１で設定される仮想面が対向仮想面Ｓna，Ｓnbを含む場合において、目標運動が不適切であると判断される場合を除いて、対向仮想面Ｓna，Ｓnbの間でロボット１に発生する内力の大きさ（Ｎ_na，Ｎ_nbの大きさのうちの小さい方の大きさ）が前記内力上限値ＩＦＣ_n以下に収まるように（前記第３必要条件を満足するように）、仮想面垂直抗力成分Ｎ_na，Ｎ_nbが決定される。このため、ロボット１の関節アクチュエータ１１が発生可能な動力（本実施形態では駆動トルク）のうち、内力を発生するために必要な負担分が過大にならないように、対向仮想面Ｓna，Ｓnbに対応する２つの接触対象面を含む各接触対象面における目標並進力を決定できる。
ここで、以上説明した本実施形態と本願発明との対応関係を補足しておく。本実施形態ででは、制御ユニット２１の外力目標生成部２７が本発明における目標運動評価装置としての機能を有する。
そして、この外力目標生成部２７が実行する処理のうち、Ｓ０１の処理によって、本発明における仮想面群設定手段が実現される。
また、Ｓ０２の処理によって、本発明における基本必要総並進外力決定手段が実現される。
この場合、前記必要総並進外力Ｆalllが本発明における基本必要総並進外力に相当する。
また、Ｓ０３の処理によって、本発明における並進外力補償量決定手段が実現される。この場合、本実施形態では、本発明における運動状態量として、ロボット１の全体重心点の位置が使用され、前記偏差ΔＰgが本発明における運動状態量偏差に相当する。
また、Ｓ０５の処理によって、第１Ａ必要条件と第１Ｂ必要条件とを満足するように仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ０７〜Ｓ１７の処理によって、運動状態評価手段が実現される。この場合、Ｓ０７の判断処理によって、本発明における第１判断手段が実現される。また、Ｓ０９の判断処理によって、本発明における第２判断手段が実現される。また、Ｓ１５の判断処理によって、本発明における第３判断手段が実現される。
また、本実施形態では、それを別の観点でみると、Ｓ０５〜Ｓ３７の処理（Ｓ０９又はＳ１５の判断結果が否定的となる場合とＳ１０１の判断結果が肯定的となる場合とを除く）によって、あるいは、Ｓ０５〜Ｓ３３の処理（Ｓ０９又はＳ１５の判断結果が否定的となる場合を除く）とＳ１０３，Ｓ１０５の処理とによって、第１Ａ必要条件と第１Ｂ必要条件とを少なくとも満足するように（詳しくは、第１Ａ必要条件と第１Ｂ必要条件とを満足しつつ、ロボット１の目標運動のうちの、ロボット１全体の回転運動を実現し得るように）、仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ３７に続く、Ｓ３９〜Ｓ４５並びにＳ１３〜Ｓ１７の処理によって、あるいは、Ｓ１０５に続く、Ｓ１０７〜Ｓ１１５並びにＳ１３〜Ｓ１７の処理によって、本発明における運動状態評価手段が実現される。この場合、Ｓ３９又はＳ１０９の判断処理によって、本発明における第１判断手段が実現される。また、Ｓ４３又はＳ１１３の判断処理によって、本発明における第２判断手段が実現される。また、Ｓ１５の判断処理によって、本発明における第３判断手段が実現される。
また、本実施形態では、それを別の観点でみると、Ｓ０５〜Ｓ１３の処理（Ｓ０９の判断結果が否定的となる場合を除く）によって、あるいは、Ｓ０５〜Ｓ４５の処理（Ｓ０９又はＳ１５又Ｓ４３の判断結果が否定的となる場合とＳ１０１の判断結果が肯定的となる場合とを除く）とこれに続くＳ１３の処理とによって、あるいは、Ｓ０５〜Ｓ３３の処理（Ｓ０９又はＳ１５の判断結果が否定的となる場合を除く）とＳ１０３〜Ｓ１１５の処理（Ｓ１０７又はＳ１１３の判断結果が否定的となる場合と除く）とこれに続くＳ１３の処理とによって、第１Ａ必要条件と第１Ｂ必要条件と第２必要条件とを満足するように仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ１５及びＳ１７の処理によって、本発明における運動状態評価手段が実現されると共に、Ｓ１５の判断処理によって、本発明における第４判断手段が実現される。
［第４実施形態］
次に本発明の第４実施形態を図１７及び図１８を参照して説明する。なお、本実施形態は、外力目標生成部２７の処理の一部だけが第２実施形態又は第３実施形態と相違するものであるので、第２実施形態又は第３実施形態と同一事項については説明を省略する。
本実施形態は、モーメント偏差errＭを解消もしくは低減するためのモーメント補償量として、第３実施形態と同様に内力修正量ΔIN_n（第４補償量）を適宜利用するものである。この場合、本実施形態では、Ｓ０１で設定した仮想面群に対向仮想面が含まれる場合に、モーメント補償量として、仮想面摩擦力成分修正量ｆ_i（第２補償量）と仮想面ねじり力Ｒ_i（第３補償量）と内力修正量ΔIN_n（第４補償量）との組を決定した上で、これらの補償量によって解消できない残偏差成分errＭ’を解消するように、仮想面上外力作用点修正量Δrpc_i（第１補償量）を決定する。
具体的には、本実施形態における外力目標生成部２７の処理のうち、前記Ｓ２１までの処理は、第２実施形態と同じである。そして、Ｓ２１の後の一部の処理が第２実施形態と相違する。
以下図１７及び図１８を参照して説明すると、外力目標生成部２７は、Ｓ２１の次に、Ｓ１２１の判断処理を実行する。このＳ１２１では、外力目標生成部２７は、Ｓ０１で設定した仮想面群に、対向仮想面Ｓna，Ｓnbが有るか否かを判断する。そして、この判断結果が否定的である場合には、外力目標生成部２７は、図１４及び図１５に示したＳ６１からの処理を第２実施形態と同様に実行する。
なお、本実施形態では、Ｓ１２１の判断結果が否定的となった場合において、その後、図１５に示したＳ８１の判断処理を実行したとき、その判断結果は常に否定的となる。従って、Ｓ１２１の判断結果が否定的となった場合の後の処理では、Ｓ８１及びＳ８３の処理は実質的に不要であり、Ｓ７７の判断結果が否定的である場合に、直ちにＳ８５の処理を実行するようにしてもよい。
一方、Ｓ１２１の判断結果が肯定的である場合には、外力目標生成部２７は、次に、Ｓ１２３の処理を実行する。このＳ１２３では、外力目標生成部２７は、第３実施形態で説明したＳ１０３と同様の処理によって、仮想面摩擦力成分修正量ｆ_i（第２補償量）、仮想面ねじり力Ｒ_i（第３補償量）及び内力修正量ΔIN_n（第４補償量）と、これらのｆ_i，Ｒ_i，ΔIN_nによってモーメント基準点周りに発生するモーメントＭfrinとの関係を前記式１３により表現するヤコビアンＪfrinを決定する。ただし、本実施形態では、Ｓ１２３の処理における各仮想面上の外力作用点としては、仮想面上暫定外力作用点（目標運動生成部２５が決定した接触対象面上の暫定外力作用点を該接触対象面に対応する仮想面に投影してなる点）が使用される。
次いで、外力目標生成部２７は、Ｓ１２５の処理を実行する。このＳ１２５では、外力目標生成部２７は、前記式１３のＭfrinをＳ２１で求めたモーメント偏差errＭに一致させた場合に式１３の関係式を満足させ得るｆ_i、Ｒ_i及びΔIN_nの組(f_i R_i ΔIN_n)Tを算出する。
この場合、外力目標生成部２７は、Ｓ１２３で求めたヤコビアンＪfrinの擬似逆行列Ｊfrin_invを、第３実施形態におけるＳ１０５の処理と同様の処理によって算出し、この擬似逆行列Ｊfrin_invを、モーメント偏差errＭに乗じることによって、ｆ_i，Ｒ_i，ΔIN_nの組(f_i R_i ΔIN_n)Tを算出する。これにより、errＭを解消するために必要なｆ_i，Ｒ_i，ΔIN_nの組が算出される。
なお、必ずしもｆ_i，Ｒ_i，ΔIN_nの全てを算出する必要はない。例えば、摩擦係数μ_iが比較的小さい仮想面におけるｆ_iを“０”に設定したり、ねじり力係数μr_iが比較的小さい仮想面におけるＲ_iを“０”に設定するようにしてもよい。
以上のＳ１２５までの処理によって、Ｓ１２１の判断結果が否定的となる場合には、前記第１Ａ必要条件及び第１Ｂ必要条件を満足しつつ、補償総モーメント外力Ｍall_adを実現するためのモーメント補償量として、仮想面摩擦力成分修正量ｆ_i、仮想面ねじり力Ｒ_i及び内力修正量ΔIN_nの組が算出されることとなる。
次いで、外力目標生成部２７は、第３実施形態におけるＳ１０７と同じ判断処理をＳ１２７で実行する。すなわち、外力目標生成部２７は、ΔIN_nによる修正後の内力（＝ｍｉｎ（｜Ｎ_na｜，｜Ｎ_nb｜））が前記第３必要条件を満足するか否かを判断する。
このＳ１２７の判断結果が肯定的である場合には、外力目標生成部２７は、次に、Ｓ１３１の処理を実行する。このＳ１３１では、外力目標生成部２７は、第２実施形態におけるＳ６５と同じ判断処理を実行する。すなわち、外力目標生成部２７は、各仮想面において、ｆ_iによる修正後の仮想面摩擦力成分Ｆ_i（Ｓ１５までの処理で決定されたＦ_iとｆ_iとの総和の摩擦力成分）が、前記第２必要条件を満足するか否かを判断すると共に、Ｒ_iの大きさが、前記第４必要条件を満足するか否かを判断する。
そして、Ｓ１３１の判断結果が肯定的である場合には、外力目標生成部２７は、Ｓ１３３の処理を実行し、今回時刻での処理を終了する。このＳ１３３の処理では、外力目標生成部２７は、第２実施形態におけるＳ６７と同様の処理によって、今回時刻での各接触対象面からロボット１の目標外力と目標外力作用点とを確定する。
具体的には、外力目標生成部２７は、Ｓ１５までの処理で決定した各仮想面における仮想面必要並進力（Ｎ_i，Ｆ_i）と、Ｓ１２５の処理で決定した仮想面摩擦力成分修正量ｆ_i及び内力修正量ΔIN_nとから、今回時刻での各仮想面における仮想面必要並進力を確定する。この場合、Ｓ１５までの処理で決定した仮想面垂直抗力成分Ｎ_iの大きさをΔIN_nだけ変化させてなる垂直抗力成分が、該仮想面における仮想面垂直抗力成分として確定されると共に、Ｓ１５までの処理で決定した仮想面摩擦力成分Ｆ_iに仮想面摩擦力成分修正量ｆ_iを加え合わせてなる摩擦力成分が、該仮想面における仮想面摩擦力成分として確定される。
また、外力目標生成部２７は、Ｓ１２５の処理で決定した仮想面ねじり力Ｒ_iを、このＲ_iに対応する仮想面におけるねじり力として確定する。
そして、外力目標生成部２７は、以上の如く確定した各仮想面における仮想面必要並進力と仮想面ねじり力Ｒ_iとを、Ｓ６７の処理と同様に、該仮想面に対応する接触対象面からロボット１に作用させる並進力とねじり力とにそれぞれ変換することで、目標外力の構成要素である目標並進力と目標ねじり力とを決定する。
また、外力目標生成部２７は、目標運動生成部２５で生成された暫定外力作用点をそのまま目標外力作用点として確定する。
前記Ｓ１３１の判断結果が否定的である場合には、外力目標生成部２７は、次にＳ１３５の処理を実行する。このＳ１３５では、外力目標生成部２７は、第２実施形態におけるＳ６９と同じ処理によって、第２必要条件を満足するように、仮想面摩擦力成分修正量ｆ_iを制限してなる仮想面摩擦力成分制限修正量ｆ_lim_iを決定すると共に、第４必要条件を満足するように、仮想面ねじり力Ｒ_iを制限してなる仮想面制限ねじり力Ｒ_lim_iを決定する。
一方、前記Ｓ１２７の判断結果が否定的である場合には、外力目標生成部２７は、Ｓ１２９の処理を実行した後、上記Ｓ１３５の処理を実行する。
この場合、Ｓ１２９では、外力目標生成部２７は、前記第３必要条件を満足するように、内力修正量ΔIN_nを制限してなる内力制限修正量ΔIN_lim_nを決定する。具体的には、Ｓ１２７の判断結果が否定的となった対向仮想面Ｓna，Ｓnbに関して、Ｓ１５までの処理で決定された仮想面垂直抗力成分Ｎ_na，Ｎnbの大きさをそれぞれ、ΔIN_lim_nだけ変化させた後の仮想面垂直抗力成分Ｎ_na，Ｎnbの大きさのうちの小さい方の大きさ（ΔIN_lim_nによる修正後の内力の大きさ）が前記内力上限値ＩＦＣ_nに一致するように（あるいは、ＩＦＣ_nよりも若干小さい値となるように）、ΔIN_lim_nを決定する。
なお、Ｓ０１で設定される仮想面群が２組以上の対向仮想面Ｓna，Ｓnbを有する場合において、Ｓ１２７の判断結果が否定的とならない対向仮想面Ｓna，Ｓnbに関しては、Ｓ１２５で算出された内力修正量ΔIN_nがそのまま、内力制限修正量ΔIN_lim_nとして決定される。
そして、Ｓ１２９の処理に続くＳ１３５の処理では、対向仮想面Ｓna，Ｓnbのそれぞれの摩擦力上限値及びねじり力上限値を決定するための仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさとしては、Ｓ１５までの処理で決定された仮想面垂直抗力成分の大きさを、Ｓ１２９で決定されたΔIN_lim_nにより修正してなる値が用いられる。
なお、Ｓ１２９の処理に続くＳ１３５の処理においては、Ｓ０１で設定された全ての仮想面について、Ｓ１２５で算出されたｆ_iによる修正後の仮想面摩擦力成分Ｆ_iが第２必要条件を満足し、且つ、Ｓ１２５で算出されたＲ_iが第４必要条件を満足するものとなっている場合もある。この場合には、Ｓ１２５で算出されたｆ_i，Ｒ_iがそのまま各仮想面における仮想面摩擦力成分制限修正量ｆ_lim_i、仮想面制限ねじり力Ｒ_lim_iとして決定されることとなる。
また、図示は省略したが、本実施形態では、Ｓ１２７の判断結果と、Ｓ１３１の判断結果とがそれぞれ肯定的、否定的となった場合におけるＳ１３５の処理では、後の処理の便宜上、Ｓ１２５で算出された内力修正量ΔIN_nがそのまま内力制限修正量ΔIN_lim_nとして決定される。
上記の如くΔIN_lim_n、ｆ_lim_i、Ｒ_lim_iを決定した後、外力目標生成部２７は、次に、Ｓ１３７の処理を実行する。このＳ１３７では、外力目標生成部２７は、前記モーメント偏差errＭのうち、ΔIN_lim_nとｆ_lim_iとＲ_lim_iとの組によって解消できない偏差成分としての残偏差成分errＭ'を算出する。
具体的には、外力目標生成部２７は、各仮想面において、制限前の仮想面摩擦力成分修正量ｆ_iと仮想面摩擦力成分制限修正量ｆ_lim_iとの差Δｆ_i（＝ｆ_i−ｆ_lim_i）を算出すると共に、制限前の仮想面ねじり力Ｒ_iと仮想面制限ねじり力Ｒ_lim_iとの差ΔＲ_i（＝Ｒ_i−Ｒ_lim_i）とを算出する。さらに、外力目標生成部２７は、制限前の内力修正量ΔIN_nと内力制限修正量ΔIN_lim_iとの差ΔΔIN_n（＝ΔIN_n−ΔIN_lim_n）を算出する。
そして、外力目標生成部２７は、前記式１３の右辺における縦ベクトル(f_i R_i ΔIN_n)Tの成分ｆ_i，Ｒ_i，ΔIN_nをそれぞれに対応するΔｆ_i，ΔＲ_i，ΔΔIN_nに置き換え、且つ、前記式１３の左辺をerrＭ'に置き換えた式によって、残偏差成分errＭ’を算出する。
なお、式１３の右辺における縦ベクトル(f_i R_i ΔIN_n)Tの成分ｆ_i，Ｒ_i，ΔIN_nを、それぞれｆ_lim_i，Ｒ_lim_i，ΔIN_lim_nに置き換えた式によって、これらのｆ_lim_i，Ｒ_lim_i，ΔIN_lim_nに起因してモーメント基準点周りに発生するモーメントを算出し、このモーメントを、モーメント偏差errＭから差し引くことによって、残偏差成分errＭ'を算出するようにしてもよい。
次いで、外力目標生成部２７は、図１８のＳ１３９からの処理を実行する。この場合、Ｓ１３９からＳ１４３までの処理は、第２実施形態におけるＳ７３からＳ７７までの処理と同じである。
そして、Ｓ１４３の判断結果が肯定的である場合には、外力目標生成部２７は、外力目標Ｓ１４５の処理を実行し、今回時刻での処理を終了する。このＳ１４５の処理では、外力目標生成部２７は、第２実施形態におけるＳ７９と同様の処理によって、今回時刻での各接触対象面からロボット１の目標外力と目標外力作用点とを確定する。
具体的には、外力目標生成部２７は、Ｓ１５までの処理で決定した各仮想面における仮想面必要並進力（Ｎ_i，Ｆ_i）と、Ｓ１３５までの処理で決定した内力制限修正量ΔIN_lim_nと仮想面摩擦力成分制限修正量ｆ_lim_iとから、今回時刻での各仮想面における仮想面必要並進力を確定する。この場合、対向仮想面Ｓna，Ｓnbについては、Ｓ１５までの処理で決定した仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさをΔIN_lim_nにより変化させてなる垂直抗力成分が、該対向仮想面Ｓna，Ｓnbにおける仮想面垂直抗力成分として確定されると共に、その他の各仮想面については、Ｓ１５までの処理で決定した仮想面垂直抗力成分Ｎ_iが、そのまま該仮想面における仮想面垂直抗力成分として確定される。また、いずれの仮想面についても、Ｓ１５までの処理で決定した仮想面摩擦力成分Ｆ_iに仮想面摩擦力成分制限修正量ｆ_lim_iを加え合わせてなる摩擦力成分が、該仮想面における仮想面摩擦力成分として確定される。
また、外力目標生成部２７は、Ｓ１３５の処理で決定した仮想面制限ねじり力Ｒ_lim_iを、このＲ_lim_iに対応する仮想面における仮想面ねじり力として確定する。
そして、外力目標生成部２７は、以上の如く確定した各仮想面における仮想面必要並進力と仮想面ねじり力とを、Ｓ７９と同様の処理によって、該仮想面に対応する接触対象面からロボット１に作用させる並進力及びねじり力にそれぞれ変換することによって、目標外力の構成要素である目標並進力と目標ねじり力とを決定する。
また、外力目標生成部２７は、Ｓ１４１で決定した仮想面上外力作用点修正量Δrpc_iによる修正後の各仮想面上の外力作用点を該仮想面に対応する接触対象面上に逆投影してなる点を、該接触対象面上の目標外力作用点として決定する。
また、Ｓ１４３の判断結果が否定的となる場合には、外力目標生成部２７は、Ｓ１４７の処理を実行した後、図７のＳ１３からの処理を改めて実行する。この場合、Ｓ１４７では、外力目標生成部２７は、対向仮想面Ｓna，Ｓnbにおける仮想面垂直抗力成分Ｎ_na，Ｎ_nbの大きさの増加量ＩＮ_n（詳しくは、Ｓ１５までの処理で決定された仮想面垂直抗力成分Ｎ_na，Ｎ_nbからの増加量）を決定する。この場合、本実施形態では、Ｓ８３で決定する増加量ＩＮ_nは、あらかじめ定められた所定値に設定される。
なお、このようにＳ１３からの処理を改めて実行する場合には、Ｓ２１の処理の次に、Ｓ１２１の判断処理を行うことなく（あるいは、Ｓ１２１の判断結果に依存することなく）、Ｓ６１からの処理を実行するようにしてもよい。
以上が、本実施形態における外力目標生成部２７の処理の詳細である。
以上説明した外力目標生成部２７の処理によって、まず、Ｓ０５〜Ｓ１５の処理によって、第１実施形態と同様に、ロボット１全体の並進運動に係わる前記補償総並進外力Ｆall_adを実現するために必要な仮想面必要並進力（Ｎ_i，Ｆ_i）が暫定的に決定される。このため、前記補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値を簡素なアルゴリズムによって効率よく決定することができる。
また、第１実施形態と同様に、Ｓ０７、Ｓ０９の判断結果がいずれも否定的となる場合、あるいは、Ｓ０７、Ｓ０９、Ｓ１５の判断結果がそれぞれ、否定的、肯定的、否定的となる場合に、ロボット１の運動状態が不適切であると評価され、外力目標生成部２７の処理が中止される。このため、第１実施形態と同様に、前記補償総並進外力Ｆall_adを実現するために、接触対象面とロボット１との間の摩擦力が過大になりやすいロボット１の運動状態、あるいは、内力が過大になりやすいロボット１の運動状態を、簡素なアルゴリズムで効率よく不適切であると評価することができる。ひいては、ロボット１の運動を安定に行なうことが困難となる状況で、該ロボット１の運動を継続してしまうような事態が発生するのを防止する（例えばロボット１の運動を停止する）ことができる。
そして、本実施形態では、このように補償総並進外力Ｆall_adを実現し得る仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値を決定した上で、Ｓ１９、Ｓ２１、Ｓ６１〜Ｓ７５の処理（Ｓ６７の処理を除く）、又はＳ１９、Ｓ２１、Ｓ１２３〜Ｓ１４１（Ｓ１３３の処理を除く）によって、ロボット１全体の回転運動に係わる補償総モーメント外力Ｍall_adを実現するための付加的な操作量（モーメント補償量）として、前記仮想面摩擦力成分修正量ｆ_iと仮想面ねじり力Ｒ_iとの組、あるいは、ｆ_iとＲ_limiと内力修正量ΔIN_nとの組、あるいは、ｆ_lim_iとＲ_lim_iとΔｒpc_iと内力制限修正量ΔIN_lim_nとの組が決定される。
このため、第１実施形態の場合と同様に、Ｓ０５〜Ｓ１５の処理によって決定した仮想面必要並進力（Ｎ_i，Ｆ_i）の暫定値と、Ｓ１９、Ｓ２１、Ｓ６１〜Ｓ７５の処理（Ｓ６７の処理を除く）、又はＳ１９、Ｓ２１、Ｓ１２３〜Ｓ１４１（Ｓ１３３の処理を除く）によって決定したモーメント補償量とを単純に組合わせるだけで、補償総並進外力Ｆall_adと補償総モーメント外力Ｍall_adとの両方を適切に実現できる仮想面上必要並進力と仮想面上ねじり力と仮想面上外力作用点との組（仮想面上ねじり力が“０”になる場合を含む）を決定することができることとなる。そして、この仮想面上必要並進力と仮想面上ねじり力と仮想面上外力作用点との組から、各接触対象面からロボット１に作用させるべき目標外力（目標並進力及び目標ねじり力）と目標外力作用点とを効率よく適切に決定できることとなる。
また、図７に示したＳ０９及びＳ１５、並びにＳ８１のいずれかの判断結果が否定的となる場合（ロボット１の運動状態が不適切である場合）を除いて、第１実施形態と同様に、今回時刻での各接触対象面に対応する各仮想面における最終的な仮想面必要並進力（仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとの組）は、結果的に、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足するように決定される。
そして、各仮想面に対応する接触対象面における並進外力の目標値（目標並進力）は、その垂直抗力成分（接触対象面に垂直な成分）と摩擦力成分（接触対象面に平行な成分）とが、それぞれ、該仮想面における仮想面垂直抗力成分Ｎ_iと仮想面摩擦力成分Ｆ_iとに一致するように決定される。
このため、第１実施形態と同様に、各接触対象面からロボット１への目標並進力は、可能な限り、各接触対象面における目標並進力のうちの垂直抗力成分の合力によって前記必要総並進外力を実現すると共に、該目標並進力のうちの摩擦力成分を、該接触対象面で発生可能な摩擦力の大きさの限界内で可能な限り小さくなるように、各接触対象面からロボットへの目標並進力を決定できる。
また、Ｓ０１で設定される仮想面が対向仮想面Ｓna，Ｓnbを含む場合において、ロボット１の運動状態が不適切であると判断される場合と除いて、第１実施形態と同様に、これらの対向仮想面Ｓna，Ｓnbの間でロボット１に発生する内力の大きさ（Ｎ_na，Ｎ_nbの大きさのうちの小さい方の大きさ）を、前記第１Ａ必要条件、第１Ｂ必要条件、第２必要条件及び第３必要条件を満足し得る範囲内で、必要最低限に留めることができる。従って、第１実施形態と同様に、ロボット１の関節アクチュエータ１１が発生可能な動力（本実施形態では駆動トルク）のうち、該内力を発生するために必要な負担分を軽減することができるように対向仮想面Ｓna，Ｓnbに対応する２つの接触対象面を含む各接触対象面における目標並進力を決定できる。
ここで、以上説明した本実施形態と本願発明との対応関係を補足しておく。本実施形態ででは、制御ユニット２１の外力目標生成部２７が本発明における目標運動評価装置としての機能を有する。
そして、この外力目標生成部２７が実行する処理のうち、Ｓ０１の処理によって、本発明における仮想面群設定手段が実現される。
また、Ｓ０２の処理によって、本発明における基本必要総並進外力決定手段が実現される。
この場合、前記必要総並進外力Ｆalllが本発明における基本必要総並進外力に相当する。
また、Ｓ０３の処理によって、本発明における並進外力補償量決定手段が実現される。この場合、本実施形態では、本発明における運動状態量として、ロボット１の全体重心点の位置が使用され、前記偏差ΔＰgが本発明における運動状態量偏差に相当する。
また、Ｓ０５の処理によって、第１Ａ必要条件と第１Ｂ必要条件とを満足するように仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ０７〜Ｓ１７の処理によって、運動状態評価手段が実現される。この場合、Ｓ０７の判断処理によって、本発明における第１判断手段が実現される。また、Ｓ０９の判断処理によって、本発明における第２判断手段が実現される。また、Ｓ１５の判断処理によって、本発明における第３判断手段が実現される。
また、本実施形態では、それを別の観点でみると、Ｓ０５〜Ｓ１３の処理（Ｓ０９の判断結果が否定的となる場合を除く）によって、あるいは、Ｓ０５〜Ｓ２１の処理（Ｓ０９又はＳ１５の判断結果が否定的となる場合を除く）とＳ６１〜Ｓ８３の処理（Ｓ８１の判断結果が否定的となる場合とＳ１２１の判断結果が肯定的となる場合を除く）とこれに続くＳ１３の処理とによって、あるいは、Ｓ０５〜Ｓ２１の処理（Ｓ０９又はＳ１５の判断結果が否定的となる場合を除く）とＳ１２３〜Ｓ１４７の処理とこれに続くＳ１３の処理とによって、第１Ａ必要条件と第１Ｂ必要条件と第２必要条件とを満足するように仮想面必要並進力を算出する仮想面必要並進力算出手段が実現される。
そして、この場合、Ｓ１５及びＳ１７の判断処理によって、本発明における運動状態評価手段が実現されると共に、Ｓ１５の判断処理によって、本発明における第４判断手段が実現される。
なお、以上説明した各実施形態では、前記壁登り歩容のように、ロボット１の外界（動作環境）に互いに間隔を存して対向する接触対象面ＷＬ１，ＷＬ２が存在する場合を想定して説明したが、本発明は、互いに間隔を存して対向する接触対象面が存在しない動作環境でロボットの運動を行なわせる場合にも適用できる。例えば、互いに交差する３つの接触対象面、あるいは２つの接触対象面にロボットの複数の部位を接触させながら、ロボットの運動を行なわせる場合にも本発明を適用できる。
前記壁登り歩容以外の目標運動の例を図１９及び図２０に示す。
図１９（ａ）〜（ｅ）は、例えば互いに交差する２つの接触対象面として、床面ＦＬと壁面ＷＬ１とが存在する動作環境で、ロボット１の運動を行なわせるための一例の目標運動における該ロボット１の瞬時的な動作状態を時系列順に示している。
この目標運動は、次のような形態の運動である。すなわち、図１９（ａ）に示すようにロボット１が２つのリンク機構５ａ，５ｂを床面ＦＬに接地させて起立した状態から、図１９（ｂ）に示すように、リンク機構５ｃ，５ｄを壁面ＷＬ１に接触させる。そして、この状態で、基体３を壁面ＷＬ１に近づけて、図１９（ｃ）に示す如く、該基体３を壁面ＷＬ１に寄り掛からせるように接触させる。その後、図１９（ｄ）に示すように、リンク機構５ｃ，５ｄにより壁面ＷＬ１を押すことによって、基体３を壁面ＷＬ１から離反させ、最終的に、図１９（ｅ）に示す如く、リンク機構５ｃ，５ｄを壁面ＷＬ１から離反させる。
また、図２０（ａ）〜（ｄ）は、例えば互いに交差する３つの接触対象面として、床面ＦＬと２つの壁面ＷＬ１，ＷＬ３とが存在する動作環境（例えば屋内の部屋の隅部）で、ロボット１の運動を行なわせるための一例の目標運動における該ロボット１の瞬時的な動作状態を時系列順に示している。なお、図２０（ａ）〜（ｄ）は、ロボット１と動作環境とを上方から見た平面視で示している。そして、図２０（ａ）〜（ｄ）の各図では、ロボット１はリンク機構５ａ，５ｄ（図示省略）を床面ＦＬに接地させて起立している。
この運動は、次のような形態の運動である。すなわち、図２０（ａ）に示すようにロボット１が床面ＦＬ上に接地させて起立した状態から、図２０（ｂ）に示すように、リンク機構５ｃ，５ｄをそれぞれ壁面ＷＬ１，ＷＬ３に接触させる。そして、この状態で、基体３を壁面ＷＬ３に近づけて、図２０（ｃ）に示す如く、該基体３を壁面ＷＬ３に寄り掛からせるように接触させる。その後、リンク機構５ｃ，５ｄによりそれぞれ壁面ＷＬ１，ＷＬ２を押すことによって、図２０（ｄ）に示すように、基体３とリンク機構５ｃとを壁面ＷＬ１から離反させると共に、リンク機構５ｄを壁面ＷＬ３から離反させる。
図１９又は図２０に示したような目標運動でロボット１の運動を行なう場合においても、前記した各実施形態における外力目標生成部２７の処理によって、ロボット１に各接触対象面ＦＬ，ＷＬ１から作用させるべき目標外力と目標外力作用点とを適切に決定できる。
なお、この場合、図１９に示した目標運動に係わる外力目標生成部２７の処理において、前記Ｓ０１の処理で設定される仮想面は、図１９（ａ），（ｅ）に示す動作状態では、１つの仮想面（図示例では仮想面Ｓ3a）であり、図１９（ｂ）〜（ｄ）に示す動作状態では、２つの仮想面（図示例では仮想面Ｓ2a，Ｓ3a）である。
また、図２０に示した目標運動に係わる外力目標生成部２７の処理において、前記Ｓ０１の処理で設定される仮想面は、図２０（ａ），（ｄ）に示す動作状態では、１つの仮想面（図示例では仮想面Ｓ3a）であり、図２０（ｂ），（ｃ）に示す動作状態では、３つの仮想面（図示例では仮想面Ｓ1a，Ｓ2a，Ｓ3a）である。
なお、図１９又は図２０に例示した場合のように、ロボット１の動作環境に対向仮想面Ｓna，Ｓnbに対応する接触対象面が存在しない場合には、図７のＳ０９、図９のＳ４３、図１５のＳ８１、図１６のＳ１０１、図１７のＳ１２１の判断処理の判断結果が常に否定的となる。従って、これらの判断結果が肯定的となる場合に専用的な処理は不要である。
１…脚式移動ロボット、２７…外力目標生成部（目標運動評価装置）、Ｓ０１…仮想面群設定手段、Ｓ０２…基本必要総並進外力決定手段、Ｓ０３…並進外力補償量決定手段、Ｓ０５…仮想面必要並進力算出手段、Ｓ０７〜Ｓ１７…運動状態評価手段、Ｓ０７…第１判断手段、Ｓ０９…第２判断手段、Ｓ１５…第３判断手段、Ｓ０５〜Ｓ３７…仮想面必要並進力算出手段、Ｓ３９〜Ｓ４５、Ｓ１３〜Ｓ１７…運動状態評価手段、Ｓ３９…第１判断手段、Ｓ４３…第２判断手段、Ｓ１５…第３判断手段、Ｓ０５〜Ｓ１３…仮想面必要並進力算出手段、Ｓ１５，Ｓ１７…運動状態評価手段、Ｓ１５…第４判断手段、Ｓ０５〜Ｓ４５…仮想面必要並進力算出手段、Ｓ１５，Ｓ１７…運動状態評価手段、Ｓ１５…第４判断手段、Ｓ０５〜Ｓ２１，Ｓ６１〜Ｓ８３，Ｓ１３…仮想面必要並進力算出手段、Ｓ１５，Ｓ１７…運動状態評価手段、Ｓ１５…第４判断手段、Ｓ０５〜Ｓ３３，Ｓ１０３，Ｓ１０５…仮想面必要並進力算出手段、Ｓ１０７〜Ｓ１１５，Ｓ１３〜Ｓ１７…運動状態評価手段、Ｓ１０９…第１判断手段、Ｓ１１３…第２判断手段、Ｓ１５…第３判断手段、Ｓ０５〜Ｓ３３，Ｓ１０３〜Ｓ１１５，Ｓ１３…仮想面必要並進力算出手段、Ｓ１５，Ｓ１７…運動状態評価手段、Ｓ１５…第４判断手段、Ｓ０５〜Ｓ２１，Ｓ１２３〜Ｓ１４７，Ｓ１３…仮想面必要並進力算出手段、Ｓ１５，Ｓ１７…運動状態評価手段、Ｓ１５…第４判断手段。

Claims (5)

  1. 脚式移動ロボットの動作環境に存する互いに異なる複数の接触対象面に該ロボットの複数の部位を接触させながら、該ロボットの運動を行なわせるための該ロボットの目標運動に該ロボットの実際の運動を追従させるように該ロボットの動作制御を行っている状態での該ロボットの運動状態を評価する運動状態評価装置であって、
    相互の姿勢関係があらかじめ定められた複数の仮想面から成る仮想面群を用い、該仮想面群の複数の仮想面が前記複数の接触対象面に一致又は近似する面になるように、該仮想面群を前記ロボットの動作環境の空間に仮想的に設定する仮想面群設定手段と、
    前記目標運動に基づいて、該目標運動を実現するために前記ロボットに作用させるべきトータルの外力のうちの並進力成分である基本必要総並進外力を決定する基本必要総並進外力決定手段と、
    前記ロボットの所定の運動状態量の観測値と、前記目標運動における該運動状態量の目標値との偏差である運動状態量偏差を逐次算出し、該運動状態量偏差に基づいて、該運動状態量偏差を“０”に近づけるために前記ロボットに付加的に作用させるべき並進力である並進外力補償量を決定する並進外力補償量決定手段と、
    前記決定された基本必要総並進外力に前記決定された並進外力補償量を付加してなる補償総並進外力を実現するために前記仮想面群の複数の仮想面のそれぞれから前記ロボットに作用させるべき並進力である仮想面必要並進力を算出する手段であり、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に垂直な成分である仮想面垂直抗力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分を除く成分に一致するという第１Ａ必要条件と、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に平行な成分である仮想面摩擦力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分に一致するという第１Ｂ必要条件と少なくとも満足するように、各仮想面における仮想面必要並進力を算出する仮想面必要並進力算出手段と、
    少なくとも前記算出された仮想面必要並進力に基づいて、前記ロボットの運動状態を評価する運動状態評価手段とを備えたことを特徴とする脚式移動ロボットの運動状態評価装置。
  2. 請求項１記載の脚式移動ロボットの運動状態評価装置において、
    前記運動状態評価手段は、各仮想面における仮想面必要並進力のうちの仮想面摩擦力成分の大きさが、少なくとも該仮想面における仮想面垂直抗力成分に応じて設定した第１所定値以下になるという第２必要条件を、前記算出された仮想面必要並進力が満足するか否かを判断する第１判断手段を備え、少なくとも、該第１判断手段の判断結果が否定的となり、且つ、該第１Ａ必要条件及び第１Ｂ必要条件と、前記第２必要条件とを満足させ得るように前記算出された仮想面必要並進力を修正することができない場合に、前記ロボットの運動状態が不適切であると評価することを特徴とする脚式移動ロボットの運動状態評価装置。
  3. 請求項２記載の脚式移動ロボットの運動状態評価装置において、
    前記運動状態評価手段は、前記第１判断手段の判断結果が否定的となった場合において、該判断結果が否定的となった仮想面が、前記仮想面群のうちの互いに間隔を存して対向する２つの仮想面である対向仮想面に属する仮想面であるか否かを判断する第２判断手段を備え、前記第１判断手段の判断結果と前記第２判断手段の判断結果とがいずれも否定的となる場合に、前記ロボットの運動状態が不適切であると判断することを特徴とする脚式移動ロボットの運動状態評価装置。
  4. 請求項３記載の脚式移動ロボットの運動状態評価装置において、
    前記運動状態評価手段は、前記第２判断手段の判断結果が肯定的となった場合において、前記第１判断手段の判断結果が否定的となった仮想面を含む２つの対向仮想面における前記算出された仮想面必要並進力のうちの仮想面垂直抗力成分を、前記２つの対向仮想面のそれぞれにおける仮想面垂直抗力成分のうち、小さい方の垂直抗力成分の大きさがあらかじめ設定された第２所定値以下であるという第３必要条件と、前記第１Ａ必要条件及び第２必要条件とを満足させ得るように修正することができるか否かを判断する第３判断手段を備え、前記第１判断手段の判断結果と前記対向仮想面判断手段の判断結果と前記第３判断手段の判断結果とがそれぞれ、否定的、肯定的、否定的となる場合に、前記ロボットの運動状態が不適切であると判断することを特徴とする脚式移動ロボットの運動状態評価装置。
  5. 脚式移動ロボットの動作環境に存する互いに異なる複数の接触対象面に該ロボットの複数の部位を接触させながら、該ロボットの運動を行なわせるための該ロボットの目標運動に該ロボットの実際の運動を追従させるように該ロボットの動作制御を行っている状態での該ロボットの運動状態を評価する運動状態評価装置であって、
    相互の姿勢関係があらかじめ定められた複数の仮想面から成る仮想面群を用い、該仮想面群の複数の仮想面が前記複数の接触対象面に一致又は近似する面になるように、該仮想面群を前記ロボットの動作環境の空間に仮想的に設定する仮想面群設定手段と、
    前記目標運動に基づいて、該目標運動を実現するために前記ロボットに作用させるべきトータルの外力のうちの並進力成分である基本必要総並進外力を決定する基本必要総並進外力決定手段と、
    前記ロボットの所定の運動状態量の観測値と、前記目標運動における該運動状態量の目標値との偏差である運動状態量偏差を逐次算出し、該運動状態量偏差に基づいて、該運動状態量偏差を“０”に近づけるために前記ロボットに付加的に作用させるべき並進力である並進外力補償量を決定する並進外力補償量決定手段と、
    前記決定された基本必要総並進外力に前記決定された並進外力補償量を付加してなる補償総並進外力を実現するために前記仮想面群の複数の仮想面のそれぞれから前記ロボットに作用させるべき並進力である仮想面必要並進力を算出する手段であり、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に垂直な成分である仮想面垂直抗力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分を除く成分に一致するという第１Ａ必要条件と、前記複数の仮想面のそれぞれにおける仮想面必要並進力のうちの該仮想面に平行な成分である仮想面摩擦力成分の合力が、前記補償総並進外力のうちの、前記仮想面群の全ての仮想面に対して平行な成分に一致するという第１Ｂ必要条件と、各仮想面における仮想面必要並進力のうちの仮想面摩擦力成分の大きさが、少なくとも該仮想面における仮想面垂直抗力成分に応じて設定した第１所定値以下になるという第２必要条件とを少なくとも満足するように、各仮想面における仮想面必要並進力を算出する仮想面必要並進力算出手段と、
    少なくとも前記算出された仮想面必要並進力に基づいて、前記ロボットの運動状態を評価する運動状態評価手段とを備え、
    前記運動状態評価手段は、前記仮想面群のうち、互いに間隔を存して対向する前記２つの接触対象面に対応する２つの仮想面である対向仮想面のそれぞれにおける仮想面垂直抗力成分のうち、小さい方の垂直抗力成分の大きさがあらかじめ設定された第２所定値以下であるという第３必要条件を、前記対向仮想面に関して前記算出された仮想面必要並進力が満足するか否かを判断する第４判断手段を備え、
    該第４判断手の判断結果が否定的となり、且つ、前記第１Ａ必要条件と、前記第３必要条件とを満足させ得るように、前記対向仮想面に関して前記算出された仮想面必要並進力のうちの仮想面垂直抗力成分を修正することができない場合に、前記ロボットの運動状態が不適切であると評価することを特徴とする脚式移動ロボットの運動状態評価装置。
JP2010044713A 2010-03-01 2010-03-01 脚式移動ロボットの運動状態評価装置 Active JP5398592B2 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2010044713A JP5398592B2 (ja) 2010-03-01 2010-03-01 脚式移動ロボットの運動状態評価装置
US13/036,298 US8442680B2 (en) 2010-03-01 2011-02-28 Motion state evaluation apparatus of legged mobile robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010044713A JP5398592B2 (ja) 2010-03-01 2010-03-01 脚式移動ロボットの運動状態評価装置

Publications (2)

Publication Number Publication Date
JP2011177839A true JP2011177839A (ja) 2011-09-15
JP5398592B2 JP5398592B2 (ja) 2014-01-29

Family

ID=44505721

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010044713A Active JP5398592B2 (ja) 2010-03-01 2010-03-01 脚式移動ロボットの運動状態評価装置

Country Status (2)

Country Link
US (1) US8442680B2 (ja)
JP (1) JP5398592B2 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015087504A1 (ja) * 2013-12-10 2015-06-18 トヨタ自動車株式会社 移動ロボットの移動制御方法、および、移動ロボット
JPWO2017135053A1 (ja) * 2016-02-04 2018-08-09 シャープ株式会社 ロボット、ロボットの制御方法、制御プログラムおよび記録媒体

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8428780B2 (en) * 2010-03-01 2013-04-23 Honda Motor Co., Ltd. External force target generating device of legged mobile robot
JP5398589B2 (ja) * 2010-03-01 2014-01-29 本田技研工業株式会社 脚式移動ロボットの目標運動評価装置
JP5398592B2 (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
JP5991857B2 (ja) * 2011-06-10 2016-09-14 三星電子株式会社Ｓａｍｓｕｎｇ Ｅｌｅｃｔｒｏｎｉｃｓ Ｃｏ．，Ｌｔｄ． ロボットの均衡制御装置及びその制御方法
JP5962020B2 (ja) * 2012-01-17 2016-08-03 セイコーエプソン株式会社 ロボット制御装置、ロボットシステム、ロボット及びロボット制御方法
JP5966372B2 (ja) 2012-01-17 2016-08-10 セイコーエプソン株式会社 ロボット制御装置、ロボットシステム、ロボット制御方法及びロボット
US9272421B2 (en) * 2013-01-07 2016-03-01 Milos Misha Subotincic Visually controlled end effector
US9440353B1 (en) * 2014-12-29 2016-09-13 Google Inc. Offline determination of robot behavior
JP6447278B2 (ja) * 2015-03-18 2019-01-09 トヨタ自動車株式会社 多点接触ロボット、多点接触ロボットの制御方法及びプログラム
US10589810B2 (en) * 2015-04-02 2020-03-17 Osaka University Legged mechanism, walking robot, method for controlling posture, and recording medium
CN112572634B (zh) * 2020-11-16 2023-03-31 长春工业大学 一种轮足混合行走机器人结构及控制系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS57102782A (en) * 1980-12-12 1982-06-25 Mitsubishi Heavy Ind Ltd Travelling device
JPS62185907U (ja) * 1986-05-20 1987-11-26
JPH03111182A (ja) * 1989-09-22 1991-05-10 Res Dev Corp Of Japan ３次元運動機構

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4826392A (en) * 1986-03-31 1989-05-02 California Institute Of Technology Method and apparatus for hybrid position/force control of multi-arm cooperating robots
JPH04246638A (ja) 1991-01-31 1992-09-02 Canon Inc カメラの磁気再生装置
US5872893A (en) * 1996-07-25 1999-02-16 Honda Giken Kogyo Kabushiki Kaisha Gait generation system of legged mobile robot
WO2003057423A1 (fr) * 2001-12-28 2003-07-17 Honda Giken Kogyo Kabushiki Kaisha Dispositif de production de demarche pour robot se deplaçant sur des jambes
WO2003061917A1 (fr) 2002-01-18 2003-07-31 Honda Giken Kogyo Kabushiki Kaisha Dispositif de commande pour robot bipede
US7603199B2 (en) * 2003-11-27 2009-10-13 Honda Motor Co., Ltd. Control device for mobile body
US7734375B2 (en) * 2004-06-09 2010-06-08 Boston Dynamics Robot and robot leg mechanism
US8066088B2 (en) * 2004-12-09 2011-11-29 The Board Of Trustees Of The Leland Stanford Junior University Biologically inspired climbing device
US7339340B2 (en) * 2005-03-23 2008-03-04 Harris Corporation Control system and related method for multi-limbed, multi-legged robot
US7554787B2 (en) * 2006-06-05 2009-06-30 Sri International Wall crawling devices
KR100812724B1 (ko) * 2006-09-29 2008-03-12 삼성중공업 주식회사 실내 위치측정시스템을 이용한 벽면 이동 로봇
WO2008076194A2 (en) * 2006-11-13 2008-06-26 Raytheon Sarcos Llc Serpentine robotic crawler
US8428780B2 (en) * 2010-03-01 2013-04-23 Honda Motor Co., Ltd. External force target generating device of legged mobile robot
JP5398592B2 (ja) * 2010-03-01 2014-01-29 本田技研工業株式会社 脚式移動ロボットの運動状態評価装置
JP5398589B2 (ja) * 2010-03-01 2014-01-29 本田技研工業株式会社 脚式移動ロボットの目標運動評価装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS57102782A (en) * 1980-12-12 1982-06-25 Mitsubishi Heavy Ind Ltd Travelling device
JPS62185907U (ja) * 1986-05-20 1987-11-26
JPH03111182A (ja) * 1989-09-22 1991-05-10 Res Dev Corp Of Japan ３次元運動機構

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015087504A1 (ja) * 2013-12-10 2015-06-18 トヨタ自動車株式会社 移動ロボットの移動制御方法、および、移動ロボット
JPWO2015087504A1 (ja) * 2013-12-10 2017-03-16 トヨタ自動車株式会社 移動ロボットの移動制御方法、および、移動ロボット
JPWO2017135053A1 (ja) * 2016-02-04 2018-08-09 シャープ株式会社 ロボット、ロボットの制御方法、制御プログラムおよび記録媒体

Also Published As

Publication number Publication date
JP5398592B2 (ja) 2014-01-29
US20110213496A1 (en) 2011-09-01
US8442680B2 (en) 2013-05-14

Similar Documents

Publication Publication Date Title
JP5398592B2 (ja) 脚式移動ロボットの運動状態評価装置
JP5398589B2 (ja) 脚式移動ロボットの目標運動評価装置
US8428780B2 (en) External force target generating device of legged mobile robot
JP3790816B2 (ja) 人型リンク系の運動生成方法
KR100709556B1 (ko) 인간형 로봇의 보행 제어 방법
JP2001157973A (ja) ロボットの歩行制御装置及び歩行制御方法
US9597798B2 (en) Control method of robot apparatus and robot apparatus
KR20020086468A (ko) 각식 이동 로봇을 위한 동작 제어 장치 및 동작 제어방법, 및 로봇 장치
JP2001277159A (ja) 脚式移動ロボット及びその制御方法、並びに、脚式移動ロボット用相対移動測定センサ
Kim et al. Computationally-robust and efficient prioritized whole-body controller with contact constraints
US8396593B2 (en) Gait generating device of legged mobile robot
Li et al. Force-and-moment-based model predictive control for achieving highly dynamic locomotion on bipedal robots
Lim et al. Backward ladder climbing locomotion of humanoid robot with gain overriding method on position control
Figueroa et al. A dynamical system approach for adaptive grasping, navigation and co-manipulation with humanoid robots
JP5398591B2 (ja) 脚式移動ロボットの外力目標生成装置
JP5398590B2 (ja) 脚式移動ロボットの外力目標生成装置
JP5099733B2 (ja) 脚式移動ロボットの制御装置
JP5398588B2 (ja) 脚式移動ロボットの歩容生成装置
JP2003117858A (ja) ロボットの歩行制御装置及び歩行制御方法
JP3555945B2 (ja) ロボット装置のためのモーション編集装置及びモーション編集方法、ロボット装置及びロボット装置の制御方法、並びにコンピュータ・プログラム
JP5398587B2 (ja) 脚式移動ロボットの歩容生成装置
Pournazhdi et al. Dynamic modeling and sliding mode control for fast walking of seven-link biped robot
Bazargan-Lari et al. A More Realistic Replica of a Walking Biped for Implying Dynamics and Control On Ascending and Descending Stairs by Considering Self-Impact Joint Constraint
JP4707290B2 (ja) 脚式移動ロボットの動作制御装置及び動作制御方法
CN117260718A (zh) 一种四足机器人的自适应载荷补偿控制方法及系统

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20121127

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: 20131001

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20131022

R150 Certificate of patent or registration of utility model

Ref document number: 5398592

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250