JP4130739B2 - 二足歩行移動体の床反力推定方法 - Google Patents
二足歩行移動体の床反力推定方法 Download PDFInfo
- Publication number
- JP4130739B2 JP4130739B2 JP2002018789A JP2002018789A JP4130739B2 JP 4130739 B2 JP4130739 B2 JP 4130739B2 JP 2002018789 A JP2002018789 A JP 2002018789A JP 2002018789 A JP2002018789 A JP 2002018789A JP 4130739 B2 JP4130739 B2 JP 4130739B2
- Authority
- JP
- Japan
- Prior art keywords
- leg
- reaction force
- floor reaction
- gravity
- center
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
-
- 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
Description
【０００１】
【発明の属する技術分野】
本発明は、人間や二足歩行ロボット等の二足歩行移動体の脚体に作用する床反力、特に、二足歩行移動体の運動状態が該二足歩行移動体の両脚体が接地している両脚支持状態であるときの各脚体に作用する床反力の鉛直方向成分を推定する方法に関する。
【０００２】
【従来の技術】
例えば人間の歩行動作を補助する歩行アシスト装置の動作制御や、二足歩行ロボットの移動動作の制御を行なう場合、人間や二足歩行ロボットの脚体に作用する床反力（詳しくは、脚体の接地部に床から作用する力）を逐次把握することが必要となる。この床反力を把握することで、二足歩行移動体の脚体の関節に作用するモーメント等を把握することが可能となり、その把握されたモーメント等に基づいて歩行アシスト装置の目標補助力や、二足歩行ロボット各関節の目標駆動トルク等を決定することが可能となる。
【０００３】
前記床反力を把握する手法としては、例えば特開2000-249570号公報に開示されているものが知られている。この技術では、二足歩行移動体の定常的な歩行時に各脚体の床反力の経時変化の波形が周期的に変化することから、各脚体の床反力を、歩行周期の１／ｎ（ｎ＝１，２，…）の互いに異なる周期を有する複数の三角関数の合成値（一次結合）として把握するものである。この場合、複数の三角関数を合成する際の各三角関数の重み係数は、二足歩行移動体毎にあらかじめ定めた所定値やそれを地形に応じて調整した値が用いられている。
【０００４】
しかしながら、かかる技術では、二足歩行移動体の一歩分もしくは複数歩分について脚体の床反力を把握しようとするものであるため、二足歩行移動体の歩容が逐次変化するような場合には、床反力を精度よく把握することは困難である。また、把握される床反力の精度を高めるためには、前記三角関数の重み係数を二足歩行移動体毎に設定したり、地形等に応じて調整したりしなければならないので、二足歩行移動体の移動環境や二足歩行移動体の個体差の影響を少なくして、床反力を精度よく把握するようにすることが困難である。
【０００５】
また、例えば二足歩行ロボットにおいては、各脚体の足首部や足平部に６軸力センサ等の力センサを取り付け、この力センサの出力により床反力を把握するものも知られている。さらに、床に設置したフォースプレート上で二足歩行移動体を歩行させ、該フォースプレートの出力により床反力を把握する手法も知られている。
【０００６】
しかしながら、力センサを用いる技術では、特に人間の脚体の床反力を把握しようとする場合には、人間の足首部や足平部に力センサを取り付けなければならないため、通常的な生活環境下では、該力センサが歩行の邪魔になってしまうという不都合がある。また、フォースプレートを用いるものでは、該フォースプレートが設置された環境下でしか床反力を把握できない。
【０００７】
かかる不具合を解消するため、本願出願人は、先に、特願2001-214174号により以下の床反力推定方法を提案している。この方法の原理を図１を参照して説明する。二足歩行移動体の運動状態（歩行動作時の脚体の運動状態）は、図１（ａ）に例示するように二足歩行移動体１の両脚体２，２のうちの一方の脚体２（図では進行方向で前側の脚体）のみが接地する単脚支持状態と、図１（ｂ）に示すように両脚体２，２が接地する両脚支持状態とがある。
【０００８】
ここで、両脚体２，２に床Ａから作用する全床反力をＦとおくと、該全床反力Ｆは、図１（ａ）の単脚支持状態では、接地している脚体２に作用する床反力に等しく、また、図１（ｂ）の両脚支持状態では、両脚体２，２にそれぞれ作用する床反力Ff，Frの合力である。また、二足歩行移動体１が運動を行う床Ａに対して固定した絶対座標系Ｃfにおける二足歩行移動体１の重心G0の加速度ａのＸ軸方向（二足歩行移動体２の進行方向での水平方向）、Ｚ軸方向（鉛直方向）の成分をそれぞれａx，ａz、二足歩行移動体１に作用する全床反力ＦのＸ軸方向、Ｚ軸方向の成分をそれぞれＦx，Ｆzとおくと、重心Ｇ0の運動方程式（詳しくは、重心G0の並進運動に関する運動方程式）は、次式（１）により表される。
【０００９】
T(Ｆx，Ｆz−Ｍ・ｇ)＝Ｍ・T(ａx，ａz) ……（１）
（但し、Ｍ：二足歩行移動体の重量、ｇ：重力加速度）
尚、式（１）中の両辺の括弧部分T( ， ）は２成分のベクトルを意味している。本明細書ではT( ， ）という形の表記は、ベクトルを表す。
【００１０】
つまり、重心G0の運動方程式は、該重心G0の加速度ａと二足歩行移動体１の重量Ｍとの積が、該重心G0に作用する重力（＝Ｍ・ｇ）と、前記全床反力Ｆとの合力に等しいという関係式になる。
【００１１】
従って、二足歩行移動体１の重心Ｇ0の加速度ａ＝T(ａx，ａz)を把握すれば、その加速度ａと、二足歩行移動体１の重量Ｍの値と、重力加速度ｇの値とを用いて、次式（２）により、全床反力Ｆ＝T(Ｆx，Ｆz)の推定値を得ることができることとなる。
【００１２】
T(Ｆx，Ｆz)＝Ｍ・T(ａx，ａz＋ｇ) ……（２）
【００１３】
そして、図１（ａ）の単脚支持状態では、接地している単一の脚体２に作用する床反力は、上記全床反力Ｆに等しいので、式（２）によりその単一の脚体２に作用する床反力Ｆの推定値が得られることとなる。
【００１４】
この場合、床反力Ｆの推定値を得るために必要な重量Ｍは、あらかじめ計測等により把握することができる。また、重心Ｇ0の位置や加速度ａについては、詳細は後述するが、二足歩行移動体１の各関節の屈曲角度（回転角度）を検出するセンサや、加速度センサ、ジャイロセンサ等のセンサの出力を用いて公知の手法等により逐次把握することが可能である。
【００１５】
また、図１（ｂ）の両脚支持状態では、前側脚体２の床反力FfのＸ軸方向、Ｚ軸方向の成分をそれぞれＦfx，Ｆfz、後側脚体２の床反力ＦrのＸ軸方向、Ｚ軸方向の成分をそれぞれＦrx，Ｆrzとして、全床反力ＦのＸ軸方向、Ｚ軸方向の成分Ｆx，ＦzはそれぞれＦfx＋Ｆrx，Ｆfz＋Ｆrzになり、重心Ｇ0の運動方程式は、次式（３）により表される。
【００１６】
T(Ｆfx＋Ｆrx，Ｆfz＋Ｆrz−Ｍ・ｇ)＝Ｍ・T(ａx，ａz) ……（３）
【００１７】
ここで、両脚支持状態において、各脚体２，２の床反力Ｆf，Ｆrは、図１（ｂ）に示すように、各脚体２，２の下端部近傍の特定部位１２f，１２r（例えば足首部）から二足歩行移動体１の重心Ｇ0に向かって作用すると仮定する。この場合、前記重心Ｇ0に対する各脚体２，２の前記特定部位１２f，１２rの位置と、各脚体２，２に作用する床反力Ｆf，Ｆrとの間には一定の関係式、すなわち、前記重心Ｇ0と各脚体２，２の特定部位１２f，１２rとを結ぶ線分の向き（該重心Ｇ0に対する該特定部位１２f，１２rの位置ベクトルの向き）が該脚体２，２に係る床反力Ｆf，Ｆrの向きに等しいという関係を表す関係式が成立する。
【００１８】
具体的には、図１（ｂ）を参照して、前記絶対座標系Ｃｆにおける重心Ｇ0の位置の座標を（Ｘg，Ｚg）、前側脚体２の特定部位１２fの位置の座標を（Ｘf，Ｚf）、後側脚体２の特定部位１２rの位置の座標を（Ｘr，Ｚr）とおくと、上記の関係式は次式（４）となる。
【００１９】
(Ｚf−Ｚg)／(Ｘf−Ｘg)＝Ｆfz／Ｆfx
(Ｚr−Ｚg)／(Ｘr−Ｘg)＝Ｆrz／Ｆrx……（４）
【００２０】
そして、この式（４）と前記式（３）から次式（５）（５’）が得られる。
【００２１】
Ｆfx＝Ｍ・｛ΔＸf・(ΔＺr・ａx−ΔＸr・ａz
−ΔＸr・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf)
Ｆrx＝Ｍ・｛ΔＸr・(−ΔＺf・ａx＋ΔＸf・ａz
＋ΔＸf・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf) ……（５）
Ｆfz＝Ｍ・｛ΔＺf・(ΔＺr・ａx−ΔＸr・ａz
−ΔＸr・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf)
Ｆrz＝Ｍ・｛ΔＺr・(−ΔＺf・ａx＋ΔＸf・ａz
＋ΔＸf・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf)……（５’）
（但し、ΔＺf＝Ｘf−Ｘg，ΔＺf＝Ｚf−Ｚg，
ΔＸr＝Ｘr−Ｘg，ΔＺr＝Ｚr−Ｚg）
【００２２】
従って、二足歩行移動体１の重心Ｇ0の加速度ａ＝T(ａx，ａz)を把握すると共に、二足歩行移動体１の重心Ｇ0に対する各脚体２，２のそれぞれの特定部位１２f，１２rの位置（これは式（５）（５’）ではΔＸf，ΔＺf，ΔＸr，ΔＺrにより表される）を把握すれば、その加速度ａ及び特定部位１２f，１２rの位置と、二足歩行移動体１の重量Ｍの値と、重力加速度ｇの値とを用いて、前記式（５）（５’）により、各脚体２毎の床反力Ｆf＝T(Ｆfx，Ｆfz)、Ｆr＝T(Ｆrx，Ｆrz)の推定値を得ることができることとなる。
【００２３】
この場合、床反力Ｆf，Ｆrの推定値を得るために必要な重量Ｍは、あらかじめ計測等により把握することができる。また、重心Ｇ0の加速度ａや重心Ｇ0の位置、該重心Ｇ0に対する前記特定部位１２f，１２rの位置については、詳細は後述するが、二足歩行移動体１の各関節の屈曲角度（回転角度）を検出するセンサや、加速度センサ、ジャイロセンサ等のセンサの出力を用いて、公知の手法等により逐次把握することが可能である。
【００２４】
然し、上記先願の方法で求めた両脚支持状態における各脚体の床反力の鉛直方向成分Ｆfz，Ｆrzの推定値は必ずしも満足できる精度ではないことが判明した。これは、各脚体２，２の床反力Ｆf，Ｆrが各脚体２，２の特定部位１２f，１２rから二足歩行移動体１の重心Ｇ0に向かって作用するとは限らないためである。そして、二足歩行移動体１の重量の影響で大きな値になる床反力の鉛直方向成分の推定値は進行方向成分に比し誤差が大きくなる。
【００２５】
【発明が解決しようとする課題】
本発明は、以上の点に鑑み、比較的簡単な手法で両脚支持状態における各脚体の床反力の鉛直方向成分を精度よくリアルタイムで把握することができ、特に二足歩行移動体としての人間に係る床反力を把握する上で好適な床反力推定方法を提供することを課題としている。
【００２６】
【課題を解決するための手段】
本発明の二足歩行移動体の床反力推定方法、すなわち、二足歩行移動体の運動状態が該二足歩行移動体の両脚体が接地している両脚支持状態であるときの各脚体に作用する床反力の鉛直方向成分を推定する方法は、上記課題を解決するため、二足歩行移動体の重心の位置を逐次求めつつ、該重心の位置の時系列データを用いて床に対して固定された絶対座標系での該重心の加速度を逐次求める第１ステップと、二足歩行移動体の重量と重力加速度と前記重心の加速度と各脚体に作用する床反力の合力である全床反力とにより表される該重心の運動方程式に基づき、該全床反力の推定値を逐次求める第２ステップと、前記両脚支持状態において両脚体のうち少なくとも二足歩行移動体の進行方向に向かって前側に存する前側脚体の足平部のあらかじめ定めた特定部位の床面からの位置を逐次求める第３ステップとを備え、前記両脚支持状態であるときには、両脚体のうち該二足歩行移動体の進行方向に向かって後側に存する後側脚体に作用する床反力の鉛直方向成分と、前側脚体の足平部の前記特定部位の床面からの位置との間に成立する所定の相関関係に基づき、前記第３ステップで求めた前側脚体の足平部の前記特定部位の床面からの位置を用いて後側脚体に作用する床反力の鉛直方向成分の推定値を逐次求め、その求めた後側脚体の床反力の鉛直方向成分の推定値を前記第２ステップで求めた全床反力の鉛直方向成分の推定値から差し引くことにより、前側脚体に作用する床反力の鉛直方向成分の推定値を逐次求めることを特徴とする。
【００２７】
本願発明者は、鋭意努力の結果、両脚支持状態において後側脚体に作用する床反力の鉛直方向成分は、前側脚体の足平部の踵が着床して両脚支持状態に移行してから、前側脚体の足平部の特定部位（例えば中足趾節関節）の床面からの位置変化に対して顕著な相関性を持って変化することを知見するに至った。従って、後側脚体に作用する床反力の鉛直方向成分と前側脚体の足平部の特定部位の床面からの位置との間に成立する相関関係を各種実験やシミュレーション等であらかじめ調べておけば、その相関関係に基づいて、本発明のように前側脚体の足平部の特定部位の床面からの位置を用いて後側脚体に作用する床反力の鉛直方向成分を推定することができる。そして、後側脚体に作用する床反力と前側脚体に作用する床反力の合力が全床反力であるので、この全床反力の鉛直方向成分の推定値から、上記相関関係に基づいて求められる後側脚体に作用する床反力の鉛直方向成分の推定値を差し引くことにより、前側脚体に作用する床反力の鉛直方向成分の推定値を求めることができる。
【００２８】
尚、後側と前側の各脚体に作用する床反力の進行方向成分の推定値は、適宜の手法、例えば、上記先願と同様に上記式（５）から求めればよい。
【００２９】
ここで、本発明における全床反力の推定値は上記先願と同様の手法で求められる。そして、この全床反力の推定値を求めるために必要な二足歩行移動体の重量は、あらかじめ計測等により把握しておけばよい。また、二足歩行移動体の重心の位置や加速度は、二足歩行移動体の各関節の屈曲角度（回転角度）を検出するセンサ（ポテンショメータ等）や、加速度センサ、ジャイロセンサ等、比較的小型で二足歩行移動体への装備が容易なセンサの出力のデータを用いてリアルタイムで把握することが可能であり、足平部の特定部位の床面からの位置も、履き物等に傾斜測定用の簡易な加速度センサ等を装備しておくことによりリアルタイムで把握することが可能である。
【００３０】
従って、本発明の床反力推定方法によれば、二足歩行移動体の足首部や足平部に力センサを装着したり、フォースプレートを使用したりすることなく、比較的簡単な手法で床反力をリアルタイムで把握することができる。
【００３１】
【発明の実施の形態】
本発明の一実施形態を図２〜図９を参照して説明する。
【００３２】
本実施形態は、二足歩行移動体としての人間に本発明の床反力推定方法を適用した実施形態である。
【００３３】
図２に模式化して示すように、人間１は、その構成を大別すると、左右一対の脚体２，２と、腰部３及び胸部４からなる胴体５と、頭部６と、左右一対の腕体７，７とを有する。胴体５は、その腰部３が脚体２，２のそれぞれに左右一対の股関節８，８を介して連結され、両脚体２，２上に支持されている。また、胴体５の胸部４は、腰部３の上側に該腰部３に対して人間１の前方側に傾斜可能に存している。そして、この胸部４の上部の左右両側部から腕体７，７が延設され、該胸部４の上端部に頭部６が支持されている。
【００３４】
各脚体２，２は、股関節８から延在する大腿部９と、該大腿部９の先端から膝関節１０を介して延在する下腿部１１とを有し、下腿部１１の先端部に、足首部（足首関節）１２を介して足平部１３が連結されている。
【００３５】
本実施形態では、このような構成を有する人間１の各脚体２に作用する床反力の推定、さらには膝関節１０及び股関節８に作用するモーメントの推定を行うために、次のような装置を人間１に装備している。
【００３６】
すなわち、胴体５の胸部４には、胸部４の傾斜に伴う角速度に応じた出力を発生するジャイロセンサ１４（以下、胸部ジャイロセンサ１４という）と、胸部４の前後方向の加速度に応じた出力を発生する加速度センサ１５（以下、胸部前後加速度センサ１５という）と、CPU、RAM、ROM等から構成される演算処理装置１６と、該演算処理装置１６等の電源となるバッテリ１７とが装着されている。この場合、これらの胸部ジャイロセンサ１４、胸部前後加速度センサ１５、演算処理装置１６及びバッテリ１７は、例えば胸部４に図示しないベルト等を介して固定されるショルダーバッグ状の収容部材１８に収容され、該収容部材１８を介して胸部４に一体的に固定されている。
【００３７】
尚、胸部加速度センサ１５の出力が表す加速度は、より詳しくは、胸部４の水平断面方向（胸部４の軸心と直交する方向）での前後方向の加速度であり、人間１が平地に直立姿勢で起立した状態では、前後水平方向（図２の絶対座標系のＸ軸方向）での加速度であるが、腰部３あるいは胸部４が鉛直方向（図２の絶対座標系のＺ軸方向）から傾斜した状態では、胸部４の鉛直方向に対する傾斜角度分だけ水平方向に対して傾斜した方向での加速度となる。
【００３８】
また、胴体５の腰部３には、腰部３の傾斜に伴う角速度に応じた出力を発生するジャイロセンサ１９（以下、腰部ジャイロセンサ１９という）と、腰部３の前後方向の加速度に応じた出力を発生する加速度センサ２０（以下、腰部前後加速度センサ２０という）と、腰部３の上下方向の加速度に応じた出力を発生する加速度センサ２１（以下、腰部上下加速度センサ２１という）とが、図示しないベルト等の固定手段を介して一体的に装着・固定されている。
【００３９】
ここで、腰部前後加速度センサ２０は、より詳しくは胸部前後加速度センサ１５と同様、腰部３の水平断面方向（腰部３の軸心と直交する方向）での前後方向の加速度を検出するセンサである。また、腰部上下加速度センサ２１は、より詳しくは、腰部３の軸心方向での上下方向の加速度（これは腰部前後加速度センサ２０が検出する加速度と直交する）を検出するセンサである。尚、腰部前後加速度センサ２０及び腰部上下加速度センサ２１は、二軸型の加速度センサにより一体的に構成されたものであってもよい。
【００４０】
さらに各脚体２の股関節８と膝関節１０とには、それぞれの屈曲角度Δθc，Δθdに応じた出力を発生する膝関節角度センサ２２及び股関節角度センサ２３が装着されている。尚、股関節角度センサ２２については、図２では手前側（人間１の前方に向かって右側）の脚体２の股関節８に係わる股関節角度センサ２２のみが図示されているが、他方側（人間１の前方に向かって左側）の脚体２の股関節８には、手前側の股関節角度センサ２２と同心に、股関節角度センサ２２が装着されている。
【００４１】
これらの角度センサ２２，２３は、例えばポテンショメータにより構成されたものであり、各脚体２に図示しないバンド部材等の手段を介して装着されている。ここで、各股関節角度センサ２２が検出する屈曲角度Δθcは、より詳しくは、腰部３と各脚体２の大腿部９との姿勢関係が所定の姿勢関係（例えば人間１の直立姿勢状態のように腰部３の軸心と大腿部９の軸心とがほぼ平行となる姿勢関係）にあるときを基準とした、腰部３に対する各脚体２の大腿部９の股関節８回り（人間１の左右方向における股関節８の軸心回り）の回転角度である。同様に、各膝関節角度センサ２３が検出する屈曲角度Δθdは、各脚体２の大腿部９と下腿部１１との姿勢関係が所定の姿勢関係（例えば大腿部９の軸心と下腿部１１の軸心とがほぼ平行となる姿勢関係）にあるときを基準とした、大腿部９に対する下腿部１１の膝関節１０回り（人間１の左右方向における膝関節１０の軸心回り）の回転角度である。
【００４２】
また、各脚体２の足平部１３の特定部位、例えば、中足趾節関節の床面からの位置（以下ＭＰ高さと記す）を計測するためのセンサが設けられている。これを図３を参照して詳述するに、足平部１３の踵１３ａから中足趾節関節１３ｂまでは剛体と仮定でき、ＭＰ高さＨは、踵１３ａから中足趾節関節１３ｂまでの距離をＤ、床面に対する足平部１３の傾斜角度をθとして、Ｈ＝Ｄｓｉｎθになる。そして、足平部１３の長手方向の加速度を検出する加速度センサ２４を履き物等に装備しておけば、この加速度センサ２４による計測加速度をｇｓ、重力加速度をｇとして、θ＝Ａｒｃｓｉｎ（ｇｓ／ｇ）の式でθを算出でき、このθを用いてＭＰ高さＨを求められる。ここで、両脚支持状態では、人間１の進行方向に向かって前側の脚体２の踵位置は加速せず、加速度センサ２４は足平部１３の傾斜角度θに応じた加速度を正確に検出する。従って、加速度センサ２４により足平部１３の傾斜角度θひいてはＭＰ高さＨを正確に計測できる。尚、加速度センサ２４に作用する接地衝撃を減らすため、加速度センサ２４の装備位置は踵から離れたつま先側にすることが望ましい。
【００４３】
前記各センサ１４，１５，１９〜２４は、それらの出力を演算処理装置１６に入力すべく、図示を省略する信号線を介して演算処理装置１６に接続されている。
【００４４】
前記演算処理装置１６は、図４に示すような機能的手段を備えている。すなわち、演算処理装置１６は、腰部上下加速度センサ２１の検出データと、後述する床反力推定手段３８により求められた各脚体２の床反力の推定値のデータとを用いて、人間１の脚体２，２の運動状態が単脚支持状態（図１（ａ）の状態）であるか、両脚支持状態（図１（ｂ）の状態）であるかを判断する脚体運動判断手段２５を備えている。また、演算処理装置１６は、胸部前後加速度センサ１５及び胸部ジャイロセンサ１４の検出データを用いて、胸部４の絶対座標系Ｃfにおける傾斜角度θa（具体的には例えば鉛直方向に対する傾斜角度θa。図２参照）を計測する胸部傾斜角度計測手段２６と、腰部前後加速度センサ２０及び腰部ジャイロセンサ１９の検出データを用いて、腰部３の絶対座標系Ｃfにおける傾斜角度θb（具体的には例えば鉛直方向に対する傾斜角度θb。図２参照）を計測する腰部傾斜角度計測手段２７とを備えている。
【００４５】
さらに、演算処理装置１６は、腰部前後加速度センサ２０及び腰部上下加速度センサ２１の検出データと前記腰部傾斜角度計測手段２７により計測された腰部３の傾斜角度θbのデータとを用いて、本実施形態における人間１の基準点として図２に示すように腰部３に設定される身体座標系Ｃp（図２のｘｚ座標）の原点Ｏの絶対座標系Ｃfにおける加速度（並進加速度）ａ0＝T(ａ0x，ａ0z)を求める基準加速度計測手段２８を備えている。ここで、身体座標系Ｃｐは、より詳しくは、例えば人間１の左右の股関節８，８のそれぞれの中心を結ぶ線の中点を原点Ｏとし、鉛直方向をｚ軸方向、人間１の前方に向かう水平方向をｘ軸方向とした座標系（３軸の方向が前記絶対座標系Ｃfと同一の座標系）である。
【００４６】
また、演算処理装置１６は、各脚体２の股関節角度センサ２２及び膝関節角度センサ２３の検出データと、前記腰部傾斜角度計測手段２７による腰部３の傾斜角度θbのデータとを用いて、絶対座標系Ｃfにおける各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θd（具体的には例えば鉛直方向に対する傾斜角度θc，θd。図２参照）求める脚体姿勢算出手段２９を備えている。
【００４７】
また、演算処理装置１６は、前記胸部傾斜角度計測手段２６、腰部傾斜角度計測手段２７及び脚体姿勢算出手段２９により得られる胸部４の傾斜角度θa、腰部３の傾斜角度θb、並びに各脚体２の大腿部９の傾斜角度θc及び下腿部１１の傾斜角度θdのデータを用いて、後述の剛体リンクモデルに対応する人間１の各剛体相当部の重心の位置（詳しくは前記身体座標系Ｃpにおける各剛体相当部の重心の位置）を求める各部重心位置算出手段３０と、その各剛体相当部の重心の位置のデータを用いて、上記身体座標系Ｃpにおける人間１の全体の重心の位置を求める身体重心位置算出手段３１と、その人間１の全体の重心G0（図１参照。以下、身体重心G0という）の位置のデータと前記脚体姿勢算出手段２９による各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータとを用いて本実施形態における各脚体２の特定部位としての各脚体２の足首部１２の身体重心G0に対する位置（詳しくは、前記式（５）におけるΔＸf，ΔＺf，ΔＸr，ΔＺr）を求める足首位置算出手段３２と、前記足平部加速度センサ２４の検出データを用いてＭＰ高さＨを求めるＭＰ高さ算出手段３３と、前記身体重心位置算出手段３１による身体重心の位置のデータと前記基準加速度計測手段２７による身体座標系Ｃpの原点Ｏの加速度ａ0のデータとを用いて絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ａx，ａz)(図１参照）を求める身体重心加速度算出手段３４とを備えている。
【００４８】
さらに、演算処理装置１６は、前記各部重心位置算出手段３０による人間１の各剛体相当部の重心の位置（詳しくは脚体２に係わる剛体相当部の重心の位置）のデータと前記基準加速度計測手段２８による身体座標系Cpの原点Ｏの加速度ａ0のデータとを用いて絶対座標系Ｃfにおける各脚体２の大腿部９及び下腿部１１のそれぞれの重心の加速度（並進加速度）を求める脚体各部加速度算出手段３５と、前記脚体姿勢算出手段２９による各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータを用いて絶対座標系Ｃfにおける各脚体２，２の大腿部９及び下腿部１１の角加速度を求める脚体各部角加速度算出手段３６と、前記脚体姿勢算出手段２８による各脚体２，２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのうち、例えば大腿部９の傾斜角度θcのデータを用いて接地している各脚体２の床反力作用点の位置を推定する床反力作用点推定手段３７とを備えている。
【００４９】
また、演算処理装置１６は、前記身体重心加速度算出手段３４による身体重心の加速度ａのデータと前記足首位置算出手段３２による足首位置のデータと前記ＭＰ高さ算出手段３３によるＭＰ高さＨのデータと前記脚体運動判断手段２５による脚体２の運動状態の判断結果のデータとを用いて各脚体２に作用する床反力の推定値を求める床反力推定手段３８と、この床反力の推定値のデータと脚体各部加速度算出手段３５による各脚体２の大腿部９及び下腿部１１の重心の加速度のデータと脚体各部角加速度算出手段３６による各脚体２の大腿部９及び下腿部１１の角加速度のデータと床反力作用点推定手段３７による床反力作用点の推定位置のデータと前記脚体姿勢算出手段２９による各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータとを用いて各脚体２の膝関節１０及び股関節８にそれぞれ作用するモーメントを推定する関節モーメント推定手段３９とを備えている。
【００５０】
次に、上述の演算処理装置１６の各手段のより詳細な処理内容と併せて、本実施形態の作動を説明する。
【００５１】
本実施形態では、例えば人間１が歩行等の脚体２の運動を行うに際して、両脚体２，２を着床させた状態で演算処理装置１６の図示しない電源スイッチを投入すると、該演算処理装置１６による処理が所定のサイクルタイム毎に以下に説明するように逐次実行され、各脚体２に作用する床反力の推定値等が逐次求められる。
【００５２】
すなわち、まず、演算処理装置１６は、前記脚体運動判断手段２５の処理を実行する。この脚体運動判断手段２５の処理では、前記サイクルタイム毎に、前記腰部上下加速度センサ２１による腰部３の上向き方向の加速度の検出データがあらかじめ定めた所定の閾値と比較される。そして、該加速度の検出値がその閾値を超えたときに、前記図１（ｂ）に示したような両脚支持状態が開始し、且つ、前記図１（ａ）に示したような単脚支持状態が終了すると判断される。すなわち、人間１の歩行時に、単脚支持状態から両脚支持状態への移行の際には、遊脚側の脚体２が着床することで、股関節８の近傍の腰部３には、ほぼ上向きに比較的大きな加速度（通常的な単脚支持状態では発生し得ない加速度）が発生する。このため、前記脚体運動判断手段２５は、上記のように腰部上下加速度センサ２１による腰部３の上向き方向の加速度の検出データを所定の閾値と比較することで、両脚支持状態の開始及び単脚支持状態の終了を判断する。
【００５３】
また、脚体運動判断手段２５の処理では、両脚支持状態で床反力推定手段３８により後述するように求められた両脚体２，２のそれぞれに作用する床反力Ｆf，Ｆr（図１（ｂ）参照）の推定値のうち、人間１の進行方向に対して後側の脚体２に係る床反力Ｆr＝T(Ｆrx，Ｆrz)の推定値（詳しくは演算処理装置１６の前回のサイクルタイムで求められた床反力Ｆrの絶対値＝√(Ｆrx2+Ｆrz2)）があらかじめ定めた所定の閾値（略「０」の正の値）と比較される。そして、該床反力Ｆrの推定値の絶対値がその閾値以下に低下したときに、両脚支持状態が終了し、且つ単脚支持状態が開始すると判断される。尚、本実施形態では、脚体２の運動状態の初期状態は、両脚支持状態であり、いずれか一方の脚体２に係る床反力の推定値が上記閾値以下に低下するまでは、脚体運動判断手段２５は、脚体２の運動状態が両脚支持状態であると判断する。
【００５４】
上述のような脚体運動判断手段２５の処理と並行して、演算処理装置１６は、前記胸部傾斜角度計測手段２６及び腰部傾斜角度計測手段２７による処理を実行する。この場合、胸部傾斜角度計測手段２６の処理では、胸部前後加速度センサ１５及び胸部ジャイロセンサ１４からそれぞれ入力される胸部４の前後方向の加速度、胸部４の角速度の検出データから、所謂カルマンフィルタの処理を用いた公知の手法により、絶対座標系Ｃfにおける胸部４の傾斜角度θaが前記サイクルタイム毎に逐次求められる。同様に、腰部傾斜角度計測手段２７の処理では、腰部前後加速度センサ２０及び腰部ジャイロセンサ１９からそれぞれ入力される腰部３の前後方向の加速度、腰部３の角速度の検出データから、カルマンフィルタの処理を用いて絶対座標系Ｃfにおける腰部３の傾斜角度θbが逐次求められる。ここで、絶対座標系Ｃfにおける胸部４及び腰部３のそれぞれの傾斜角度θa，θbは、本実施形態では例えば鉛直方向（重力方向）に対する傾斜角度である。
【００５５】
尚、例えばジャイロセンサ１４，１９による角速度の検出データを積分することで、胸部４や腰部３の傾斜角度を求めることも可能であるが、本実施形態のようにカルマンフィルタの処理を用いることで、胸部４や腰部３の傾斜角度θa，θbを精度よく計測することができる。
【００５６】
次に、演算処理装置１６は、前記脚体姿勢算出手段２９の処理と前記基準加速度計測手段２８の処理とを実行する。
【００５７】
前記脚体姿勢算出手段２９による処理では、絶対座標系Ｃfにおける各脚体２の大腿部９及び下腿部１１の傾斜角度θc，θd（鉛直方向に対する傾斜角度。図２参照）が前記サイクルタイム毎に次のように求められる。すなわち、各脚体２の大腿部９の傾斜角度θcは、その脚体２に装着されている前記股関節角度センサ２２による股関節８の屈曲角度Δθcの検出データの今回値と、前記腰部傾斜角度計測手段２５により求められた腰部３の傾斜角度θbの今回値とから次式（６）により算出される。
【００５８】
θc＝θb＋Δθc ……（６）
【００５９】
ここで、腰部３の傾斜角度θbは、該腰部３の上端部が下端部よりも人間１の前方側に突き出るように該腰部３が鉛直方向に対して傾斜している場合に負の値となるものであり、股関節８の屈曲角度Δθcは、大腿部９の下端部が人間１の前方側に突き出るように大腿部９が腰部３の軸心に対して傾斜している場合に正の値となるものである。
【００６０】
さらに、各脚体２の下腿部１１の傾斜角度θdは、上記のように求められた大腿部９の傾斜角度θcの今回値と、該脚体２に装着されている前記膝関節角度センサ２３による膝関節１０の屈曲角度Δθdの検出データの今回値とから次式（７）により算出される。
【００６１】
θd＝θc−Δθd ……（７）
【００６２】
ここで、膝関節１０の屈曲角度は、下腿部１１が大腿部９の軸心に対して該大腿部９の背面側に傾斜している場合に正の値となるものである。
【００６３】
また、前記基準加速度計測手段２８の処理では、前記身体座標系Ｃpの原点Ｏの絶対座標系Ｃfにおける加速度ａ0＝T(a0x，a0z）が次のように求められる。すなわち、前記腰部前後加速度センサ２０による腰部３の前後方向の加速度の検出データの今回値をap、前記腰部上下加速度センサ２１による腰部３の上下方向の加速度の検出データの今回値をaqとすると、それらの検出データap，aqと、前記腰部傾斜角度計測手段２７により求められた腰部３の傾斜角度θbの今回値とから、次式（８）により絶対座標系Ｃfにおける加速度ａ0＝T(a0x，a0z）が求められる。
【００６４】
a0＝T(a0x，a0z）
＝T(ap・cosθb−aq・sinθb，ap・sinθb＋aq・cosθb−ｇ)……（８）
【００６５】
次に、演算処理装置１６は、前記各部重心位置算出手段３０の処理を実行し、以下に説明する剛体リンクモデルを用いて、前記身体座標系Ｃpにおける人間１の各剛体相当部の重心の位置（身体座標系Ｃpの原点に対する位置）を求める。
【００６６】
図５に示すように、本実施形態で用いる剛体リンクモデルＲは、人間１を、各脚体２の大腿部９に相当する剛体R1，R1と、下腿部１１に相当する剛体R2，R2と、腰部３に相当する剛体R3と、前記胸部４、腕体７，７及び頭部６を合わせた部分（以下、上体部という）４０に相当する剛体R4とを連結してなるものとして表現するモデルである。この場合、各剛体R1と剛体R3との連結部、並びに、各剛体R1と剛体R2との連結部がそれぞれ股関節８、膝関節１０に相当する。また、剛体R3と剛体R4との連結部は腰部３に対する胸部４の傾動支点部４１である。
【００６７】
そして、本実施形態では、このような剛体リンクモデルＲの各剛体R1〜R4に対応する人間１の剛体相当部（各脚体２の大腿部９及び下腿部１１、腰部３、上体部４０）のそれぞれの重心G1、G2、G3、G4の各剛体相当部における位置があらかじめ求められ、演算処理装置１６の図示しないメモリに記憶されている。
【００６８】
ここで、演算処理装置１６に記憶保持している各剛体相当部の重心G 1、G2、G3、G4の位置は、各剛体相当部に対して固定した座標系での位置である。この場合、各剛体相当部の重心G1、G2、G3、G4の位置を表すデータとして、例えば、各剛体相当部の一端部の関節の中心点から該剛体相当部の軸心方向の距離が用いられる。具体的には、例えば図４に示すように、各大腿部９の重心G1の位置は、該大腿部９の股関節８の中心から大腿部９の軸心方向に距離ｄ1の位置、各下腿部１１の重心G2の位置は、該下腿部１１の膝関節１０の中心から下腿部１１の軸心方向に距離ｄ2の位置として表され、それらの距離ｄ1，ｄ2の値があらかじめ求められて演算処理装置１６に記憶保持されている。他の剛体相当部の重心、G3、G4の位置についても同様である。
【００６９】
尚、上体部４０の重心G4の位置は、厳密には、該上体部４０に含まれる腕体７，７の動きの影響を受けるが、歩行時における各腕体７，７は、一般に胸部４の軸心に対して対称的な位置関係になるので、上体部４０の重心G4の位置はさほど変動せず、例えば直立姿勢状態における上体部４０の重心G4の位置とほぼ同一となる。
【００７０】
また、本実施形態では、各剛体相当部（各脚体２の大腿部９及び下腿部１１、腰部３、上体部４０）の重心G1、G2、G3、G4の位置を表すデータの他、各剛体相当部の重量のデータや、各剛体相当部のサイズのデータ（例えば各剛体相当部の長さのデータ）があらかじめ求められて、演算処理装置１６に記憶保持されている。
【００７１】
尚、下腿部１１の重量は、足平部１３を含めた重量である。また、上述のように演算処理装置１６にあらかじめ記憶保持したデータは、実測等により求めておいてもよいが、人間１の身長や体重から、人間の平均的な統計データに基づいて推測するようにしてもよい。一般に、上記各剛体相当部の重心G1、G2、G3、G 4の位置や、重量、サイズは、人間の身長や体重と相関性があり、その相関データに基づいて、人間の身長及び体重のデータから、上記各剛体相当部の重心G1、G2、G3、G4の位置や、重量、サイズを比較的精度よく推測することが可能である。
【００７２】
前記各部重心位置算出手段３０は、上述のように演算処理装置１６にあらかじめ記憶保持したデータと、前記胸部傾斜角度計測手段２６及び腰部傾斜角度計測手段２７によりそれぞれ求められた胸部４の傾斜角度θa（＝上体部３９の傾斜角度）及び腰部３の傾斜角度θbの今回値と、前記脚体姿勢算出手段２９により求められた各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdの今回値とから、腰部３に固定された原点Ｏを有する身体座標系Ｃp（図５のｘｚ座標）での各剛体相当部の重心G1、G2、G3、G4の位置を求める。
【００７３】
この場合、各剛体相当部（各脚体２の大腿部９及び下腿部１１、腰部３、上体部４０）の傾斜角度θa〜θdが上述のように求められているので、その傾斜角度θa〜θｄのデータと、各剛体相当部のサイズのデータとから身体座標系Ｃpにおける各剛体相当部の位置及び姿勢が判る。従って、身体座標系Cpにおける各剛体相当部の重心G1、G2、G3、G4の位置が求められることとなる。
【００７４】
具体的には、例えば図５を参照して、同図５の左側に位置する脚体２に関し、大腿部９の身体座標系Ｃpにおける傾斜角度（ｚ軸方向に対する傾斜角度）はθc（この場合、図５ではθc＜０である）であるので、身体座標系Ｃpにおける大腿部９の重心G1の位置の座標は、（ｄ1・sinθc，−ｄ1・cosθc）となる。また、下腿部１１の身体座標系Ｃpにおける傾斜角度はθd（図５ではθd＜０）であるので、身体座標系Ｃpにおける下腿部１１の重心G2の位置の座標は、大腿部９の長さをＤcとすると、（Ｄc・sinθc＋ｄ2・sinθd，−Ｄc・cosθc−ｄ2・cosθd）となる。他の脚体２の大腿部９及び下腿部１１並びに、腰部３及び上体部４０の重心についても上記と同様に求められる。
【００７５】
このようにして、各部重心位置算出手段３０により、身体座標系Ｃpにおける各剛体相当部の重心G1、G2、G3、G4の位置を求めた後、演算処理装置１６は、前記身体重心位置算出手段３１の処理実行し、各剛体相当部の重心G1、G2、G3、G4の位置のデータと、各剛体相当部の重量のデータとを用いて身体座標系Ｃpにおける人間１の身体重心G0の位置（xg，zg）を求める。
【００７６】
ここで、身体座標系Ｃpにおける腰部３の重心G3の位置及び重量をそれぞれ（x3，z3）、m3、上体部４０の重心G4の位置及び重量をそれぞれ（x4，z4）、m4、人間１の前方に向かって左側の脚体２の大腿部９の重心G1の位置及び重量をそれぞれ（x1L，z1L）、m1L、同脚体２の下腿部１１の重心G2の位置及び重量をそれぞれ（x2L，z2L）、m2L、右側の脚体２の大腿部９の重心G1の位置及び重量をそれぞれ（x1R，z1R）、m1R、同脚体２の下腿部１１の重心G2の位置及び重量をそれぞれ（x2R，z2R）、m2R、人間１の体重をＭ（＝m1L＋m2L＋m1R＋m2R＋m3＋m4）とすると、身体座標系Ｃpにおける人間１の身体重心G0の位置（xg，zg）は次式（９）により求められる。
【００７７】
xg＝（m1L・x1L＋m1R・x1R＋m2L・x2L＋m2R・x2R
＋m3・x3＋m4・x4）／Ｍ
zg＝（m1L・z1L＋m1R・z1R＋m2L・z2L＋m2R・z2R
＋m3・z3＋m4・z4）／Ｍ ……（９）
【００７８】
このようにして身体重心位置算出手段３１の処理を実行した後、さらに、演算処理装置１６は、前記身体重心加速度算出手段３４の処理と、前記足首位置算出手段３２の処理と、前記ＭＰ高さ算出手段３３の処理とを実行する。
【００７９】
この場合、身体重心加速度算出手段３４の処理では、まず、前記サイクルタイム毎に身体重心位置算出手段３０により求められる身体座標系Ｃpにおける身体重心G0の位置（xg，zg）の時系列データを用いて、身体座標系Ｃpにおける身体重心G0の位置（xg，zg）の２階微分値、すなわち、身体座標系Ｃpの原点Ｏに対する身体重心G0の加速度T(d2xg／dt2，d2zg／dt2)が求められる。そして、この加速度T(d2xg／dt2，d2zg／dt2)と、前記基準加速度計測手段２７により求められた身体座標系Ｃpの原点Ｏの絶対座標系Ｃfにおける加速度a0＝T(a0x，a0z）とのベクトル和を求めることにより、絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ax，az)が求められる。
【００８０】
また、前記足首位置算出手段３２の処理では、まず、前記脚体姿勢算出手段２９により求められた各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータの今回値と、前記腰部傾斜角度計測手段２７により求められた腰部３の傾斜角度θbのデータの今回値と、該大腿部９及び下腿部１１のサイズ（長さ）のデータとから、前記各部重心位置算出手段３０の処理と同様の処理によって、前記身体座標系Ｃpにおける各脚体２の足首部１２の位置が求められる。具体的には、図５を参照して、同図５の左側に位置する脚体２に関し、下腿部１１の長さ（膝関節１０の中心から足首部１２までの長さ）をＤdとすると、身体座標系Ｃpにおける足首部１２の位置の座標（x12，z12）は、（Ｄc・sinθc＋Ｄd・sinθd，−Ｄc・cosθc−Ｄd・cosθd）となる（但し、図４ではθc＜０、θd＜０）。他方の脚体２についても同様である。
【００８１】
そして、この足首部１２の身体座標系Ｃpにおける位置（x12，z12）と前記身体重心位置算出手段３１により求められた身体座標系Ｃpにおける身体重心G0の位置（xg，zg）のデータの今回値とから、身体重心Ｇ0に対する各脚体２の足首部１２の位置ベクトルT(x12−xg，z12−zg）、すなわち、前記式（５）におけるΔＸf，ΔＺf，ΔＸr，ΔＺrが求められる。
【００８２】
また、前記ＭＰ高さ算出手段３３の処理では、前記足平部加速度センサ２４の検出データを用い、図３を参照して先に説明したように、各脚体２の足平部１３の床面に対する傾斜角度θを算出して、この傾斜角度θからＭＰ高さＨを求める。尚、履き物等に加速度センサ２４に代えてジャイロセンサを装備し、このジャイロセンサの検出データから足平部１３の傾斜角度θを算出してＭＰ高さＨを求めるようにしても良く、更には、履き物等に光学式距離センサを装備して、ＭＰ高さＨを直接的に計測することも可能である。
【００８３】
次に、演算処理手段１６は、前記床反力推定手段３８の処理を次のように実行する。すなわち、この処理では、人間１の体重Ｍ及び重力加速度ｇの値（これらはあらかじめ演算処理装置１６に記憶されている）と、前記身体重心加速度算出手段３４により求められた絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ａx，ａz)の今回値とから、前記式（２）により、全床反力Ｆ＝T(Ｆx，Ｆz)の推定値が各サイクルタイム毎に逐次求められる。この場合、前記脚体運動判断手段２５により今回のサイクルタイムで判断された脚体２の運動状態が単脚支持状態であれば、上記全床反力Ｆ＝T(Ｆx，Ｆz)の推定値がそのまま接地している単一の脚体２に作用する床反力の推定値として求められることになる。尚、この場合、非接地側の脚体２（遊脚側の脚体２）に作用する床反力は、T(０，０)である。
【００８４】
また、脚体運動判断手段２５により今回のサイクルタイムで判断された脚体２の運動状態が両脚支持状態である場合には、先ず、人間１の進行方向に向かって後側に存する後側脚体２に作用する床反力Ｆrの鉛直方向成分Ｆrzと人間１の進行方向に向かって前側に存する前側脚体２のＭＰ高さＨとの間に成立する相関関係に基づいて、前記ＭＰ高さ算出手段３３により求めた前側脚体２のＭＰ高さＨのデータを用いて後側脚体２に作用する床反力Ｆrの鉛直方向成分Ｆrzの推定値が求められる。
【００８５】
ここで、上記相関関係について詳述する。本願発明者は、鋭意努力の結果、通常歩行時において前側脚体２の足平部１３の踵が着床してからつま先が着床するまでの各時点における前側脚体２のＭＰ高さをＨ（ｔ）、後側脚体２に作用する床反力の鉛直方向成分をＦrz（ｔ）とし、前側脚体２の踵着床時における前側脚体２のＭＰ高さをＨ０、後側脚体２に作用する床反力の鉛直方向成分をＦrz０とすると、Ｈ０に対するＨ（ｔ）の比（ＭＰ高さ比＝Ｈ（ｔ）／Ｈ０）とＦrz０に対するＦrz（ｔ）の比（反力比＝Ｆrz（ｔ）／Ｆrz０）との間には図６に示す相関関係が成立することを知見するに至った。
そこで、本実施形態では、図６の相関関係がデータテーブルや、これら相関関係を近似する多項式関数の形態で演算処理装置１６に予め記憶されている。そして、前記脚体運動判断手段２５で両脚支持状態が開始されたと判別された時点での前側脚体２のＭＰ高さと全床反力の鉛直方向成分とを上記Ｈ０と上記Ｆrz０とし、前記ＭＰ高さ算出手段３３により求めた前側脚体２のＭＰ高さのデータから図６の相関関係に基づいて後側脚体２に作用する床反力の鉛直方向成分Ｆrzの推定値が逐次求められる。すなわち、各時点でのＭＰ高さ比に対応する反力比にＦrz０を乗算することで各時点におけるＦrzの推定値が求められる。次に、このＦrzの推定値を各サイクルタイムで求めた全床反力の鉛直方向成分Ｆzの推定値から減算することにより、前側脚体２に作用する床反力の鉛直方向成分Ｆfz（＝Ｆz−Ｆrz）の推定値が逐次求められる。これにより両脚支持状態における両脚体２，２のそれぞれの床反力の鉛直方向成分Ｆrz，Ｆfzが逐次求められることとなる。
更に、前記足首位置算出手段３２で求めたΔＸf，ΔＺf，ΔＸr，ΔＺrを前記式（５）に代入して、前側脚体２に作用する床反力の進行方向成分Ｆfxの推定値と、後側脚体２に作用する床反力の進行方向成分Ｆrxの推定値とが求められる。
【００８６】
また、演算処理装置１６は、上述の処理と並行して、前記脚体各部加速度算出手段３５、脚体各部角加速度算出手段３６、床反力作用点推定手段３７の処理を実行する。
【００８７】
この場合、前記脚体各部加速度算出手段３５の処理では、前記身体重心加速度算出手段３４の処理と同様、まず、前記サイクルタイム毎に前記各部重心位置算出手段３０により求められる身体座標系Ｃpにおける各脚体２の剛体相当部である大腿部９及び下腿部１１の重心G1，G2の位置のそれぞれの時系列データを用いて、身体座標系Ｃpにおける大腿部９及び下腿部１１の重心G1，G2の位置のそれぞれの２階微分値、すなわち、身体座標系Ｃpにおける大腿部９及び下腿部１１の重心G1，G2のそれぞれの加速度（身体座標系Ｃpの原点Ｏに対する加速度）が求められる。そして、このそれぞれの加速度と、前記基準加速度計測手段２８による腰部３の絶対座標系Ｃfにおける加速度a0＝T(a0x，a0z）とのベクトル和を求めることにより、絶対座標系Ｃfにおける大腿部９及び下腿部１１のそれぞれの加速度（より詳しくは、該加速度の絶対座標系Ｃfにおける座標成分）が求められる。
【００８８】
また、前記脚体各部角加速度算出手段３６の処理では、前記サイクルタイム毎に前記脚体姿勢算出手段２９により求められる各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdの時系列データを用いて、該大腿部９及び下腿部１１のそれぞれ傾斜角度θc，θdの２階微分値、すなわち、大腿部９及び下腿部１１のそれぞれの角加速度が求められる。
【００８９】
また、床反力作用点推定手段３７の処理では、接地している脚体２について、例えば前記脚体姿勢算出手段２９により算出された大腿部９の傾斜角度θcの今回値から、図７及び図８に示すようにあらかじめ定められた相関データに基づいて該脚体２の足首部１２から、該脚体２の足平部１３の床反力作用点（足平部１３の接地箇所に作用する全床反力が集中するとみなせる点）へのベクトル（足首部１２に対する床反力作用点の位置ベクトル。以下、床反力作用点ベクトルという）を該床反力作用点の位置を表すデータとして求める。
【００９０】
すなわち、本願発明者等の知見によれば、接地している脚体２の大腿部９や下腿部１１の傾斜角度θc，θdは、床反力作用点と比較的顕著な相関性を有し、例えば大腿部９の傾斜角度θcに対して、前記床反力作用点ベクトル、詳しくは、人間１の進行方向（Ｘ軸方向）における該床反力作用点ベクトルの成分と、鉛直方向（Ｚ軸方向）における該床反力作用点ベクトルの成分は、それぞれ図７、図８に示すように変化する。ここで、大腿部９の負の傾斜角度θcは、脚体２が人間１の後側に延びているとき（例えば図２の人間１の前方に向かって右側の脚体２）の傾斜角度であり、正の傾斜角度θcは、脚体２が人間１の前側に存するとき（例えば図２の人間１の前方に向かって左側の脚体２）の傾斜角度である。
【００９１】
そこで、本実施形態では、図７及び図８の相関データがあらかじめデータテーブルや、それらの相関データをそれぞれ近似する多項式関数の形態で、演算処理装置１６にあらかじめ記憶保持されている。そして、前記床反力作用点推定手段３７の処理では、前記脚体姿勢算出手段２９により算出された大腿部９の傾斜角度θcの今回値から、上記の相関データに基づいて、前記床反力作用点ベクトル（詳しくは該床反力作用点ベクトルのＸ軸方向、Ｚ軸方向の成分）が求められる。
【００９２】
尚、床反力作用点の位置は、接地している脚体２の大腿部９と下腿部１１の相対角度（膝関節１０の屈曲角度）との相関性もあり、大腿部９の傾斜角度θcの代わりに、上記相対角度から、床反力作用点の位置を推定するようにしてもよく、あるいは、大腿部９の傾斜角度θc及び上記相対角度の両者を用いて、マップ等により床反力作用点の位置を推定するようにしてもよい。
【００９３】
次に、演算処理装置１６は、前記関節モーメント推定手段３９の処理を実行して、各脚体２の膝関節１０及び股関節８に作用するモーメントを求める。この処理は、前記床反力推定手段３８、脚体各部加速度算出手段３５、脚体各部角加速度算出手段３６、床反力作用点推定手段３７、及び脚体姿勢算出手段２９によりそれぞれ求められたデータの今回値を用いて、所謂逆動力学モデルに基づいて行われる。この逆動力学モデルは、人間１の各剛体相当部の並進運動に関する運動方程式と回転運動に関する運動方程式とを用いて、床反力作用点により近い関節から順番に該関節に作用するモーメントを求めるものであり、本実施形態では、各脚体２の膝関節１０、股関節８に作用するモーメントが順番に求められる。
【００９４】
さらに詳細には、図９を参照して、まず、各脚体２の下腿部１１に関し、下腿部１１の先端部の足首部１２に作用する力（関節反力）、下腿部１１の膝関節１０の部分に作用する力（関節反力）、及び下腿部１１の重心G2の並進加速度を、それぞれ絶対座標系Ｃfにおける成分表記によって、T(Ｆ1x，Ｆ1z)、T(Ｆ2x，Ｆ2z)、T(a2x，a2z)とし、該下腿部１１の重量をm2とする。このとき、下腿部１１の重心G2の並進運動に関する運動方程式は、次式（１０）となる。
【００９５】
T(m2・a2x，m2・a2z)＝T(Ｆ1x−Ｆ2x，Ｆ1z−Ｆ2z−m2・ｇ)
ゆえに、T(Ｆ2x，Ｆ2z)＝T(Ｆ1x−m2・a2x，Ｆ1z−m2・a2z−m2・ｇ)……（１０）
【００９６】
ここで、下腿部１１の重心G2の加速度T(a2x，a2z)は、前記脚体各部加速度算出手段３５により求められるものである。また、下腿部１１の先端部の足首部１２に作用する関節反力T(Ｆ1x，Ｆ1z)は、近似的には、該下腿部１１を有する脚体２について前記床反力推定手段３８により求められる床反力の推定値に等しい。より詳しくは、単脚支持状態において、該脚体２が接地しているときには、関節反力T(Ｆ1x，Ｆ1z)は、前記式（２）により求められる全床反力T(Fx，Fz）であり、該脚体２が遊脚側の脚体であるときには、T(Ｆ1x，Ｆ1z)＝T(０，０)である。また、両脚支持状態において、該脚体２が人間１の進行方向前方に向かって後側の脚体であるときには、関節反力T(Ｆ1x，Ｆ1z)は前記後側脚体の床反力T(Frx，Frz）であり、該脚体２が前側の脚体であるときには、前記前側脚体の床反力T(Ffx，Ffz）である。
【００９７】
従って、各脚体２の膝関節１０に作用する関節反力T(Ｆ2x，Ｆ2z)は、脚体各部加速度算出手段３５により求められた下腿部１１の重心G2の加速度T(a2x，a2z)のデータと、床反力推定手段３８により求められる床反力（＝T(Ｆ1x，Ｆ1z)）のデータと、下腿部１１のあらかじめ求められた重量m2のデータと、重力加速度ｇの値とから、上記式（１０）により求められる。
【００９８】
また、図９を参照して、下腿部１１の先端部の足首部１２に作用するモーメントをＭ1、下腿部１１の膝関節１０の部分に作用するモーメントをＭ2、下腿部１１の重心G2の回りの慣性モーメントをIG2、下腿部１１の重心G2の回りの角加速度をα2とする。また、前記図４に対応させて、下腿部１１の重心G2と膝関節１０の中心との間の距離をd2、下腿部１１の重心G2と足首部１２との間の距離をd2’（＝Dd−d2）とすると、下腿部１１の重心G2の回りの回転運動に関する運動方程式は、次式（１１）となる。
【００９９】
IG2・α2＝M1−M2＋F1x・d2’・cosθd−F1z・d2’・sinθd
＋F2x・d2・cosθd−F2z・d2・sinθd
ゆえに
M2＝M1−IG2・α2＋F1x・d2’・cosθd−F1z・d2’・sinθd
＋F2x・d2・cosθd−F2z・d2・sinθd……（１１）
【０１００】
ここで、式（１１）中のM1は、同式（１１）に係わる下腿部１１を有する脚体２について前記床反力作用点推定手段３７により求められる床反力作用点ベクトルと、該脚体２について前記床反力推定手段３８により求められる床反力ベクトルとの外積（ベクトル積）として得られるモーメントである。また、α2は、前記脚体各部角加速度算出手段３４により求められる下腿部１１の角加速度である。また、θdは前記脚体姿勢算出手段２９により求められる下腿部１１の傾斜角度である。また、T(Ｆ1x，Ｆ1z)は、前述の通り、床反力推定手段３８により求められる床反力の推定値である。さらに、T(F2x，F2z)は、前記式（１０）により求められるものである。また、慣性モーメントIG2は下腿部１１の重量m2やサイズのデータ等と共に、あらかじめ求められて演算処理装置１６に記憶されるものである。
【０１０１】
従って、膝関節１０に作用するモーメントM2は、床反力推定手段３８による床反力の推定値のデータと、床反力作用点推定手段３７による床反力作用点ベクトルのデータと、脚体各部角加速度算出手段３６による下腿部１１の角加速度α2のデータと、脚体姿勢算出手段２９による下腿部１１の傾斜角度θdのデータと、前記式（１０）により求められた関節反力T(F2x，F2z)のデータと、あらかじめ求めた下腿部１１の慣性モーメントIG2、サイズ（Dd）、重心G2の位置(d2)のデータとから前記式（１１）により求められる。
【０１０２】
関節モーメント推定手段３９は、上記のようにして下腿部１１の膝関節１０の部分に作用するモーメントM2を求めた後、その算出処理と同様の処理によって、大腿部９の股関節８の部分に作用するモーメントを求める。この処理の基本的な考え方は、膝関節１０のモーメントM2を求める手法と同一であるので、詳細な図示及び説明は省略するが、その概要は次の通りである。
【０１０３】
すなわち、まず、大腿部９の重心G1（図５参照）の並進運動に関する運動方程式に基づく次式（１２）（前記式（１０）と同じ形の式）により、大腿部９の股関節８の部分に作用する関節反力T(F3x，F3z)が求められる。
【０１０４】
T(Ｆ3x，Ｆ3z)＝T(Ｆ2x−m1・a1x，Ｆ2z−m1・a1z−m1・ｇ)……（１２）
【０１０５】
ここで、T(Ｆ2x，Ｆ2z)は、先に前記式（１０）により求めた膝関節１０の関節反力である。また、T(a1x，a1z)は、前記脚体各部加速度算出手段３５により求められる大腿部９の重心G1の絶対座標系Ｃfにおける加速度（並進加速度）である。また、m1はあらかじめ求めた大腿部９の重量、ｇは重力加速度である。
【０１０６】
次いで、大腿部９の重心G1の回りの回転運動に関する運動方程式に基づく次式（１３）（前記式（１１）と同じ形の式）により、大腿部９の股関節８の部分に作用するモーメントM3が求められる。
【０１０７】
M3＝M2−IG1・α1＋F2x・d1’・cosθc−F2z・d1’・sinθc
＋F3x・d1・cosθc−F3z・d1・sinθc……（１３）
【０１０８】
ここで、M2は、前記式（１１）により求められた膝関節１０のモーメント、T(Ｆ2x，Ｆ2z)は、前記式（１０）により求められた膝関節１０の関節反力、T(Ｆ3x，Ｆ3z)は、前記式（１２）により求められた股関節８の関節反力、IG1は、あらかじめ求めた大腿部９の重心G1の回りの慣性モーメント、α1は前記脚体各部角加速度算出手段３６により求められる大腿部９の角加速度、θcは前記脚体姿勢算出手段２９により求められる大腿部９の傾斜角度である。また、d1は、股関節８の中心から大腿部９の重心G1までの距離（図５参照）、d1’は、膝関節１０の中心から大腿部９の重心G1までの距離（図５ではDc−d1）であり、これらは、あらかじめ求めた重心G1の位置や大腿部９のサイズ（長さ）から定まるものである。
【０１０９】
以上説明した処理が、前記演算処理装置１６のサイクルタイム毎に逐次実行され、各脚体２に作用する床反力や、各脚体２の膝関節１０及び股関節８に作用するモーメントが逐次リアルタイムで推定される。
【０１１０】
尚、本明細書での詳細な説明は省略するが、求められた膝関節１０や股関節８のモーメントの推定値は、例えば人間１の歩行を補助する装置（膝関節１０や股関節８に補助トルクを付与可能な電動モータ等を含む装置）の制御に用いられる。
【０１１１】
前述した演算処理装置１６の処理により求められた床反力の推定値（詳しくは、該床反力の推定値の絶対値）の経時変化の様子を図１０に実線で例示する。また、演算処理装置１６の処理により求められた膝関節１０及び股関節８のモーメントの推定値の経時変化の様子を図１１に実線で例示する。ここで、図１０及び図１１は、人間１が平地をほぼ一定速度で歩行した場合の例示である。この場合、図１０では、フォースメータ等を用いて床反力を実測した比較例（床反力の真値に相当するもの）が仮想線で併記されている。また、図１１ではトルクメータ等を用いて膝関節１０及び股関節８のモーメントを実測した比較例（膝関節１０及び股関節８のモーメントの真値に相当するもの）が仮想線で併記されている。
【０１１２】
図１０を参照して明らかなように、本実施形態によれば精度のよい床反力の推定値が得られていることが判る。また、本実施形態ではこの床反力の推定値を用いることによって、図１１に示されるように、膝関節１０や股関節８のモーメントも比較的精度よく推定することができる。
【０１１３】
以上のように、本実施形態によれば、脚体２に人間１の歩行の邪魔となったり、脚体２の運動に負担がかかるようなセンサを装着したりすることなく、股関節８や股関節８に装着した角度センサ２２，２３や、胴体５に装備したジャイロセンサ１４，１９及び加速度センサ１５，２０，２１や、履き物等に装備する加速度センサ２４というような比較的小型で軽量なセンサを用いて各脚体２に作用する床反力や、各脚体２の股関節８及び膝関節１０に作用するモーメントをリアルタイムで容易に推定することができる。
【０１１４】
また、前記実施形態では、本発明を人間１に適用した場合を例にとって説明したが、二足歩行移動体としての二足歩行ロボットにも本発明を適用することができる。ここで、二足歩行ロボットでは、腰部と胸部とが一体的な構造となっている場合があるが、この場合には、ジャイロセンサや前後方向の加速度センサを腰部及び胸部のいずれか一方だけに取り付けて、床反力や脚体の関節のモーメントを本実施形態と同様に推定するようにすることも可能である。また、二足歩行ロボットでは、股関節や膝関節の屈曲角度は、それらの関節のアクチュエータに対する制御装置の制御量により把握するようにすることも可能である。
【０１１５】
また、前記実施形態では、脚体２の運動状態を判断するために、腰部上下加速度センサ２１の検出データをそのまま用いたが、該検出データの代わりに、例えば前記基準加速度計測手段２８により求められる絶対座標系Ｃfでの腰部３の加速度ａ0の鉛直方向（Ｚ軸方向）の成分の値を用いるようにしても良い。
【０１１６】
ところで、前記実施形態では、両脚支持状態における前側と後側の各脚体２に作用する床反力の進行方向成分Ｆfx，Ｆrxの推定値を上記先願と同様の手法で求めるようにしたが、後側脚体に作用する床反力の進行方向成分の、両脚支持状態の経過時間及び二足歩行移動体の移動速度に対する変化の特性を表すものとしてあらかじめ定めた特性データに基づき、後側脚体に作用する床反力の進行方向成分Ｆrxの推定値を逐次求めると共に、このＦrxを全床反力の進行方向成分Ｆxの推定値から差し引くことにより、前側脚体に作用する床反力の進行方向成分Ｆfxの推定値を逐次求めることも可能である。
【０１１７】
以下、このような手法で各脚体２に作用する床反力の進行方向成分Ｆfx，Ｆrxの推定値を求める第２の実施形態について説明する。第２実施形態では、演算処理装置１６に、図１２に示す如く、前記第１実施形態の足首位置算出手段３２に代えて、脚体運動判断手段２５により両脚支持状態の開始（単脚支持状態の終了）が把握される毎に、その両脚支持状態の開始時からの経過時間を計時する計時手段４２と、脚体運動判断手段２５により両脚支持状態の開始（単脚支持状態の終了）が把握される毎に、前記脚体姿勢算出手段２９による各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータと前記計時手段４２の計時データとを用いて人間１の移動速度を推定する移動速度推定手段４３と、この移動速度推定手段４３により求められた移動速度のデータから両脚支持状態の開始時から終了時までの時間（両脚支持状態の継続時間。以下、両脚支持期間という）を推定する両脚支持期間推定手段４４とを設ける。
【０１１８】
そして、脚体運動判断手段２５の処理では、第１実施形態のものと同様に腰部上下加速度センサ２１による腰部３の上向き方向の加速度の検出データに基づいて両脚支持状態の開始が把握されると、該両脚支持状態の開始時点から前記計時手段４２により計測される経過時間が、該両脚支持状態の開始時点で前記両脚支持期間推定手段４４により後述するように求められる両脚支持期間（両脚支持状態の開始時から終了時までの該両脚支持状態の継続時間）の推定値に達したか否かがサイクルタイム毎に逐次監視される。そして、脚体運動判断手段２５は、該経過時間が両脚支持期間の推定値に達した時に、両脚支持状態が終了し、且つ、単脚支持状態が開始すると判断する。
【０１１９】
このように脚体運動判断手段２５の処理が実行され、また、脚体姿勢算出手段２９による処理が第１実施形態のものと同様に実行された後、演算処理装置１６は、前記移動速度推定手段４３の処理及び両脚支持期間推定手段４４の処理を順次実行する。
【０１２０】
移動速度推定手段４３による処理は次のように行われる。すなわち、図１３を参照して、人間１の歩行時に、時刻t1において実線で示す人間１の前側の脚体２（図では人間１の前方に向かって右側の脚体２）が着床して両脚支持状態が開始し、時刻t2において仮想線示の人間１で表すように、次の両脚支持状態が開始した場合（時刻t1で人間１の後側の脚体２が離床後に時刻t2で着床した場合）を想定する。このとき、時刻t1から時刻t2までの人間１の移動距離Ｌは、絶対座標系ＣfのＸ軸方向（人間１の進行方向）における腰部３の股関節８の中心の移動距離（これは、本実施形態では、身体座標系Ｃpの原点ＯのＸ軸方向の移動量に等しい）である。
【０１２１】
そして、この移動距離Ｌは、時刻t1における股関節８の中心から人間１の前側の脚体２の足首部１２までのＸ軸方向の距離ΔL1と、時刻t2における股関節８の中心から人間１の後側の脚体２（これは時刻t1で人間１の前側にあった脚体２である）の足首部１２までのＸ軸方向の距離ΔL2との総和にほぼ一致する。
【０１２２】
従って、上記距離ΔL1，ΔL2と、時刻t1から時刻t2までの経過時間（t2−t1）、すなわち、両脚支持状態が開始してから次に両脚支持状態が開始するまでの１歩分の経過時間を把握することによって、それらの距離ΔL1，ΔL2と、該１歩分経過時間（t2−t1）とを用いて次式（１４）により時刻t1からt2までの人間１の移動速度Ｖ（時刻t1から時刻t2までの平均移動速度）を求めることができる。
【０１２３】
Ｖ＝Ｌ／（t2−t1）＝（ΔL1＋ΔL2）／（t2−t1） ……（１４）
【０１２４】
そこで、前記移動速度推定手段４３の処理では、前記脚体運動判断手段２５により両脚支持状態が開始したことが把握される毎に、人間１の前側の脚体２に係わる上記距離ΔL1と、後側の脚体２に係わる上記距離ΔL2とが以下に説明するように求められ、それらの距離ΔL1，ΔL2の算出値が記憶保持される。そして、今回の両脚支持状態の開始時に求められた後側の脚体２に係わる距離ΔL2と、前回の両脚支持状態の開始時に求められた前側の脚体２に係わる距離ΔL1と、前回の両脚支持状態の開始時から今回の両脚支持状態の開始時までに前記計時手段４２により計測された時間（＝t2−t1）とから前記式（１４）により人間１の移動速度Ｖを求める。
【０１２５】
この場合、上記距離ΔL1，ΔL2は次にように求められる。すなわち、両脚支持状態の開始時における人間１の前側の脚体２については、該両脚支持状態の開始時（脚体運動判断手段２５により両脚支持状態の開始が把握されたサイクルタイム）に前記脚体姿勢算出手段２９により求められる大腿部９及び下腿部１１のそれぞれの傾斜角度をθc1、θd1（図１３の時刻t1の図を参照）とする。このとき、該脚体２に係わる距離ΔL1は、これらの傾斜角度θc1，θd1（θc1＞０，θd1＞０）のデータと、大腿部９及び下腿部１１のそれぞれの長さDc，Ddのデータとを用いて、次式（１５）により算出される。
【０１２６】
ΔL1＝Dc・sinθc1＋Dd・sinθd1 ……（１５）
【０１２７】
同様に、両脚支持状態の開始時における人間１の後側の脚体２については、該両脚支持状態の開始時に前記脚体姿勢算出手段２９により求められる大腿部９及び下腿部１１のそれぞれの傾斜角度をθc2、θd2（図１３の時刻t2の図を参照）とすると、該脚体２に係わる距離ΔL2は、これらの傾斜角度θc2，θd2（θc2＜０，θd2＜０）のデータと、大腿部９及び下腿部１１のそれぞれの長さDc，Ddのデータとを用いて、次式（１６）により算出される。
【０１２８】
ΔL2＝−Dc・sinθc2−Dd・sinθd2 ……（１６）
【０１２９】
以上説明した移動速度推定手段４３の処理によって、両脚支持状態が開始する毎に、人間１の移動速度Ｖ（詳しくは、両脚支持状態が開始する直前の１歩における移動速度）が推定される。尚、両脚支持状態が開始してから次に両脚支持状態が開始するまでの期間における各サイクルタイムでは、移動速度Ｖの推定値は一定に維持される。
【０１３０】
また、両脚支持期間推定手段４４の処理は次のように行われる。本願発明者等の知見によれば、人間１の歩行時の両脚支持状態の継続期間である両脚支持期間は、人間１の移動速度Ｖと密接な相関性を有する。すなわち、人間１の歩行時の両脚支持期間は、移動速度Ｖに対して図１４に示すように変化し、該移動速度Ｖが速くなる程、短くなる。
【０１３１】
そこで、第２実施形態では、図１４の相関データがあらかじめデータテーブルや、それを近似する多項式関数の形態で、演算処理装置１６にあらかじめ記憶保持されている。そして、前記両脚支持期間推定手段４４の処理では、両脚支持状態の開始時に、移動速度推定手段３６により前述のように求められた移動速度Ｖの最新値から、図１４の相関データに基づいて該両脚支持状態に係わる両脚支持期間の推定値を求める。尚、該両脚支持期間の推定値は、次回の両脚支持状態が開始するまで維持される。
【０１３２】
床反力推定手段３８の処理では、第１実施形態と同様に身体重心加速度算出手段３４により求められた身体重心G0の加速度T(ａx，ａz)のデータと、人間１の重量Ｍのデータとから、前記式（２）により、全床反力Ｆ＝T(Ｆx，Ｆz)の推定値が前記サイクルイタイム毎に逐次求められる。この場合、脚体運動判断手段２５により把握されている脚体２の運動状態が単脚支持状態である場合には、上記全床反力Ｆ＝T(Ｆx，Ｆz)の推定値がそのまま接地している単一の脚体２に作用する床反力の推定値として求められることとなる。
【０１３３】
一方、脚体運動判断手段２５により把握されている脚体２の運動状態が両脚支持状態である場合には、床反力推定手段３８は、図６の相関関係に基づき、第１実施形態と同様に後側脚体２に作用する床反力の鉛直方向成分Ｆrzの推定値を前側脚体２のＭＰ高さＨを用いて求め、このＦrzを全床反力の鉛直方向成分Ｆzから差し引いて、前側脚体２に作用する床反力の鉛直方向成分Ｆfzの推定値を求める。
【０１３４】
また、前側と後側の各脚体２に作用する床反力の進行方向成分Ｆfx，Ｆrxの推定値は以下の如く求められる。すなわち、本願発明者等の知見によれば、両脚支持状態で後側脚体２に作用する床反力の進行方向成分Ｆrxの、該両脚支持状態の開始時における全床反力の進行方向成分Ｆxに対する割合（以下、床反力比という）と、該両脚支持状態の開始時からの経過時間の前記両脚支持期間に対する割合（＝経過時間／両脚支持期間。以下、両脚支持時間比とい）との関係に着目したとき、それらの間には特徴的な相関性があり、この相関性は、人間１の移動速度Ｖ等の影響をほとんど受けない。
【０１３５】
具体的には、後側脚体２に作用する床反力の進行方向成分成分Ｆrxの、両脚支持状態の開始時における全床反力の進行方向成分Ｆx（以下、参照符号Ｆxsにより表す）に対する割合である床反力比Ｆrx／Ｆxsは、人間１の移動速度Ｖ等によらずに、前記両脚支持時間比に対して図１５に示すようなほぼ一定の相関関係を有し、両脚支持状態の時間の経過に伴い、一旦、「１」から増加した後、「０」まで減少していく。
【０１３６】
そこで、第２実施形態では、図１５の相関データ（特性データ）があらかじめデータテーブルや、それらの相関データをそれぞれ近似する多項式関数の形態で、演算処理装置１６にあらかじめ記憶保持されている。そして、計時手段４２による経過時間の計時データの今回値と、両脚支持期間推定手段４４により求められた両脚支持期間の推定値のデータの最新値とから前記両脚支持時間比が前記サイクルタイム毎に逐次求められる。そして、この求めた両脚支持時間比のデータから図１５の相関データに基づいて、床反力比Ｆrx／Ｆxsが逐次求められ、この床反力比Ｆrx／Ｆxsに両脚支持状態の開始時の全床反力の進行方向成分Ｆxsを乗算することにより、後側脚体２に作用する床反力の進行方向成分Ｆrxの推定値が求められ、このＦrxを全床反力の進行方向成分Ｆxから差し引くことにより前側脚体２に作用する床反力の進行方向成分Ｆfxの推定値が求められる。
【０１３７】
このようにして各脚体２に作用する床反力Ｆr＝T(Ｆrx，Ｆrz)，Ｆf＝T(Ｆfx，Ｆfz)を求めた後、関節モーメント推定手段３９での処理により、第１実施形態と同様に各脚体２の膝関節１０及び股関節８に作用するモーメントが逐次リアルタイムで推定される。
【０１３８】
尚、履き物等に検出方向をＸ軸方向とした一軸型の力センサを装備して、両脚支持状態における前側と後側の各脚体２に作用する床反力の進行方向成分Ｆfx，Ｆrxを力センサにより計測することも可能である。
【図面の簡単な説明】
【図１】先願の床反力推定方法の基本的原理を説明するための図。
【図２】本発明の一実施形態における二足歩行移動体としての人間と該人間に装備する装置構成を模式化して示す図。
【図３】足平部の特定部位の床面からの位置（ＭＰ高さ）の計測原理を説明するための図。
【図４】図２の装置に備える演算処理装置の機能を説明するためのブロック図。
【図５】図３の演算処理装置の処理に用いる剛体リンクモデルを示す図。
【図６】前側脚体のＭＰ高さと後側脚体に作用する床反力の鉛直方向成分との相関関係を示す線図。
【図７】大腿部の傾斜角度と床反力作用点ベクトルの進行方向成分との相関関係を示す線図。
【図８】大腿部の傾斜角度と床反力作用点ベクトルの鉛直方向成分との相関関係を示す線図。
【図９】関節モーメントの計測原理を説明するための図。
【図１０】本発明の実施形態により求められた床反力の推定値の経時変化の様子を例示するグラフ。
【図１１】本発明の実施形態により求められた膝関節及び股関節のモーメントの推定値の経時変化の様子を例示するグラフ。
【図１２】本発明の第２の実施形態における演算処理装置の機能を説明するためのブロック図。
【図１３】移動速度の推定原理を説明するための図。
【図１４】移動速度と両脚支持期間との相関関係をしめす線図。
【図１５】両脚支持時間比と後側脚体に作用する床反力の進行方向成分との相関関係を示す線図。
【符号の説明】
１…人間（二足歩行移動体）、２…脚体、１３…足平部、１３ｂ…中足趾節関節（特定部位）。
【発明の属する技術分野】
本発明は、人間や二足歩行ロボット等の二足歩行移動体の脚体に作用する床反力、特に、二足歩行移動体の運動状態が該二足歩行移動体の両脚体が接地している両脚支持状態であるときの各脚体に作用する床反力の鉛直方向成分を推定する方法に関する。
【０００２】
【従来の技術】
例えば人間の歩行動作を補助する歩行アシスト装置の動作制御や、二足歩行ロボットの移動動作の制御を行なう場合、人間や二足歩行ロボットの脚体に作用する床反力（詳しくは、脚体の接地部に床から作用する力）を逐次把握することが必要となる。この床反力を把握することで、二足歩行移動体の脚体の関節に作用するモーメント等を把握することが可能となり、その把握されたモーメント等に基づいて歩行アシスト装置の目標補助力や、二足歩行ロボット各関節の目標駆動トルク等を決定することが可能となる。
【０００３】
前記床反力を把握する手法としては、例えば特開2000-249570号公報に開示されているものが知られている。この技術では、二足歩行移動体の定常的な歩行時に各脚体の床反力の経時変化の波形が周期的に変化することから、各脚体の床反力を、歩行周期の１／ｎ（ｎ＝１，２，…）の互いに異なる周期を有する複数の三角関数の合成値（一次結合）として把握するものである。この場合、複数の三角関数を合成する際の各三角関数の重み係数は、二足歩行移動体毎にあらかじめ定めた所定値やそれを地形に応じて調整した値が用いられている。
【０００４】
しかしながら、かかる技術では、二足歩行移動体の一歩分もしくは複数歩分について脚体の床反力を把握しようとするものであるため、二足歩行移動体の歩容が逐次変化するような場合には、床反力を精度よく把握することは困難である。また、把握される床反力の精度を高めるためには、前記三角関数の重み係数を二足歩行移動体毎に設定したり、地形等に応じて調整したりしなければならないので、二足歩行移動体の移動環境や二足歩行移動体の個体差の影響を少なくして、床反力を精度よく把握するようにすることが困難である。
【０００５】
また、例えば二足歩行ロボットにおいては、各脚体の足首部や足平部に６軸力センサ等の力センサを取り付け、この力センサの出力により床反力を把握するものも知られている。さらに、床に設置したフォースプレート上で二足歩行移動体を歩行させ、該フォースプレートの出力により床反力を把握する手法も知られている。
【０００６】
しかしながら、力センサを用いる技術では、特に人間の脚体の床反力を把握しようとする場合には、人間の足首部や足平部に力センサを取り付けなければならないため、通常的な生活環境下では、該力センサが歩行の邪魔になってしまうという不都合がある。また、フォースプレートを用いるものでは、該フォースプレートが設置された環境下でしか床反力を把握できない。
【０００７】
かかる不具合を解消するため、本願出願人は、先に、特願2001-214174号により以下の床反力推定方法を提案している。この方法の原理を図１を参照して説明する。二足歩行移動体の運動状態（歩行動作時の脚体の運動状態）は、図１（ａ）に例示するように二足歩行移動体１の両脚体２，２のうちの一方の脚体２（図では進行方向で前側の脚体）のみが接地する単脚支持状態と、図１（ｂ）に示すように両脚体２，２が接地する両脚支持状態とがある。
【０００８】
ここで、両脚体２，２に床Ａから作用する全床反力をＦとおくと、該全床反力Ｆは、図１（ａ）の単脚支持状態では、接地している脚体２に作用する床反力に等しく、また、図１（ｂ）の両脚支持状態では、両脚体２，２にそれぞれ作用する床反力Ff，Frの合力である。また、二足歩行移動体１が運動を行う床Ａに対して固定した絶対座標系Ｃfにおける二足歩行移動体１の重心G0の加速度ａのＸ軸方向（二足歩行移動体２の進行方向での水平方向）、Ｚ軸方向（鉛直方向）の成分をそれぞれａx，ａz、二足歩行移動体１に作用する全床反力ＦのＸ軸方向、Ｚ軸方向の成分をそれぞれＦx，Ｆzとおくと、重心Ｇ0の運動方程式（詳しくは、重心G0の並進運動に関する運動方程式）は、次式（１）により表される。
【０００９】
T(Ｆx，Ｆz−Ｍ・ｇ)＝Ｍ・T(ａx，ａz) ……（１）
（但し、Ｍ：二足歩行移動体の重量、ｇ：重力加速度）
尚、式（１）中の両辺の括弧部分T( ， ）は２成分のベクトルを意味している。本明細書ではT( ， ）という形の表記は、ベクトルを表す。
【００１０】
つまり、重心G0の運動方程式は、該重心G0の加速度ａと二足歩行移動体１の重量Ｍとの積が、該重心G0に作用する重力（＝Ｍ・ｇ）と、前記全床反力Ｆとの合力に等しいという関係式になる。
【００１１】
従って、二足歩行移動体１の重心Ｇ0の加速度ａ＝T(ａx，ａz)を把握すれば、その加速度ａと、二足歩行移動体１の重量Ｍの値と、重力加速度ｇの値とを用いて、次式（２）により、全床反力Ｆ＝T(Ｆx，Ｆz)の推定値を得ることができることとなる。
【００１２】
T(Ｆx，Ｆz)＝Ｍ・T(ａx，ａz＋ｇ) ……（２）
【００１３】
そして、図１（ａ）の単脚支持状態では、接地している単一の脚体２に作用する床反力は、上記全床反力Ｆに等しいので、式（２）によりその単一の脚体２に作用する床反力Ｆの推定値が得られることとなる。
【００１４】
この場合、床反力Ｆの推定値を得るために必要な重量Ｍは、あらかじめ計測等により把握することができる。また、重心Ｇ0の位置や加速度ａについては、詳細は後述するが、二足歩行移動体１の各関節の屈曲角度（回転角度）を検出するセンサや、加速度センサ、ジャイロセンサ等のセンサの出力を用いて公知の手法等により逐次把握することが可能である。
【００１５】
また、図１（ｂ）の両脚支持状態では、前側脚体２の床反力FfのＸ軸方向、Ｚ軸方向の成分をそれぞれＦfx，Ｆfz、後側脚体２の床反力ＦrのＸ軸方向、Ｚ軸方向の成分をそれぞれＦrx，Ｆrzとして、全床反力ＦのＸ軸方向、Ｚ軸方向の成分Ｆx，ＦzはそれぞれＦfx＋Ｆrx，Ｆfz＋Ｆrzになり、重心Ｇ0の運動方程式は、次式（３）により表される。
【００１６】
T(Ｆfx＋Ｆrx，Ｆfz＋Ｆrz−Ｍ・ｇ)＝Ｍ・T(ａx，ａz) ……（３）
【００１７】
ここで、両脚支持状態において、各脚体２，２の床反力Ｆf，Ｆrは、図１（ｂ）に示すように、各脚体２，２の下端部近傍の特定部位１２f，１２r（例えば足首部）から二足歩行移動体１の重心Ｇ0に向かって作用すると仮定する。この場合、前記重心Ｇ0に対する各脚体２，２の前記特定部位１２f，１２rの位置と、各脚体２，２に作用する床反力Ｆf，Ｆrとの間には一定の関係式、すなわち、前記重心Ｇ0と各脚体２，２の特定部位１２f，１２rとを結ぶ線分の向き（該重心Ｇ0に対する該特定部位１２f，１２rの位置ベクトルの向き）が該脚体２，２に係る床反力Ｆf，Ｆrの向きに等しいという関係を表す関係式が成立する。
【００１８】
具体的には、図１（ｂ）を参照して、前記絶対座標系Ｃｆにおける重心Ｇ0の位置の座標を（Ｘg，Ｚg）、前側脚体２の特定部位１２fの位置の座標を（Ｘf，Ｚf）、後側脚体２の特定部位１２rの位置の座標を（Ｘr，Ｚr）とおくと、上記の関係式は次式（４）となる。
【００１９】
(Ｚf−Ｚg)／(Ｘf−Ｘg)＝Ｆfz／Ｆfx
(Ｚr−Ｚg)／(Ｘr−Ｘg)＝Ｆrz／Ｆrx……（４）
【００２０】
そして、この式（４）と前記式（３）から次式（５）（５’）が得られる。
【００２１】
Ｆfx＝Ｍ・｛ΔＸf・(ΔＺr・ａx−ΔＸr・ａz
−ΔＸr・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf)
Ｆrx＝Ｍ・｛ΔＸr・(−ΔＺf・ａx＋ΔＸf・ａz
＋ΔＸf・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf) ……（５）
Ｆfz＝Ｍ・｛ΔＺf・(ΔＺr・ａx−ΔＸr・ａz
−ΔＸr・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf)
Ｆrz＝Ｍ・｛ΔＺr・(−ΔＺf・ａx＋ΔＸf・ａz
＋ΔＸf・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf)……（５’）
（但し、ΔＺf＝Ｘf−Ｘg，ΔＺf＝Ｚf−Ｚg，
ΔＸr＝Ｘr−Ｘg，ΔＺr＝Ｚr−Ｚg）
【００２２】
従って、二足歩行移動体１の重心Ｇ0の加速度ａ＝T(ａx，ａz)を把握すると共に、二足歩行移動体１の重心Ｇ0に対する各脚体２，２のそれぞれの特定部位１２f，１２rの位置（これは式（５）（５’）ではΔＸf，ΔＺf，ΔＸr，ΔＺrにより表される）を把握すれば、その加速度ａ及び特定部位１２f，１２rの位置と、二足歩行移動体１の重量Ｍの値と、重力加速度ｇの値とを用いて、前記式（５）（５’）により、各脚体２毎の床反力Ｆf＝T(Ｆfx，Ｆfz)、Ｆr＝T(Ｆrx，Ｆrz)の推定値を得ることができることとなる。
【００２３】
この場合、床反力Ｆf，Ｆrの推定値を得るために必要な重量Ｍは、あらかじめ計測等により把握することができる。また、重心Ｇ0の加速度ａや重心Ｇ0の位置、該重心Ｇ0に対する前記特定部位１２f，１２rの位置については、詳細は後述するが、二足歩行移動体１の各関節の屈曲角度（回転角度）を検出するセンサや、加速度センサ、ジャイロセンサ等のセンサの出力を用いて、公知の手法等により逐次把握することが可能である。
【００２４】
然し、上記先願の方法で求めた両脚支持状態における各脚体の床反力の鉛直方向成分Ｆfz，Ｆrzの推定値は必ずしも満足できる精度ではないことが判明した。これは、各脚体２，２の床反力Ｆf，Ｆrが各脚体２，２の特定部位１２f，１２rから二足歩行移動体１の重心Ｇ0に向かって作用するとは限らないためである。そして、二足歩行移動体１の重量の影響で大きな値になる床反力の鉛直方向成分の推定値は進行方向成分に比し誤差が大きくなる。
【００２５】
【発明が解決しようとする課題】
本発明は、以上の点に鑑み、比較的簡単な手法で両脚支持状態における各脚体の床反力の鉛直方向成分を精度よくリアルタイムで把握することができ、特に二足歩行移動体としての人間に係る床反力を把握する上で好適な床反力推定方法を提供することを課題としている。
【００２６】
【課題を解決するための手段】
本発明の二足歩行移動体の床反力推定方法、すなわち、二足歩行移動体の運動状態が該二足歩行移動体の両脚体が接地している両脚支持状態であるときの各脚体に作用する床反力の鉛直方向成分を推定する方法は、上記課題を解決するため、二足歩行移動体の重心の位置を逐次求めつつ、該重心の位置の時系列データを用いて床に対して固定された絶対座標系での該重心の加速度を逐次求める第１ステップと、二足歩行移動体の重量と重力加速度と前記重心の加速度と各脚体に作用する床反力の合力である全床反力とにより表される該重心の運動方程式に基づき、該全床反力の推定値を逐次求める第２ステップと、前記両脚支持状態において両脚体のうち少なくとも二足歩行移動体の進行方向に向かって前側に存する前側脚体の足平部のあらかじめ定めた特定部位の床面からの位置を逐次求める第３ステップとを備え、前記両脚支持状態であるときには、両脚体のうち該二足歩行移動体の進行方向に向かって後側に存する後側脚体に作用する床反力の鉛直方向成分と、前側脚体の足平部の前記特定部位の床面からの位置との間に成立する所定の相関関係に基づき、前記第３ステップで求めた前側脚体の足平部の前記特定部位の床面からの位置を用いて後側脚体に作用する床反力の鉛直方向成分の推定値を逐次求め、その求めた後側脚体の床反力の鉛直方向成分の推定値を前記第２ステップで求めた全床反力の鉛直方向成分の推定値から差し引くことにより、前側脚体に作用する床反力の鉛直方向成分の推定値を逐次求めることを特徴とする。
【００２７】
本願発明者は、鋭意努力の結果、両脚支持状態において後側脚体に作用する床反力の鉛直方向成分は、前側脚体の足平部の踵が着床して両脚支持状態に移行してから、前側脚体の足平部の特定部位（例えば中足趾節関節）の床面からの位置変化に対して顕著な相関性を持って変化することを知見するに至った。従って、後側脚体に作用する床反力の鉛直方向成分と前側脚体の足平部の特定部位の床面からの位置との間に成立する相関関係を各種実験やシミュレーション等であらかじめ調べておけば、その相関関係に基づいて、本発明のように前側脚体の足平部の特定部位の床面からの位置を用いて後側脚体に作用する床反力の鉛直方向成分を推定することができる。そして、後側脚体に作用する床反力と前側脚体に作用する床反力の合力が全床反力であるので、この全床反力の鉛直方向成分の推定値から、上記相関関係に基づいて求められる後側脚体に作用する床反力の鉛直方向成分の推定値を差し引くことにより、前側脚体に作用する床反力の鉛直方向成分の推定値を求めることができる。
【００２８】
尚、後側と前側の各脚体に作用する床反力の進行方向成分の推定値は、適宜の手法、例えば、上記先願と同様に上記式（５）から求めればよい。
【００２９】
ここで、本発明における全床反力の推定値は上記先願と同様の手法で求められる。そして、この全床反力の推定値を求めるために必要な二足歩行移動体の重量は、あらかじめ計測等により把握しておけばよい。また、二足歩行移動体の重心の位置や加速度は、二足歩行移動体の各関節の屈曲角度（回転角度）を検出するセンサ（ポテンショメータ等）や、加速度センサ、ジャイロセンサ等、比較的小型で二足歩行移動体への装備が容易なセンサの出力のデータを用いてリアルタイムで把握することが可能であり、足平部の特定部位の床面からの位置も、履き物等に傾斜測定用の簡易な加速度センサ等を装備しておくことによりリアルタイムで把握することが可能である。
【００３０】
従って、本発明の床反力推定方法によれば、二足歩行移動体の足首部や足平部に力センサを装着したり、フォースプレートを使用したりすることなく、比較的簡単な手法で床反力をリアルタイムで把握することができる。
【００３１】
【発明の実施の形態】
本発明の一実施形態を図２〜図９を参照して説明する。
【００３２】
本実施形態は、二足歩行移動体としての人間に本発明の床反力推定方法を適用した実施形態である。
【００３３】
図２に模式化して示すように、人間１は、その構成を大別すると、左右一対の脚体２，２と、腰部３及び胸部４からなる胴体５と、頭部６と、左右一対の腕体７，７とを有する。胴体５は、その腰部３が脚体２，２のそれぞれに左右一対の股関節８，８を介して連結され、両脚体２，２上に支持されている。また、胴体５の胸部４は、腰部３の上側に該腰部３に対して人間１の前方側に傾斜可能に存している。そして、この胸部４の上部の左右両側部から腕体７，７が延設され、該胸部４の上端部に頭部６が支持されている。
【００３４】
各脚体２，２は、股関節８から延在する大腿部９と、該大腿部９の先端から膝関節１０を介して延在する下腿部１１とを有し、下腿部１１の先端部に、足首部（足首関節）１２を介して足平部１３が連結されている。
【００３５】
本実施形態では、このような構成を有する人間１の各脚体２に作用する床反力の推定、さらには膝関節１０及び股関節８に作用するモーメントの推定を行うために、次のような装置を人間１に装備している。
【００３６】
すなわち、胴体５の胸部４には、胸部４の傾斜に伴う角速度に応じた出力を発生するジャイロセンサ１４（以下、胸部ジャイロセンサ１４という）と、胸部４の前後方向の加速度に応じた出力を発生する加速度センサ１５（以下、胸部前後加速度センサ１５という）と、CPU、RAM、ROM等から構成される演算処理装置１６と、該演算処理装置１６等の電源となるバッテリ１７とが装着されている。この場合、これらの胸部ジャイロセンサ１４、胸部前後加速度センサ１５、演算処理装置１６及びバッテリ１７は、例えば胸部４に図示しないベルト等を介して固定されるショルダーバッグ状の収容部材１８に収容され、該収容部材１８を介して胸部４に一体的に固定されている。
【００３７】
尚、胸部加速度センサ１５の出力が表す加速度は、より詳しくは、胸部４の水平断面方向（胸部４の軸心と直交する方向）での前後方向の加速度であり、人間１が平地に直立姿勢で起立した状態では、前後水平方向（図２の絶対座標系のＸ軸方向）での加速度であるが、腰部３あるいは胸部４が鉛直方向（図２の絶対座標系のＺ軸方向）から傾斜した状態では、胸部４の鉛直方向に対する傾斜角度分だけ水平方向に対して傾斜した方向での加速度となる。
【００３８】
また、胴体５の腰部３には、腰部３の傾斜に伴う角速度に応じた出力を発生するジャイロセンサ１９（以下、腰部ジャイロセンサ１９という）と、腰部３の前後方向の加速度に応じた出力を発生する加速度センサ２０（以下、腰部前後加速度センサ２０という）と、腰部３の上下方向の加速度に応じた出力を発生する加速度センサ２１（以下、腰部上下加速度センサ２１という）とが、図示しないベルト等の固定手段を介して一体的に装着・固定されている。
【００３９】
ここで、腰部前後加速度センサ２０は、より詳しくは胸部前後加速度センサ１５と同様、腰部３の水平断面方向（腰部３の軸心と直交する方向）での前後方向の加速度を検出するセンサである。また、腰部上下加速度センサ２１は、より詳しくは、腰部３の軸心方向での上下方向の加速度（これは腰部前後加速度センサ２０が検出する加速度と直交する）を検出するセンサである。尚、腰部前後加速度センサ２０及び腰部上下加速度センサ２１は、二軸型の加速度センサにより一体的に構成されたものであってもよい。
【００４０】
さらに各脚体２の股関節８と膝関節１０とには、それぞれの屈曲角度Δθc，Δθdに応じた出力を発生する膝関節角度センサ２２及び股関節角度センサ２３が装着されている。尚、股関節角度センサ２２については、図２では手前側（人間１の前方に向かって右側）の脚体２の股関節８に係わる股関節角度センサ２２のみが図示されているが、他方側（人間１の前方に向かって左側）の脚体２の股関節８には、手前側の股関節角度センサ２２と同心に、股関節角度センサ２２が装着されている。
【００４１】
これらの角度センサ２２，２３は、例えばポテンショメータにより構成されたものであり、各脚体２に図示しないバンド部材等の手段を介して装着されている。ここで、各股関節角度センサ２２が検出する屈曲角度Δθcは、より詳しくは、腰部３と各脚体２の大腿部９との姿勢関係が所定の姿勢関係（例えば人間１の直立姿勢状態のように腰部３の軸心と大腿部９の軸心とがほぼ平行となる姿勢関係）にあるときを基準とした、腰部３に対する各脚体２の大腿部９の股関節８回り（人間１の左右方向における股関節８の軸心回り）の回転角度である。同様に、各膝関節角度センサ２３が検出する屈曲角度Δθdは、各脚体２の大腿部９と下腿部１１との姿勢関係が所定の姿勢関係（例えば大腿部９の軸心と下腿部１１の軸心とがほぼ平行となる姿勢関係）にあるときを基準とした、大腿部９に対する下腿部１１の膝関節１０回り（人間１の左右方向における膝関節１０の軸心回り）の回転角度である。
【００４２】
また、各脚体２の足平部１３の特定部位、例えば、中足趾節関節の床面からの位置（以下ＭＰ高さと記す）を計測するためのセンサが設けられている。これを図３を参照して詳述するに、足平部１３の踵１３ａから中足趾節関節１３ｂまでは剛体と仮定でき、ＭＰ高さＨは、踵１３ａから中足趾節関節１３ｂまでの距離をＤ、床面に対する足平部１３の傾斜角度をθとして、Ｈ＝Ｄｓｉｎθになる。そして、足平部１３の長手方向の加速度を検出する加速度センサ２４を履き物等に装備しておけば、この加速度センサ２４による計測加速度をｇｓ、重力加速度をｇとして、θ＝Ａｒｃｓｉｎ（ｇｓ／ｇ）の式でθを算出でき、このθを用いてＭＰ高さＨを求められる。ここで、両脚支持状態では、人間１の進行方向に向かって前側の脚体２の踵位置は加速せず、加速度センサ２４は足平部１３の傾斜角度θに応じた加速度を正確に検出する。従って、加速度センサ２４により足平部１３の傾斜角度θひいてはＭＰ高さＨを正確に計測できる。尚、加速度センサ２４に作用する接地衝撃を減らすため、加速度センサ２４の装備位置は踵から離れたつま先側にすることが望ましい。
【００４３】
前記各センサ１４，１５，１９〜２４は、それらの出力を演算処理装置１６に入力すべく、図示を省略する信号線を介して演算処理装置１６に接続されている。
【００４４】
前記演算処理装置１６は、図４に示すような機能的手段を備えている。すなわち、演算処理装置１６は、腰部上下加速度センサ２１の検出データと、後述する床反力推定手段３８により求められた各脚体２の床反力の推定値のデータとを用いて、人間１の脚体２，２の運動状態が単脚支持状態（図１（ａ）の状態）であるか、両脚支持状態（図１（ｂ）の状態）であるかを判断する脚体運動判断手段２５を備えている。また、演算処理装置１６は、胸部前後加速度センサ１５及び胸部ジャイロセンサ１４の検出データを用いて、胸部４の絶対座標系Ｃfにおける傾斜角度θa（具体的には例えば鉛直方向に対する傾斜角度θa。図２参照）を計測する胸部傾斜角度計測手段２６と、腰部前後加速度センサ２０及び腰部ジャイロセンサ１９の検出データを用いて、腰部３の絶対座標系Ｃfにおける傾斜角度θb（具体的には例えば鉛直方向に対する傾斜角度θb。図２参照）を計測する腰部傾斜角度計測手段２７とを備えている。
【００４５】
さらに、演算処理装置１６は、腰部前後加速度センサ２０及び腰部上下加速度センサ２１の検出データと前記腰部傾斜角度計測手段２７により計測された腰部３の傾斜角度θbのデータとを用いて、本実施形態における人間１の基準点として図２に示すように腰部３に設定される身体座標系Ｃp（図２のｘｚ座標）の原点Ｏの絶対座標系Ｃfにおける加速度（並進加速度）ａ0＝T(ａ0x，ａ0z)を求める基準加速度計測手段２８を備えている。ここで、身体座標系Ｃｐは、より詳しくは、例えば人間１の左右の股関節８，８のそれぞれの中心を結ぶ線の中点を原点Ｏとし、鉛直方向をｚ軸方向、人間１の前方に向かう水平方向をｘ軸方向とした座標系（３軸の方向が前記絶対座標系Ｃfと同一の座標系）である。
【００４６】
また、演算処理装置１６は、各脚体２の股関節角度センサ２２及び膝関節角度センサ２３の検出データと、前記腰部傾斜角度計測手段２７による腰部３の傾斜角度θbのデータとを用いて、絶対座標系Ｃfにおける各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θd（具体的には例えば鉛直方向に対する傾斜角度θc，θd。図２参照）求める脚体姿勢算出手段２９を備えている。
【００４７】
また、演算処理装置１６は、前記胸部傾斜角度計測手段２６、腰部傾斜角度計測手段２７及び脚体姿勢算出手段２９により得られる胸部４の傾斜角度θa、腰部３の傾斜角度θb、並びに各脚体２の大腿部９の傾斜角度θc及び下腿部１１の傾斜角度θdのデータを用いて、後述の剛体リンクモデルに対応する人間１の各剛体相当部の重心の位置（詳しくは前記身体座標系Ｃpにおける各剛体相当部の重心の位置）を求める各部重心位置算出手段３０と、その各剛体相当部の重心の位置のデータを用いて、上記身体座標系Ｃpにおける人間１の全体の重心の位置を求める身体重心位置算出手段３１と、その人間１の全体の重心G0（図１参照。以下、身体重心G0という）の位置のデータと前記脚体姿勢算出手段２９による各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータとを用いて本実施形態における各脚体２の特定部位としての各脚体２の足首部１２の身体重心G0に対する位置（詳しくは、前記式（５）におけるΔＸf，ΔＺf，ΔＸr，ΔＺr）を求める足首位置算出手段３２と、前記足平部加速度センサ２４の検出データを用いてＭＰ高さＨを求めるＭＰ高さ算出手段３３と、前記身体重心位置算出手段３１による身体重心の位置のデータと前記基準加速度計測手段２７による身体座標系Ｃpの原点Ｏの加速度ａ0のデータとを用いて絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ａx，ａz)(図１参照）を求める身体重心加速度算出手段３４とを備えている。
【００４８】
さらに、演算処理装置１６は、前記各部重心位置算出手段３０による人間１の各剛体相当部の重心の位置（詳しくは脚体２に係わる剛体相当部の重心の位置）のデータと前記基準加速度計測手段２８による身体座標系Cpの原点Ｏの加速度ａ0のデータとを用いて絶対座標系Ｃfにおける各脚体２の大腿部９及び下腿部１１のそれぞれの重心の加速度（並進加速度）を求める脚体各部加速度算出手段３５と、前記脚体姿勢算出手段２９による各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータを用いて絶対座標系Ｃfにおける各脚体２，２の大腿部９及び下腿部１１の角加速度を求める脚体各部角加速度算出手段３６と、前記脚体姿勢算出手段２８による各脚体２，２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのうち、例えば大腿部９の傾斜角度θcのデータを用いて接地している各脚体２の床反力作用点の位置を推定する床反力作用点推定手段３７とを備えている。
【００４９】
また、演算処理装置１６は、前記身体重心加速度算出手段３４による身体重心の加速度ａのデータと前記足首位置算出手段３２による足首位置のデータと前記ＭＰ高さ算出手段３３によるＭＰ高さＨのデータと前記脚体運動判断手段２５による脚体２の運動状態の判断結果のデータとを用いて各脚体２に作用する床反力の推定値を求める床反力推定手段３８と、この床反力の推定値のデータと脚体各部加速度算出手段３５による各脚体２の大腿部９及び下腿部１１の重心の加速度のデータと脚体各部角加速度算出手段３６による各脚体２の大腿部９及び下腿部１１の角加速度のデータと床反力作用点推定手段３７による床反力作用点の推定位置のデータと前記脚体姿勢算出手段２９による各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータとを用いて各脚体２の膝関節１０及び股関節８にそれぞれ作用するモーメントを推定する関節モーメント推定手段３９とを備えている。
【００５０】
次に、上述の演算処理装置１６の各手段のより詳細な処理内容と併せて、本実施形態の作動を説明する。
【００５１】
本実施形態では、例えば人間１が歩行等の脚体２の運動を行うに際して、両脚体２，２を着床させた状態で演算処理装置１６の図示しない電源スイッチを投入すると、該演算処理装置１６による処理が所定のサイクルタイム毎に以下に説明するように逐次実行され、各脚体２に作用する床反力の推定値等が逐次求められる。
【００５２】
すなわち、まず、演算処理装置１６は、前記脚体運動判断手段２５の処理を実行する。この脚体運動判断手段２５の処理では、前記サイクルタイム毎に、前記腰部上下加速度センサ２１による腰部３の上向き方向の加速度の検出データがあらかじめ定めた所定の閾値と比較される。そして、該加速度の検出値がその閾値を超えたときに、前記図１（ｂ）に示したような両脚支持状態が開始し、且つ、前記図１（ａ）に示したような単脚支持状態が終了すると判断される。すなわち、人間１の歩行時に、単脚支持状態から両脚支持状態への移行の際には、遊脚側の脚体２が着床することで、股関節８の近傍の腰部３には、ほぼ上向きに比較的大きな加速度（通常的な単脚支持状態では発生し得ない加速度）が発生する。このため、前記脚体運動判断手段２５は、上記のように腰部上下加速度センサ２１による腰部３の上向き方向の加速度の検出データを所定の閾値と比較することで、両脚支持状態の開始及び単脚支持状態の終了を判断する。
【００５３】
また、脚体運動判断手段２５の処理では、両脚支持状態で床反力推定手段３８により後述するように求められた両脚体２，２のそれぞれに作用する床反力Ｆf，Ｆr（図１（ｂ）参照）の推定値のうち、人間１の進行方向に対して後側の脚体２に係る床反力Ｆr＝T(Ｆrx，Ｆrz)の推定値（詳しくは演算処理装置１６の前回のサイクルタイムで求められた床反力Ｆrの絶対値＝√(Ｆrx2+Ｆrz2)）があらかじめ定めた所定の閾値（略「０」の正の値）と比較される。そして、該床反力Ｆrの推定値の絶対値がその閾値以下に低下したときに、両脚支持状態が終了し、且つ単脚支持状態が開始すると判断される。尚、本実施形態では、脚体２の運動状態の初期状態は、両脚支持状態であり、いずれか一方の脚体２に係る床反力の推定値が上記閾値以下に低下するまでは、脚体運動判断手段２５は、脚体２の運動状態が両脚支持状態であると判断する。
【００５４】
上述のような脚体運動判断手段２５の処理と並行して、演算処理装置１６は、前記胸部傾斜角度計測手段２６及び腰部傾斜角度計測手段２７による処理を実行する。この場合、胸部傾斜角度計測手段２６の処理では、胸部前後加速度センサ１５及び胸部ジャイロセンサ１４からそれぞれ入力される胸部４の前後方向の加速度、胸部４の角速度の検出データから、所謂カルマンフィルタの処理を用いた公知の手法により、絶対座標系Ｃfにおける胸部４の傾斜角度θaが前記サイクルタイム毎に逐次求められる。同様に、腰部傾斜角度計測手段２７の処理では、腰部前後加速度センサ２０及び腰部ジャイロセンサ１９からそれぞれ入力される腰部３の前後方向の加速度、腰部３の角速度の検出データから、カルマンフィルタの処理を用いて絶対座標系Ｃfにおける腰部３の傾斜角度θbが逐次求められる。ここで、絶対座標系Ｃfにおける胸部４及び腰部３のそれぞれの傾斜角度θa，θbは、本実施形態では例えば鉛直方向（重力方向）に対する傾斜角度である。
【００５５】
尚、例えばジャイロセンサ１４，１９による角速度の検出データを積分することで、胸部４や腰部３の傾斜角度を求めることも可能であるが、本実施形態のようにカルマンフィルタの処理を用いることで、胸部４や腰部３の傾斜角度θa，θbを精度よく計測することができる。
【００５６】
次に、演算処理装置１６は、前記脚体姿勢算出手段２９の処理と前記基準加速度計測手段２８の処理とを実行する。
【００５７】
前記脚体姿勢算出手段２９による処理では、絶対座標系Ｃfにおける各脚体２の大腿部９及び下腿部１１の傾斜角度θc，θd（鉛直方向に対する傾斜角度。図２参照）が前記サイクルタイム毎に次のように求められる。すなわち、各脚体２の大腿部９の傾斜角度θcは、その脚体２に装着されている前記股関節角度センサ２２による股関節８の屈曲角度Δθcの検出データの今回値と、前記腰部傾斜角度計測手段２５により求められた腰部３の傾斜角度θbの今回値とから次式（６）により算出される。
【００５８】
θc＝θb＋Δθc ……（６）
【００５９】
ここで、腰部３の傾斜角度θbは、該腰部３の上端部が下端部よりも人間１の前方側に突き出るように該腰部３が鉛直方向に対して傾斜している場合に負の値となるものであり、股関節８の屈曲角度Δθcは、大腿部９の下端部が人間１の前方側に突き出るように大腿部９が腰部３の軸心に対して傾斜している場合に正の値となるものである。
【００６０】
さらに、各脚体２の下腿部１１の傾斜角度θdは、上記のように求められた大腿部９の傾斜角度θcの今回値と、該脚体２に装着されている前記膝関節角度センサ２３による膝関節１０の屈曲角度Δθdの検出データの今回値とから次式（７）により算出される。
【００６１】
θd＝θc−Δθd ……（７）
【００６２】
ここで、膝関節１０の屈曲角度は、下腿部１１が大腿部９の軸心に対して該大腿部９の背面側に傾斜している場合に正の値となるものである。
【００６３】
また、前記基準加速度計測手段２８の処理では、前記身体座標系Ｃpの原点Ｏの絶対座標系Ｃfにおける加速度ａ0＝T(a0x，a0z）が次のように求められる。すなわち、前記腰部前後加速度センサ２０による腰部３の前後方向の加速度の検出データの今回値をap、前記腰部上下加速度センサ２１による腰部３の上下方向の加速度の検出データの今回値をaqとすると、それらの検出データap，aqと、前記腰部傾斜角度計測手段２７により求められた腰部３の傾斜角度θbの今回値とから、次式（８）により絶対座標系Ｃfにおける加速度ａ0＝T(a0x，a0z）が求められる。
【００６４】
a0＝T(a0x，a0z）
＝T(ap・cosθb−aq・sinθb，ap・sinθb＋aq・cosθb−ｇ)……（８）
【００６５】
次に、演算処理装置１６は、前記各部重心位置算出手段３０の処理を実行し、以下に説明する剛体リンクモデルを用いて、前記身体座標系Ｃpにおける人間１の各剛体相当部の重心の位置（身体座標系Ｃpの原点に対する位置）を求める。
【００６６】
図５に示すように、本実施形態で用いる剛体リンクモデルＲは、人間１を、各脚体２の大腿部９に相当する剛体R1，R1と、下腿部１１に相当する剛体R2，R2と、腰部３に相当する剛体R3と、前記胸部４、腕体７，７及び頭部６を合わせた部分（以下、上体部という）４０に相当する剛体R4とを連結してなるものとして表現するモデルである。この場合、各剛体R1と剛体R3との連結部、並びに、各剛体R1と剛体R2との連結部がそれぞれ股関節８、膝関節１０に相当する。また、剛体R3と剛体R4との連結部は腰部３に対する胸部４の傾動支点部４１である。
【００６７】
そして、本実施形態では、このような剛体リンクモデルＲの各剛体R1〜R4に対応する人間１の剛体相当部（各脚体２の大腿部９及び下腿部１１、腰部３、上体部４０）のそれぞれの重心G1、G2、G3、G4の各剛体相当部における位置があらかじめ求められ、演算処理装置１６の図示しないメモリに記憶されている。
【００６８】
ここで、演算処理装置１６に記憶保持している各剛体相当部の重心G 1、G2、G3、G4の位置は、各剛体相当部に対して固定した座標系での位置である。この場合、各剛体相当部の重心G1、G2、G3、G4の位置を表すデータとして、例えば、各剛体相当部の一端部の関節の中心点から該剛体相当部の軸心方向の距離が用いられる。具体的には、例えば図４に示すように、各大腿部９の重心G1の位置は、該大腿部９の股関節８の中心から大腿部９の軸心方向に距離ｄ1の位置、各下腿部１１の重心G2の位置は、該下腿部１１の膝関節１０の中心から下腿部１１の軸心方向に距離ｄ2の位置として表され、それらの距離ｄ1，ｄ2の値があらかじめ求められて演算処理装置１６に記憶保持されている。他の剛体相当部の重心、G3、G4の位置についても同様である。
【００６９】
尚、上体部４０の重心G4の位置は、厳密には、該上体部４０に含まれる腕体７，７の動きの影響を受けるが、歩行時における各腕体７，７は、一般に胸部４の軸心に対して対称的な位置関係になるので、上体部４０の重心G4の位置はさほど変動せず、例えば直立姿勢状態における上体部４０の重心G4の位置とほぼ同一となる。
【００７０】
また、本実施形態では、各剛体相当部（各脚体２の大腿部９及び下腿部１１、腰部３、上体部４０）の重心G1、G2、G3、G4の位置を表すデータの他、各剛体相当部の重量のデータや、各剛体相当部のサイズのデータ（例えば各剛体相当部の長さのデータ）があらかじめ求められて、演算処理装置１６に記憶保持されている。
【００７１】
尚、下腿部１１の重量は、足平部１３を含めた重量である。また、上述のように演算処理装置１６にあらかじめ記憶保持したデータは、実測等により求めておいてもよいが、人間１の身長や体重から、人間の平均的な統計データに基づいて推測するようにしてもよい。一般に、上記各剛体相当部の重心G1、G2、G3、G 4の位置や、重量、サイズは、人間の身長や体重と相関性があり、その相関データに基づいて、人間の身長及び体重のデータから、上記各剛体相当部の重心G1、G2、G3、G4の位置や、重量、サイズを比較的精度よく推測することが可能である。
【００７２】
前記各部重心位置算出手段３０は、上述のように演算処理装置１６にあらかじめ記憶保持したデータと、前記胸部傾斜角度計測手段２６及び腰部傾斜角度計測手段２７によりそれぞれ求められた胸部４の傾斜角度θa（＝上体部３９の傾斜角度）及び腰部３の傾斜角度θbの今回値と、前記脚体姿勢算出手段２９により求められた各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdの今回値とから、腰部３に固定された原点Ｏを有する身体座標系Ｃp（図５のｘｚ座標）での各剛体相当部の重心G1、G2、G3、G4の位置を求める。
【００７３】
この場合、各剛体相当部（各脚体２の大腿部９及び下腿部１１、腰部３、上体部４０）の傾斜角度θa〜θdが上述のように求められているので、その傾斜角度θa〜θｄのデータと、各剛体相当部のサイズのデータとから身体座標系Ｃpにおける各剛体相当部の位置及び姿勢が判る。従って、身体座標系Cpにおける各剛体相当部の重心G1、G2、G3、G4の位置が求められることとなる。
【００７４】
具体的には、例えば図５を参照して、同図５の左側に位置する脚体２に関し、大腿部９の身体座標系Ｃpにおける傾斜角度（ｚ軸方向に対する傾斜角度）はθc（この場合、図５ではθc＜０である）であるので、身体座標系Ｃpにおける大腿部９の重心G1の位置の座標は、（ｄ1・sinθc，−ｄ1・cosθc）となる。また、下腿部１１の身体座標系Ｃpにおける傾斜角度はθd（図５ではθd＜０）であるので、身体座標系Ｃpにおける下腿部１１の重心G2の位置の座標は、大腿部９の長さをＤcとすると、（Ｄc・sinθc＋ｄ2・sinθd，−Ｄc・cosθc−ｄ2・cosθd）となる。他の脚体２の大腿部９及び下腿部１１並びに、腰部３及び上体部４０の重心についても上記と同様に求められる。
【００７５】
このようにして、各部重心位置算出手段３０により、身体座標系Ｃpにおける各剛体相当部の重心G1、G2、G3、G4の位置を求めた後、演算処理装置１６は、前記身体重心位置算出手段３１の処理実行し、各剛体相当部の重心G1、G2、G3、G4の位置のデータと、各剛体相当部の重量のデータとを用いて身体座標系Ｃpにおける人間１の身体重心G0の位置（xg，zg）を求める。
【００７６】
ここで、身体座標系Ｃpにおける腰部３の重心G3の位置及び重量をそれぞれ（x3，z3）、m3、上体部４０の重心G4の位置及び重量をそれぞれ（x4，z4）、m4、人間１の前方に向かって左側の脚体２の大腿部９の重心G1の位置及び重量をそれぞれ（x1L，z1L）、m1L、同脚体２の下腿部１１の重心G2の位置及び重量をそれぞれ（x2L，z2L）、m2L、右側の脚体２の大腿部９の重心G1の位置及び重量をそれぞれ（x1R，z1R）、m1R、同脚体２の下腿部１１の重心G2の位置及び重量をそれぞれ（x2R，z2R）、m2R、人間１の体重をＭ（＝m1L＋m2L＋m1R＋m2R＋m3＋m4）とすると、身体座標系Ｃpにおける人間１の身体重心G0の位置（xg，zg）は次式（９）により求められる。
【００７７】
xg＝（m1L・x1L＋m1R・x1R＋m2L・x2L＋m2R・x2R
＋m3・x3＋m4・x4）／Ｍ
zg＝（m1L・z1L＋m1R・z1R＋m2L・z2L＋m2R・z2R
＋m3・z3＋m4・z4）／Ｍ ……（９）
【００７８】
このようにして身体重心位置算出手段３１の処理を実行した後、さらに、演算処理装置１６は、前記身体重心加速度算出手段３４の処理と、前記足首位置算出手段３２の処理と、前記ＭＰ高さ算出手段３３の処理とを実行する。
【００７９】
この場合、身体重心加速度算出手段３４の処理では、まず、前記サイクルタイム毎に身体重心位置算出手段３０により求められる身体座標系Ｃpにおける身体重心G0の位置（xg，zg）の時系列データを用いて、身体座標系Ｃpにおける身体重心G0の位置（xg，zg）の２階微分値、すなわち、身体座標系Ｃpの原点Ｏに対する身体重心G0の加速度T(d2xg／dt2，d2zg／dt2)が求められる。そして、この加速度T(d2xg／dt2，d2zg／dt2)と、前記基準加速度計測手段２７により求められた身体座標系Ｃpの原点Ｏの絶対座標系Ｃfにおける加速度a0＝T(a0x，a0z）とのベクトル和を求めることにより、絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ax，az)が求められる。
【００８０】
また、前記足首位置算出手段３２の処理では、まず、前記脚体姿勢算出手段２９により求められた各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータの今回値と、前記腰部傾斜角度計測手段２７により求められた腰部３の傾斜角度θbのデータの今回値と、該大腿部９及び下腿部１１のサイズ（長さ）のデータとから、前記各部重心位置算出手段３０の処理と同様の処理によって、前記身体座標系Ｃpにおける各脚体２の足首部１２の位置が求められる。具体的には、図５を参照して、同図５の左側に位置する脚体２に関し、下腿部１１の長さ（膝関節１０の中心から足首部１２までの長さ）をＤdとすると、身体座標系Ｃpにおける足首部１２の位置の座標（x12，z12）は、（Ｄc・sinθc＋Ｄd・sinθd，−Ｄc・cosθc−Ｄd・cosθd）となる（但し、図４ではθc＜０、θd＜０）。他方の脚体２についても同様である。
【００８１】
そして、この足首部１２の身体座標系Ｃpにおける位置（x12，z12）と前記身体重心位置算出手段３１により求められた身体座標系Ｃpにおける身体重心G0の位置（xg，zg）のデータの今回値とから、身体重心Ｇ0に対する各脚体２の足首部１２の位置ベクトルT(x12−xg，z12−zg）、すなわち、前記式（５）におけるΔＸf，ΔＺf，ΔＸr，ΔＺrが求められる。
【００８２】
また、前記ＭＰ高さ算出手段３３の処理では、前記足平部加速度センサ２４の検出データを用い、図３を参照して先に説明したように、各脚体２の足平部１３の床面に対する傾斜角度θを算出して、この傾斜角度θからＭＰ高さＨを求める。尚、履き物等に加速度センサ２４に代えてジャイロセンサを装備し、このジャイロセンサの検出データから足平部１３の傾斜角度θを算出してＭＰ高さＨを求めるようにしても良く、更には、履き物等に光学式距離センサを装備して、ＭＰ高さＨを直接的に計測することも可能である。
【００８３】
次に、演算処理手段１６は、前記床反力推定手段３８の処理を次のように実行する。すなわち、この処理では、人間１の体重Ｍ及び重力加速度ｇの値（これらはあらかじめ演算処理装置１６に記憶されている）と、前記身体重心加速度算出手段３４により求められた絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ａx，ａz)の今回値とから、前記式（２）により、全床反力Ｆ＝T(Ｆx，Ｆz)の推定値が各サイクルタイム毎に逐次求められる。この場合、前記脚体運動判断手段２５により今回のサイクルタイムで判断された脚体２の運動状態が単脚支持状態であれば、上記全床反力Ｆ＝T(Ｆx，Ｆz)の推定値がそのまま接地している単一の脚体２に作用する床反力の推定値として求められることになる。尚、この場合、非接地側の脚体２（遊脚側の脚体２）に作用する床反力は、T(０，０)である。
【００８４】
また、脚体運動判断手段２５により今回のサイクルタイムで判断された脚体２の運動状態が両脚支持状態である場合には、先ず、人間１の進行方向に向かって後側に存する後側脚体２に作用する床反力Ｆrの鉛直方向成分Ｆrzと人間１の進行方向に向かって前側に存する前側脚体２のＭＰ高さＨとの間に成立する相関関係に基づいて、前記ＭＰ高さ算出手段３３により求めた前側脚体２のＭＰ高さＨのデータを用いて後側脚体２に作用する床反力Ｆrの鉛直方向成分Ｆrzの推定値が求められる。
【００８５】
ここで、上記相関関係について詳述する。本願発明者は、鋭意努力の結果、通常歩行時において前側脚体２の足平部１３の踵が着床してからつま先が着床するまでの各時点における前側脚体２のＭＰ高さをＨ（ｔ）、後側脚体２に作用する床反力の鉛直方向成分をＦrz（ｔ）とし、前側脚体２の踵着床時における前側脚体２のＭＰ高さをＨ０、後側脚体２に作用する床反力の鉛直方向成分をＦrz０とすると、Ｈ０に対するＨ（ｔ）の比（ＭＰ高さ比＝Ｈ（ｔ）／Ｈ０）とＦrz０に対するＦrz（ｔ）の比（反力比＝Ｆrz（ｔ）／Ｆrz０）との間には図６に示す相関関係が成立することを知見するに至った。
そこで、本実施形態では、図６の相関関係がデータテーブルや、これら相関関係を近似する多項式関数の形態で演算処理装置１６に予め記憶されている。そして、前記脚体運動判断手段２５で両脚支持状態が開始されたと判別された時点での前側脚体２のＭＰ高さと全床反力の鉛直方向成分とを上記Ｈ０と上記Ｆrz０とし、前記ＭＰ高さ算出手段３３により求めた前側脚体２のＭＰ高さのデータから図６の相関関係に基づいて後側脚体２に作用する床反力の鉛直方向成分Ｆrzの推定値が逐次求められる。すなわち、各時点でのＭＰ高さ比に対応する反力比にＦrz０を乗算することで各時点におけるＦrzの推定値が求められる。次に、このＦrzの推定値を各サイクルタイムで求めた全床反力の鉛直方向成分Ｆzの推定値から減算することにより、前側脚体２に作用する床反力の鉛直方向成分Ｆfz（＝Ｆz−Ｆrz）の推定値が逐次求められる。これにより両脚支持状態における両脚体２，２のそれぞれの床反力の鉛直方向成分Ｆrz，Ｆfzが逐次求められることとなる。
更に、前記足首位置算出手段３２で求めたΔＸf，ΔＺf，ΔＸr，ΔＺrを前記式（５）に代入して、前側脚体２に作用する床反力の進行方向成分Ｆfxの推定値と、後側脚体２に作用する床反力の進行方向成分Ｆrxの推定値とが求められる。
【００８６】
また、演算処理装置１６は、上述の処理と並行して、前記脚体各部加速度算出手段３５、脚体各部角加速度算出手段３６、床反力作用点推定手段３７の処理を実行する。
【００８７】
この場合、前記脚体各部加速度算出手段３５の処理では、前記身体重心加速度算出手段３４の処理と同様、まず、前記サイクルタイム毎に前記各部重心位置算出手段３０により求められる身体座標系Ｃpにおける各脚体２の剛体相当部である大腿部９及び下腿部１１の重心G1，G2の位置のそれぞれの時系列データを用いて、身体座標系Ｃpにおける大腿部９及び下腿部１１の重心G1，G2の位置のそれぞれの２階微分値、すなわち、身体座標系Ｃpにおける大腿部９及び下腿部１１の重心G1，G2のそれぞれの加速度（身体座標系Ｃpの原点Ｏに対する加速度）が求められる。そして、このそれぞれの加速度と、前記基準加速度計測手段２８による腰部３の絶対座標系Ｃfにおける加速度a0＝T(a0x，a0z）とのベクトル和を求めることにより、絶対座標系Ｃfにおける大腿部９及び下腿部１１のそれぞれの加速度（より詳しくは、該加速度の絶対座標系Ｃfにおける座標成分）が求められる。
【００８８】
また、前記脚体各部角加速度算出手段３６の処理では、前記サイクルタイム毎に前記脚体姿勢算出手段２９により求められる各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdの時系列データを用いて、該大腿部９及び下腿部１１のそれぞれ傾斜角度θc，θdの２階微分値、すなわち、大腿部９及び下腿部１１のそれぞれの角加速度が求められる。
【００８９】
また、床反力作用点推定手段３７の処理では、接地している脚体２について、例えば前記脚体姿勢算出手段２９により算出された大腿部９の傾斜角度θcの今回値から、図７及び図８に示すようにあらかじめ定められた相関データに基づいて該脚体２の足首部１２から、該脚体２の足平部１３の床反力作用点（足平部１３の接地箇所に作用する全床反力が集中するとみなせる点）へのベクトル（足首部１２に対する床反力作用点の位置ベクトル。以下、床反力作用点ベクトルという）を該床反力作用点の位置を表すデータとして求める。
【００９０】
すなわち、本願発明者等の知見によれば、接地している脚体２の大腿部９や下腿部１１の傾斜角度θc，θdは、床反力作用点と比較的顕著な相関性を有し、例えば大腿部９の傾斜角度θcに対して、前記床反力作用点ベクトル、詳しくは、人間１の進行方向（Ｘ軸方向）における該床反力作用点ベクトルの成分と、鉛直方向（Ｚ軸方向）における該床反力作用点ベクトルの成分は、それぞれ図７、図８に示すように変化する。ここで、大腿部９の負の傾斜角度θcは、脚体２が人間１の後側に延びているとき（例えば図２の人間１の前方に向かって右側の脚体２）の傾斜角度であり、正の傾斜角度θcは、脚体２が人間１の前側に存するとき（例えば図２の人間１の前方に向かって左側の脚体２）の傾斜角度である。
【００９１】
そこで、本実施形態では、図７及び図８の相関データがあらかじめデータテーブルや、それらの相関データをそれぞれ近似する多項式関数の形態で、演算処理装置１６にあらかじめ記憶保持されている。そして、前記床反力作用点推定手段３７の処理では、前記脚体姿勢算出手段２９により算出された大腿部９の傾斜角度θcの今回値から、上記の相関データに基づいて、前記床反力作用点ベクトル（詳しくは該床反力作用点ベクトルのＸ軸方向、Ｚ軸方向の成分）が求められる。
【００９２】
尚、床反力作用点の位置は、接地している脚体２の大腿部９と下腿部１１の相対角度（膝関節１０の屈曲角度）との相関性もあり、大腿部９の傾斜角度θcの代わりに、上記相対角度から、床反力作用点の位置を推定するようにしてもよく、あるいは、大腿部９の傾斜角度θc及び上記相対角度の両者を用いて、マップ等により床反力作用点の位置を推定するようにしてもよい。
【００９３】
次に、演算処理装置１６は、前記関節モーメント推定手段３９の処理を実行して、各脚体２の膝関節１０及び股関節８に作用するモーメントを求める。この処理は、前記床反力推定手段３８、脚体各部加速度算出手段３５、脚体各部角加速度算出手段３６、床反力作用点推定手段３７、及び脚体姿勢算出手段２９によりそれぞれ求められたデータの今回値を用いて、所謂逆動力学モデルに基づいて行われる。この逆動力学モデルは、人間１の各剛体相当部の並進運動に関する運動方程式と回転運動に関する運動方程式とを用いて、床反力作用点により近い関節から順番に該関節に作用するモーメントを求めるものであり、本実施形態では、各脚体２の膝関節１０、股関節８に作用するモーメントが順番に求められる。
【００９４】
さらに詳細には、図９を参照して、まず、各脚体２の下腿部１１に関し、下腿部１１の先端部の足首部１２に作用する力（関節反力）、下腿部１１の膝関節１０の部分に作用する力（関節反力）、及び下腿部１１の重心G2の並進加速度を、それぞれ絶対座標系Ｃfにおける成分表記によって、T(Ｆ1x，Ｆ1z)、T(Ｆ2x，Ｆ2z)、T(a2x，a2z)とし、該下腿部１１の重量をm2とする。このとき、下腿部１１の重心G2の並進運動に関する運動方程式は、次式（１０）となる。
【００９５】
T(m2・a2x，m2・a2z)＝T(Ｆ1x−Ｆ2x，Ｆ1z−Ｆ2z−m2・ｇ)
ゆえに、T(Ｆ2x，Ｆ2z)＝T(Ｆ1x−m2・a2x，Ｆ1z−m2・a2z−m2・ｇ)……（１０）
【００９６】
ここで、下腿部１１の重心G2の加速度T(a2x，a2z)は、前記脚体各部加速度算出手段３５により求められるものである。また、下腿部１１の先端部の足首部１２に作用する関節反力T(Ｆ1x，Ｆ1z)は、近似的には、該下腿部１１を有する脚体２について前記床反力推定手段３８により求められる床反力の推定値に等しい。より詳しくは、単脚支持状態において、該脚体２が接地しているときには、関節反力T(Ｆ1x，Ｆ1z)は、前記式（２）により求められる全床反力T(Fx，Fz）であり、該脚体２が遊脚側の脚体であるときには、T(Ｆ1x，Ｆ1z)＝T(０，０)である。また、両脚支持状態において、該脚体２が人間１の進行方向前方に向かって後側の脚体であるときには、関節反力T(Ｆ1x，Ｆ1z)は前記後側脚体の床反力T(Frx，Frz）であり、該脚体２が前側の脚体であるときには、前記前側脚体の床反力T(Ffx，Ffz）である。
【００９７】
従って、各脚体２の膝関節１０に作用する関節反力T(Ｆ2x，Ｆ2z)は、脚体各部加速度算出手段３５により求められた下腿部１１の重心G2の加速度T(a2x，a2z)のデータと、床反力推定手段３８により求められる床反力（＝T(Ｆ1x，Ｆ1z)）のデータと、下腿部１１のあらかじめ求められた重量m2のデータと、重力加速度ｇの値とから、上記式（１０）により求められる。
【００９８】
また、図９を参照して、下腿部１１の先端部の足首部１２に作用するモーメントをＭ1、下腿部１１の膝関節１０の部分に作用するモーメントをＭ2、下腿部１１の重心G2の回りの慣性モーメントをIG2、下腿部１１の重心G2の回りの角加速度をα2とする。また、前記図４に対応させて、下腿部１１の重心G2と膝関節１０の中心との間の距離をd2、下腿部１１の重心G2と足首部１２との間の距離をd2’（＝Dd−d2）とすると、下腿部１１の重心G2の回りの回転運動に関する運動方程式は、次式（１１）となる。
【００９９】
IG2・α2＝M1−M2＋F1x・d2’・cosθd−F1z・d2’・sinθd
＋F2x・d2・cosθd−F2z・d2・sinθd
ゆえに
M2＝M1−IG2・α2＋F1x・d2’・cosθd−F1z・d2’・sinθd
＋F2x・d2・cosθd−F2z・d2・sinθd……（１１）
【０１００】
ここで、式（１１）中のM1は、同式（１１）に係わる下腿部１１を有する脚体２について前記床反力作用点推定手段３７により求められる床反力作用点ベクトルと、該脚体２について前記床反力推定手段３８により求められる床反力ベクトルとの外積（ベクトル積）として得られるモーメントである。また、α2は、前記脚体各部角加速度算出手段３４により求められる下腿部１１の角加速度である。また、θdは前記脚体姿勢算出手段２９により求められる下腿部１１の傾斜角度である。また、T(Ｆ1x，Ｆ1z)は、前述の通り、床反力推定手段３８により求められる床反力の推定値である。さらに、T(F2x，F2z)は、前記式（１０）により求められるものである。また、慣性モーメントIG2は下腿部１１の重量m2やサイズのデータ等と共に、あらかじめ求められて演算処理装置１６に記憶されるものである。
【０１０１】
従って、膝関節１０に作用するモーメントM2は、床反力推定手段３８による床反力の推定値のデータと、床反力作用点推定手段３７による床反力作用点ベクトルのデータと、脚体各部角加速度算出手段３６による下腿部１１の角加速度α2のデータと、脚体姿勢算出手段２９による下腿部１１の傾斜角度θdのデータと、前記式（１０）により求められた関節反力T(F2x，F2z)のデータと、あらかじめ求めた下腿部１１の慣性モーメントIG2、サイズ（Dd）、重心G2の位置(d2)のデータとから前記式（１１）により求められる。
【０１０２】
関節モーメント推定手段３９は、上記のようにして下腿部１１の膝関節１０の部分に作用するモーメントM2を求めた後、その算出処理と同様の処理によって、大腿部９の股関節８の部分に作用するモーメントを求める。この処理の基本的な考え方は、膝関節１０のモーメントM2を求める手法と同一であるので、詳細な図示及び説明は省略するが、その概要は次の通りである。
【０１０３】
すなわち、まず、大腿部９の重心G1（図５参照）の並進運動に関する運動方程式に基づく次式（１２）（前記式（１０）と同じ形の式）により、大腿部９の股関節８の部分に作用する関節反力T(F3x，F3z)が求められる。
【０１０４】
T(Ｆ3x，Ｆ3z)＝T(Ｆ2x−m1・a1x，Ｆ2z−m1・a1z−m1・ｇ)……（１２）
【０１０５】
ここで、T(Ｆ2x，Ｆ2z)は、先に前記式（１０）により求めた膝関節１０の関節反力である。また、T(a1x，a1z)は、前記脚体各部加速度算出手段３５により求められる大腿部９の重心G1の絶対座標系Ｃfにおける加速度（並進加速度）である。また、m1はあらかじめ求めた大腿部９の重量、ｇは重力加速度である。
【０１０６】
次いで、大腿部９の重心G1の回りの回転運動に関する運動方程式に基づく次式（１３）（前記式（１１）と同じ形の式）により、大腿部９の股関節８の部分に作用するモーメントM3が求められる。
【０１０７】
M3＝M2−IG1・α1＋F2x・d1’・cosθc−F2z・d1’・sinθc
＋F3x・d1・cosθc−F3z・d1・sinθc……（１３）
【０１０８】
ここで、M2は、前記式（１１）により求められた膝関節１０のモーメント、T(Ｆ2x，Ｆ2z)は、前記式（１０）により求められた膝関節１０の関節反力、T(Ｆ3x，Ｆ3z)は、前記式（１２）により求められた股関節８の関節反力、IG1は、あらかじめ求めた大腿部９の重心G1の回りの慣性モーメント、α1は前記脚体各部角加速度算出手段３６により求められる大腿部９の角加速度、θcは前記脚体姿勢算出手段２９により求められる大腿部９の傾斜角度である。また、d1は、股関節８の中心から大腿部９の重心G1までの距離（図５参照）、d1’は、膝関節１０の中心から大腿部９の重心G1までの距離（図５ではDc−d1）であり、これらは、あらかじめ求めた重心G1の位置や大腿部９のサイズ（長さ）から定まるものである。
【０１０９】
以上説明した処理が、前記演算処理装置１６のサイクルタイム毎に逐次実行され、各脚体２に作用する床反力や、各脚体２の膝関節１０及び股関節８に作用するモーメントが逐次リアルタイムで推定される。
【０１１０】
尚、本明細書での詳細な説明は省略するが、求められた膝関節１０や股関節８のモーメントの推定値は、例えば人間１の歩行を補助する装置（膝関節１０や股関節８に補助トルクを付与可能な電動モータ等を含む装置）の制御に用いられる。
【０１１１】
前述した演算処理装置１６の処理により求められた床反力の推定値（詳しくは、該床反力の推定値の絶対値）の経時変化の様子を図１０に実線で例示する。また、演算処理装置１６の処理により求められた膝関節１０及び股関節８のモーメントの推定値の経時変化の様子を図１１に実線で例示する。ここで、図１０及び図１１は、人間１が平地をほぼ一定速度で歩行した場合の例示である。この場合、図１０では、フォースメータ等を用いて床反力を実測した比較例（床反力の真値に相当するもの）が仮想線で併記されている。また、図１１ではトルクメータ等を用いて膝関節１０及び股関節８のモーメントを実測した比較例（膝関節１０及び股関節８のモーメントの真値に相当するもの）が仮想線で併記されている。
【０１１２】
図１０を参照して明らかなように、本実施形態によれば精度のよい床反力の推定値が得られていることが判る。また、本実施形態ではこの床反力の推定値を用いることによって、図１１に示されるように、膝関節１０や股関節８のモーメントも比較的精度よく推定することができる。
【０１１３】
以上のように、本実施形態によれば、脚体２に人間１の歩行の邪魔となったり、脚体２の運動に負担がかかるようなセンサを装着したりすることなく、股関節８や股関節８に装着した角度センサ２２，２３や、胴体５に装備したジャイロセンサ１４，１９及び加速度センサ１５，２０，２１や、履き物等に装備する加速度センサ２４というような比較的小型で軽量なセンサを用いて各脚体２に作用する床反力や、各脚体２の股関節８及び膝関節１０に作用するモーメントをリアルタイムで容易に推定することができる。
【０１１４】
また、前記実施形態では、本発明を人間１に適用した場合を例にとって説明したが、二足歩行移動体としての二足歩行ロボットにも本発明を適用することができる。ここで、二足歩行ロボットでは、腰部と胸部とが一体的な構造となっている場合があるが、この場合には、ジャイロセンサや前後方向の加速度センサを腰部及び胸部のいずれか一方だけに取り付けて、床反力や脚体の関節のモーメントを本実施形態と同様に推定するようにすることも可能である。また、二足歩行ロボットでは、股関節や膝関節の屈曲角度は、それらの関節のアクチュエータに対する制御装置の制御量により把握するようにすることも可能である。
【０１１５】
また、前記実施形態では、脚体２の運動状態を判断するために、腰部上下加速度センサ２１の検出データをそのまま用いたが、該検出データの代わりに、例えば前記基準加速度計測手段２８により求められる絶対座標系Ｃfでの腰部３の加速度ａ0の鉛直方向（Ｚ軸方向）の成分の値を用いるようにしても良い。
【０１１６】
ところで、前記実施形態では、両脚支持状態における前側と後側の各脚体２に作用する床反力の進行方向成分Ｆfx，Ｆrxの推定値を上記先願と同様の手法で求めるようにしたが、後側脚体に作用する床反力の進行方向成分の、両脚支持状態の経過時間及び二足歩行移動体の移動速度に対する変化の特性を表すものとしてあらかじめ定めた特性データに基づき、後側脚体に作用する床反力の進行方向成分Ｆrxの推定値を逐次求めると共に、このＦrxを全床反力の進行方向成分Ｆxの推定値から差し引くことにより、前側脚体に作用する床反力の進行方向成分Ｆfxの推定値を逐次求めることも可能である。
【０１１７】
以下、このような手法で各脚体２に作用する床反力の進行方向成分Ｆfx，Ｆrxの推定値を求める第２の実施形態について説明する。第２実施形態では、演算処理装置１６に、図１２に示す如く、前記第１実施形態の足首位置算出手段３２に代えて、脚体運動判断手段２５により両脚支持状態の開始（単脚支持状態の終了）が把握される毎に、その両脚支持状態の開始時からの経過時間を計時する計時手段４２と、脚体運動判断手段２５により両脚支持状態の開始（単脚支持状態の終了）が把握される毎に、前記脚体姿勢算出手段２９による各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θc，θdのデータと前記計時手段４２の計時データとを用いて人間１の移動速度を推定する移動速度推定手段４３と、この移動速度推定手段４３により求められた移動速度のデータから両脚支持状態の開始時から終了時までの時間（両脚支持状態の継続時間。以下、両脚支持期間という）を推定する両脚支持期間推定手段４４とを設ける。
【０１１８】
そして、脚体運動判断手段２５の処理では、第１実施形態のものと同様に腰部上下加速度センサ２１による腰部３の上向き方向の加速度の検出データに基づいて両脚支持状態の開始が把握されると、該両脚支持状態の開始時点から前記計時手段４２により計測される経過時間が、該両脚支持状態の開始時点で前記両脚支持期間推定手段４４により後述するように求められる両脚支持期間（両脚支持状態の開始時から終了時までの該両脚支持状態の継続時間）の推定値に達したか否かがサイクルタイム毎に逐次監視される。そして、脚体運動判断手段２５は、該経過時間が両脚支持期間の推定値に達した時に、両脚支持状態が終了し、且つ、単脚支持状態が開始すると判断する。
【０１１９】
このように脚体運動判断手段２５の処理が実行され、また、脚体姿勢算出手段２９による処理が第１実施形態のものと同様に実行された後、演算処理装置１６は、前記移動速度推定手段４３の処理及び両脚支持期間推定手段４４の処理を順次実行する。
【０１２０】
移動速度推定手段４３による処理は次のように行われる。すなわち、図１３を参照して、人間１の歩行時に、時刻t1において実線で示す人間１の前側の脚体２（図では人間１の前方に向かって右側の脚体２）が着床して両脚支持状態が開始し、時刻t2において仮想線示の人間１で表すように、次の両脚支持状態が開始した場合（時刻t1で人間１の後側の脚体２が離床後に時刻t2で着床した場合）を想定する。このとき、時刻t1から時刻t2までの人間１の移動距離Ｌは、絶対座標系ＣfのＸ軸方向（人間１の進行方向）における腰部３の股関節８の中心の移動距離（これは、本実施形態では、身体座標系Ｃpの原点ＯのＸ軸方向の移動量に等しい）である。
【０１２１】
そして、この移動距離Ｌは、時刻t1における股関節８の中心から人間１の前側の脚体２の足首部１２までのＸ軸方向の距離ΔL1と、時刻t2における股関節８の中心から人間１の後側の脚体２（これは時刻t1で人間１の前側にあった脚体２である）の足首部１２までのＸ軸方向の距離ΔL2との総和にほぼ一致する。
【０１２２】
従って、上記距離ΔL1，ΔL2と、時刻t1から時刻t2までの経過時間（t2−t1）、すなわち、両脚支持状態が開始してから次に両脚支持状態が開始するまでの１歩分の経過時間を把握することによって、それらの距離ΔL1，ΔL2と、該１歩分経過時間（t2−t1）とを用いて次式（１４）により時刻t1からt2までの人間１の移動速度Ｖ（時刻t1から時刻t2までの平均移動速度）を求めることができる。
【０１２３】
Ｖ＝Ｌ／（t2−t1）＝（ΔL1＋ΔL2）／（t2−t1） ……（１４）
【０１２４】
そこで、前記移動速度推定手段４３の処理では、前記脚体運動判断手段２５により両脚支持状態が開始したことが把握される毎に、人間１の前側の脚体２に係わる上記距離ΔL1と、後側の脚体２に係わる上記距離ΔL2とが以下に説明するように求められ、それらの距離ΔL1，ΔL2の算出値が記憶保持される。そして、今回の両脚支持状態の開始時に求められた後側の脚体２に係わる距離ΔL2と、前回の両脚支持状態の開始時に求められた前側の脚体２に係わる距離ΔL1と、前回の両脚支持状態の開始時から今回の両脚支持状態の開始時までに前記計時手段４２により計測された時間（＝t2−t1）とから前記式（１４）により人間１の移動速度Ｖを求める。
【０１２５】
この場合、上記距離ΔL1，ΔL2は次にように求められる。すなわち、両脚支持状態の開始時における人間１の前側の脚体２については、該両脚支持状態の開始時（脚体運動判断手段２５により両脚支持状態の開始が把握されたサイクルタイム）に前記脚体姿勢算出手段２９により求められる大腿部９及び下腿部１１のそれぞれの傾斜角度をθc1、θd1（図１３の時刻t1の図を参照）とする。このとき、該脚体２に係わる距離ΔL1は、これらの傾斜角度θc1，θd1（θc1＞０，θd1＞０）のデータと、大腿部９及び下腿部１１のそれぞれの長さDc，Ddのデータとを用いて、次式（１５）により算出される。
【０１２６】
ΔL1＝Dc・sinθc1＋Dd・sinθd1 ……（１５）
【０１２７】
同様に、両脚支持状態の開始時における人間１の後側の脚体２については、該両脚支持状態の開始時に前記脚体姿勢算出手段２９により求められる大腿部９及び下腿部１１のそれぞれの傾斜角度をθc2、θd2（図１３の時刻t2の図を参照）とすると、該脚体２に係わる距離ΔL2は、これらの傾斜角度θc2，θd2（θc2＜０，θd2＜０）のデータと、大腿部９及び下腿部１１のそれぞれの長さDc，Ddのデータとを用いて、次式（１６）により算出される。
【０１２８】
ΔL2＝−Dc・sinθc2−Dd・sinθd2 ……（１６）
【０１２９】
以上説明した移動速度推定手段４３の処理によって、両脚支持状態が開始する毎に、人間１の移動速度Ｖ（詳しくは、両脚支持状態が開始する直前の１歩における移動速度）が推定される。尚、両脚支持状態が開始してから次に両脚支持状態が開始するまでの期間における各サイクルタイムでは、移動速度Ｖの推定値は一定に維持される。
【０１３０】
また、両脚支持期間推定手段４４の処理は次のように行われる。本願発明者等の知見によれば、人間１の歩行時の両脚支持状態の継続期間である両脚支持期間は、人間１の移動速度Ｖと密接な相関性を有する。すなわち、人間１の歩行時の両脚支持期間は、移動速度Ｖに対して図１４に示すように変化し、該移動速度Ｖが速くなる程、短くなる。
【０１３１】
そこで、第２実施形態では、図１４の相関データがあらかじめデータテーブルや、それを近似する多項式関数の形態で、演算処理装置１６にあらかじめ記憶保持されている。そして、前記両脚支持期間推定手段４４の処理では、両脚支持状態の開始時に、移動速度推定手段３６により前述のように求められた移動速度Ｖの最新値から、図１４の相関データに基づいて該両脚支持状態に係わる両脚支持期間の推定値を求める。尚、該両脚支持期間の推定値は、次回の両脚支持状態が開始するまで維持される。
【０１３２】
床反力推定手段３８の処理では、第１実施形態と同様に身体重心加速度算出手段３４により求められた身体重心G0の加速度T(ａx，ａz)のデータと、人間１の重量Ｍのデータとから、前記式（２）により、全床反力Ｆ＝T(Ｆx，Ｆz)の推定値が前記サイクルイタイム毎に逐次求められる。この場合、脚体運動判断手段２５により把握されている脚体２の運動状態が単脚支持状態である場合には、上記全床反力Ｆ＝T(Ｆx，Ｆz)の推定値がそのまま接地している単一の脚体２に作用する床反力の推定値として求められることとなる。
【０１３３】
一方、脚体運動判断手段２５により把握されている脚体２の運動状態が両脚支持状態である場合には、床反力推定手段３８は、図６の相関関係に基づき、第１実施形態と同様に後側脚体２に作用する床反力の鉛直方向成分Ｆrzの推定値を前側脚体２のＭＰ高さＨを用いて求め、このＦrzを全床反力の鉛直方向成分Ｆzから差し引いて、前側脚体２に作用する床反力の鉛直方向成分Ｆfzの推定値を求める。
【０１３４】
また、前側と後側の各脚体２に作用する床反力の進行方向成分Ｆfx，Ｆrxの推定値は以下の如く求められる。すなわち、本願発明者等の知見によれば、両脚支持状態で後側脚体２に作用する床反力の進行方向成分Ｆrxの、該両脚支持状態の開始時における全床反力の進行方向成分Ｆxに対する割合（以下、床反力比という）と、該両脚支持状態の開始時からの経過時間の前記両脚支持期間に対する割合（＝経過時間／両脚支持期間。以下、両脚支持時間比とい）との関係に着目したとき、それらの間には特徴的な相関性があり、この相関性は、人間１の移動速度Ｖ等の影響をほとんど受けない。
【０１３５】
具体的には、後側脚体２に作用する床反力の進行方向成分成分Ｆrxの、両脚支持状態の開始時における全床反力の進行方向成分Ｆx（以下、参照符号Ｆxsにより表す）に対する割合である床反力比Ｆrx／Ｆxsは、人間１の移動速度Ｖ等によらずに、前記両脚支持時間比に対して図１５に示すようなほぼ一定の相関関係を有し、両脚支持状態の時間の経過に伴い、一旦、「１」から増加した後、「０」まで減少していく。
【０１３６】
そこで、第２実施形態では、図１５の相関データ（特性データ）があらかじめデータテーブルや、それらの相関データをそれぞれ近似する多項式関数の形態で、演算処理装置１６にあらかじめ記憶保持されている。そして、計時手段４２による経過時間の計時データの今回値と、両脚支持期間推定手段４４により求められた両脚支持期間の推定値のデータの最新値とから前記両脚支持時間比が前記サイクルタイム毎に逐次求められる。そして、この求めた両脚支持時間比のデータから図１５の相関データに基づいて、床反力比Ｆrx／Ｆxsが逐次求められ、この床反力比Ｆrx／Ｆxsに両脚支持状態の開始時の全床反力の進行方向成分Ｆxsを乗算することにより、後側脚体２に作用する床反力の進行方向成分Ｆrxの推定値が求められ、このＦrxを全床反力の進行方向成分Ｆxから差し引くことにより前側脚体２に作用する床反力の進行方向成分Ｆfxの推定値が求められる。
【０１３７】
このようにして各脚体２に作用する床反力Ｆr＝T(Ｆrx，Ｆrz)，Ｆf＝T(Ｆfx，Ｆfz)を求めた後、関節モーメント推定手段３９での処理により、第１実施形態と同様に各脚体２の膝関節１０及び股関節８に作用するモーメントが逐次リアルタイムで推定される。
【０１３８】
尚、履き物等に検出方向をＸ軸方向とした一軸型の力センサを装備して、両脚支持状態における前側と後側の各脚体２に作用する床反力の進行方向成分Ｆfx，Ｆrxを力センサにより計測することも可能である。
【図面の簡単な説明】
【図１】先願の床反力推定方法の基本的原理を説明するための図。
【図２】本発明の一実施形態における二足歩行移動体としての人間と該人間に装備する装置構成を模式化して示す図。
【図３】足平部の特定部位の床面からの位置（ＭＰ高さ）の計測原理を説明するための図。
【図４】図２の装置に備える演算処理装置の機能を説明するためのブロック図。
【図５】図３の演算処理装置の処理に用いる剛体リンクモデルを示す図。
【図６】前側脚体のＭＰ高さと後側脚体に作用する床反力の鉛直方向成分との相関関係を示す線図。
【図７】大腿部の傾斜角度と床反力作用点ベクトルの進行方向成分との相関関係を示す線図。
【図８】大腿部の傾斜角度と床反力作用点ベクトルの鉛直方向成分との相関関係を示す線図。
【図９】関節モーメントの計測原理を説明するための図。
【図１０】本発明の実施形態により求められた床反力の推定値の経時変化の様子を例示するグラフ。
【図１１】本発明の実施形態により求められた膝関節及び股関節のモーメントの推定値の経時変化の様子を例示するグラフ。
【図１２】本発明の第２の実施形態における演算処理装置の機能を説明するためのブロック図。
【図１３】移動速度の推定原理を説明するための図。
【図１４】移動速度と両脚支持期間との相関関係をしめす線図。
【図１５】両脚支持時間比と後側脚体に作用する床反力の進行方向成分との相関関係を示す線図。
【符号の説明】
１…人間（二足歩行移動体）、２…脚体、１３…足平部、１３ｂ…中足趾節関節（特定部位）。
Claims (2)
- 二足歩行移動体の運動状態が該二足歩行移動体の両脚体が接地している両脚支持状態であるときの各脚体に作用する床反力の鉛直方向成分を推定する方法であって、
前記二足歩行移動体の重心の位置を逐次求めつつ、該重心の位置の時系列データを用いて床に対して固定された絶対座標系での該重心の加速度を逐次求める第１ステップと、前記二足歩行移動体の重量と重力加速度と前記重心の加速度と各脚体に作用する床反力の合力である全床反力とにより表される該重心の運動方程式に基づき、該全床反力の推定値を逐次求める第２ステップと、前記両脚支持状態において両脚体のうち少なくとも前記二足歩行移動体の進行方向に向かって前側に存する前側脚体の足平部のあらかじめ定めた特定部位の床面からの位置を逐次求める第３ステップとを備え、
前記両脚支持状態であるときには、両脚体のうち該二足歩行移動体の進行方向に向かって後側に存する後側脚体に作用する床反力の鉛直方向成分と、前側脚体の足平部の前記特定部位の床面からの位置との間に成立する所定の相関関係に基づき、前記第３ステップで求めた前側脚体の足平部の前記特定部位の床面からの位置を用いて後側脚体に作用する床反力の鉛直方向成分の推定値を逐次求め、その求めた後側脚体の床反力の鉛直方向成分の推定値を前記第２ステップで求めた全床反力の鉛直方向成分の推定値から差し引くことにより、前側脚体に作用する床反力の鉛直方向成分の推定値を逐次求めることを特徴とする二足歩行移動体の床反力推定方法。 - 前記足平部の特定部位は、中足趾節関節であることを特徴とする請求項１記載の二足歩行移動体の床反力推定方法。
Priority Applications (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002018789A JP4130739B2 (ja) | 2002-01-28 | 2002-01-28 | 二足歩行移動体の床反力推定方法 |
| DE60327307T DE60327307D1 (de) | 2002-01-28 | 2003-01-22 | Verfahren zur abschätzung von bodenreaktion von zweibeinigen beweglichen körpern |
| US10/502,727 US7017395B2 (en) | 2002-01-28 | 2003-01-22 | Method of estimating floor reaction of bipedal movable body |
| PCT/JP2003/000533 WO2003064117A1 (fr) | 2002-01-28 | 2003-01-22 | Procede permettant d'estimer la reaction au sol d'un corps bipede en mouvement |
| EP03703015A EP1481771B1 (en) | 2002-01-28 | 2003-01-22 | Method of estimating floor reaction of bipedal movable body |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002018789A JP4130739B2 (ja) | 2002-01-28 | 2002-01-28 | 二足歩行移動体の床反力推定方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2003220583A JP2003220583A (ja) | 2003-08-05 |
| JP4130739B2 true JP4130739B2 (ja) | 2008-08-06 |
Family
ID=27653998
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002018789A Expired - Fee Related JP4130739B2 (ja) | 2002-01-28 | 2002-01-28 | 二足歩行移動体の床反力推定方法 |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US7017395B2 (ja) |
| EP (1) | EP1481771B1 (ja) |
| JP (1) | JP4130739B2 (ja) |
| DE (1) | DE60327307D1 (ja) |
| WO (1) | WO2003064117A1 (ja) |
Families Citing this family (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4130739B2 (ja) * | 2002-01-28 | 2008-08-06 | 本田技研工業株式会社 | 二足歩行移動体の床反力推定方法 |
| JP4168943B2 (ja) * | 2004-01-28 | 2008-10-22 | トヨタ自動車株式会社 | 脚式ロボットと脚式ロボットの歩行制御方法 |
| US20110082566A1 (en) * | 2008-09-04 | 2011-04-07 | Herr Hugh M | Implementing a stand-up sequence using a lower-extremity prosthesis or orthosis |
| BRPI1007685A2 (pt) * | 2009-05-20 | 2017-01-17 | Koninkl Philips Electronics Nv | dispositivo de detecção para detectar uma posição de uso, método de detecção de uma posição de uso de um dispositivo de detecção e produto de programa de computador |
| KR101283464B1 (ko) * | 2009-09-29 | 2013-07-12 | 한국전자통신연구원 | 동작 인식용 신발을 이용한 동작 인식 시스템 |
| JP6414664B2 (ja) * | 2014-06-13 | 2018-10-31 | 国立大学法人 筑波大学 | 義肢装着式動作補助装置 |
| JP6228097B2 (ja) * | 2014-10-06 | 2017-11-08 | 本田技研工業株式会社 | 移動ロボット |
| WO2017199589A1 (ja) * | 2016-05-18 | 2017-11-23 | 株式会社 東芝 | 行動推定方法、行動推定システム、サービス提供方法、信号検出方法、信号検出部および信号処理システム |
| CN114401887A (zh) | 2019-08-06 | 2022-04-26 | 波士顿动力公司 | 脚步接触检测 |
| CN111374676B (zh) * | 2020-03-09 | 2022-10-11 | 南方科技大学 | 人体地面反力间接测量系统、测量方法、装置及控制器 |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6289265B1 (en) * | 1998-04-20 | 2001-09-11 | Honda Giken Kogyo Kabushiki Kaisha | Controller for legged mobile robot |
| JP3497402B2 (ja) | 1999-02-25 | 2004-02-16 | 日本電信電話株式会社 | 運動状態生成装置及び運動状態生成プログラムを記録した記録媒体 |
| JP3528171B2 (ja) * | 1999-11-12 | 2004-05-17 | ソニー株式会社 | 移動ロボット装置及び移動ロボット装置の転倒制御方法 |
| JP2001347476A (ja) | 2000-06-05 | 2001-12-18 | Sony Corp | 脚式移動ロボット |
| JP4188607B2 (ja) | 2001-06-27 | 2008-11-26 | 本田技研工業株式会社 | 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 |
| JP4184679B2 (ja) * | 2001-08-01 | 2008-11-19 | 本田技研工業株式会社 | 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 |
| EP1473122B1 (en) * | 2001-12-28 | 2010-10-13 | Honda Giken Kogyo Kabushiki Kaisha | Gait generation device for legged mobile robot |
| JP4130739B2 (ja) * | 2002-01-28 | 2008-08-06 | 本田技研工業株式会社 | 二足歩行移動体の床反力推定方法 |
-
2002
- 2002-01-28 JP JP2002018789A patent/JP4130739B2/ja not_active Expired - Fee Related
-
2003
- 2003-01-22 DE DE60327307T patent/DE60327307D1/de not_active Expired - Lifetime
- 2003-01-22 WO PCT/JP2003/000533 patent/WO2003064117A1/ja active Application Filing
- 2003-01-22 US US10/502,727 patent/US7017395B2/en not_active Expired - Fee Related
- 2003-01-22 EP EP03703015A patent/EP1481771B1/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| WO2003064117A1 (fr) | 2003-08-07 |
| EP1481771A1 (en) | 2004-12-01 |
| JP2003220583A (ja) | 2003-08-05 |
| US20050080590A1 (en) | 2005-04-14 |
| US7017395B2 (en) | 2006-03-28 |
| DE60327307D1 (de) | 2009-06-04 |
| EP1481771B1 (en) | 2009-04-22 |
| EP1481771A4 (en) | 2006-08-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4188607B2 (ja) | 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 | |
| JP4184679B2 (ja) | 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 | |
| JP4282419B2 (ja) | 脚体の関節部分に与えるトルクを求める方法および演算処理装置 | |
| JP4312558B2 (ja) | 脚体の関節部分に与えるトルクを求める方法および演算処理装置 | |
| EP1627712B1 (en) | Method of assuming acting point of floor reaction force to biped walking mobile body and method of assuming joint moment of biped walking mobile body | |
| JP4440759B2 (ja) | ２足歩行移動体の床反力推定方法 | |
| JP4246535B2 (ja) | 二足歩行移動体の床反力作用点推定方法及び二足歩行移動体の関節モーメント推定方法 | |
| JP4130739B2 (ja) | 二足歩行移動体の床反力推定方法 | |
| JP3844695B2 (ja) | 二足歩行移動体の床反力作用点推定方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20041129 |
|
| 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: 20080520 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20080523 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110530 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110530 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120530 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130530 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130530 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140530 Year of fee payment: 6 |
|
| LAPS | Cancellation because of no payment of annual fees |