JP2003220583A - 二足歩行移動体の床反力推定方法 - Google Patents
二足歩行移動体の床反力推定方法Info
- Publication number
- JP2003220583A JP2003220583A JP2002018789A JP2002018789A JP2003220583A JP 2003220583 A JP2003220583 A JP 2003220583A JP 2002018789 A JP2002018789 A JP 2002018789A JP 2002018789 A JP2002018789 A JP 2002018789A JP 2003220583 A JP2003220583 A JP 2003220583A
- 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.)
- Granted
Links
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
Abstract
(57)【要約】 （修正有）
【課題】人間等の二足歩行移動体の運動状態が該二足歩
行移動体の両脚体が接地している両脚支持状態であると
きの各脚体に作用する床反力の鉛直方向成分をリアルタ
イムで精度良く把握できるようにする。 【解決手段】脚体の運動状態が単脚支持状態であるか両
脚支持状態であるかを逐次判断すると共に二足歩行移動
体の重心の運動方程式に基づいて全床反力を推定する。
単脚支持状態であるときは、全床反力の推定値をそのま
ま接地している脚体の床反力の推定値とする。足平部の
中足趾節関節の床面からの位置（ＭＰ高さ）を計測し、
両脚支持状態に移行したときは、前側脚体のＭＰ高さと
後側脚体の床反力の鉛直方向成分との間に成立する所定
の相関関係に基づき、前側脚体のＭＰ高さから後側脚体
の床反力の鉛直方向成分を推定する。全床反力の鉛直方
向成分から後側脚体の床反力の鉛直方向成分を差し引く
ことにより前側脚体の床反力の鉛直方向成分を推定す
る。
行移動体の両脚体が接地している両脚支持状態であると
きの各脚体に作用する床反力の鉛直方向成分をリアルタ
イムで精度良く把握できるようにする。 【解決手段】脚体の運動状態が単脚支持状態であるか両
脚支持状態であるかを逐次判断すると共に二足歩行移動
体の重心の運動方程式に基づいて全床反力を推定する。
単脚支持状態であるときは、全床反力の推定値をそのま
ま接地している脚体の床反力の推定値とする。足平部の
中足趾節関節の床面からの位置（ＭＰ高さ）を計測し、
両脚支持状態に移行したときは、前側脚体のＭＰ高さと
後側脚体の床反力の鉛直方向成分との間に成立する所定
の相関関係に基づき、前側脚体のＭＰ高さから後側脚体
の床反力の鉛直方向成分を推定する。全床反力の鉛直方
向成分から後側脚体の床反力の鉛直方向成分を差し引く
ことにより前側脚体の床反力の鉛直方向成分を推定す
る。
Description
【０００１】
【発明の属する技術分野】本発明は、人間や二足歩行ロ
ボット等の二足歩行移動体の脚体に作用する床反力、特
に、二足歩行移動体の運動状態が該二足歩行移動体の両
脚体が接地している両脚支持状態であるときの各脚体に
作用する床反力の鉛直方向成分を推定する方法に関す
る。
ボット等の二足歩行移動体の脚体に作用する床反力、特
に、二足歩行移動体の運動状態が該二足歩行移動体の両
脚体が接地している両脚支持状態であるときの各脚体に
作用する床反力の鉛直方向成分を推定する方法に関す
る。
【０００２】
【従来の技術】例えば人間の歩行動作を補助する歩行ア
シスト装置の動作制御や、二足歩行ロボットの移動動作
の制御を行なう場合、人間や二足歩行ロボットの脚体に
作用する床反力（詳しくは、脚体の接地部に床から作用
する力）を逐次把握することが必要となる。この床反力
を把握することで、二足歩行移動体の脚体の関節に作用
するモーメント等を把握することが可能となり、その把
握されたモーメント等に基づいて歩行アシスト装置の目
標補助力や、二足歩行ロボット各関節の目標駆動トルク
等を決定することが可能となる。
シスト装置の動作制御や、二足歩行ロボットの移動動作
の制御を行なう場合、人間や二足歩行ロボットの脚体に
作用する床反力（詳しくは、脚体の接地部に床から作用
する力）を逐次把握することが必要となる。この床反力
を把握することで、二足歩行移動体の脚体の関節に作用
するモーメント等を把握することが可能となり、その把
握されたモーメント等に基づいて歩行アシスト装置の目
標補助力や、二足歩行ロボット各関節の目標駆動トルク
等を決定することが可能となる。
【０００３】前記床反力を把握する手法としては、例え
ば特開2000-249570号公報に開示されているものが知ら
れている。この技術では、二足歩行移動体の定常的な歩
行時に各脚体の床反力の経時変化の波形が周期的に変化
することから、各脚体の床反力を、歩行周期の１／ｎ
（ｎ＝１，２，…）の互いに異なる周期を有する複数の
三角関数の合成値（一次結合）として把握するものであ
る。この場合、複数の三角関数を合成する際の各三角関
数の重み係数は、二足歩行移動体毎にあらかじめ定めた
所定値やそれを地形に応じて調整した値が用いられてい
る。
ば特開2000-249570号公報に開示されているものが知ら
れている。この技術では、二足歩行移動体の定常的な歩
行時に各脚体の床反力の経時変化の波形が周期的に変化
することから、各脚体の床反力を、歩行周期の１／ｎ
（ｎ＝１，２，…）の互いに異なる周期を有する複数の
三角関数の合成値（一次結合）として把握するものであ
る。この場合、複数の三角関数を合成する際の各三角関
数の重み係数は、二足歩行移動体毎にあらかじめ定めた
所定値やそれを地形に応じて調整した値が用いられてい
る。
【０００４】しかしながら、かかる技術では、二足歩行
移動体の一歩分もしくは複数歩分について脚体の床反力
を把握しようとするものであるため、二足歩行移動体の
歩容が逐次変化するような場合には、床反力を精度よく
把握することは困難である。また、把握される床反力の
精度を高めるためには、前記三角関数の重み係数を二足
歩行移動体毎に設定したり、地形等に応じて調整したり
しなければならないので、二足歩行移動体の移動環境や
二足歩行移動体の個体差の影響を少なくして、床反力を
精度よく把握するようにすることが困難である。
移動体の一歩分もしくは複数歩分について脚体の床反力
を把握しようとするものであるため、二足歩行移動体の
歩容が逐次変化するような場合には、床反力を精度よく
把握することは困難である。また、把握される床反力の
精度を高めるためには、前記三角関数の重み係数を二足
歩行移動体毎に設定したり、地形等に応じて調整したり
しなければならないので、二足歩行移動体の移動環境や
二足歩行移動体の個体差の影響を少なくして、床反力を
精度よく把握するようにすることが困難である。
【０００５】また、例えば二足歩行ロボットにおいて
は、各脚体の足首部や足平部に６軸力センサ等の力セン
サを取り付け、この力センサの出力により床反力を把握
するものも知られている。さらに、床に設置したフォー
スプレート上で二足歩行移動体を歩行させ、該フォース
プレートの出力により床反力を把握する手法も知られて
いる。
は、各脚体の足首部や足平部に６軸力センサ等の力セン
サを取り付け、この力センサの出力により床反力を把握
するものも知られている。さらに、床に設置したフォー
スプレート上で二足歩行移動体を歩行させ、該フォース
プレートの出力により床反力を把握する手法も知られて
いる。
【０００６】しかしながら、力センサを用いる技術で
は、特に人間の脚体の床反力を把握しようとする場合に
は、人間の足首部や足平部に力センサを取り付けなけれ
ばならないため、通常的な生活環境下では、該力センサ
が歩行の邪魔になってしまうという不都合がある。ま
た、フォースプレートを用いるものでは、該フォースプ
レートが設置された環境下でしか床反力を把握できな
い。
は、特に人間の脚体の床反力を把握しようとする場合に
は、人間の足首部や足平部に力センサを取り付けなけれ
ばならないため、通常的な生活環境下では、該力センサ
が歩行の邪魔になってしまうという不都合がある。ま
た、フォースプレートを用いるものでは、該フォースプ
レートが設置された環境下でしか床反力を把握できな
い。
【０００７】かかる不具合を解消するため、本願出願人
は、先に、特願2001-214174号により以下の床反力推定
方法を提案している。この方法の原理を図１を参照して
説明する。二足歩行移動体の運動状態（歩行動作時の脚
体の運動状態）は、図１（ａ）に例示するように二足歩
行移動体１の両脚体２，２のうちの一方の脚体２（図で
は進行方向で前側の脚体）のみが接地する単脚支持状態
と、図１（ｂ）に示すように両脚体２，２が接地する両
脚支持状態とがある。
は、先に、特願2001-214174号により以下の床反力推定
方法を提案している。この方法の原理を図１を参照して
説明する。二足歩行移動体の運動状態（歩行動作時の脚
体の運動状態）は、図１（ａ）に例示するように二足歩
行移動体１の両脚体２，２のうちの一方の脚体２（図で
は進行方向で前側の脚体）のみが接地する単脚支持状態
と、図１（ｂ）に示すように両脚体２，２が接地する両
脚支持状態とがある。
【０００８】ここで、両脚体２，２に床Ａから作用する
全床反力をＦとおくと、該全床反力Ｆは、図１（ａ）の
単脚支持状態では、接地している脚体２に作用する床反
力に等しく、また、図１（ｂ）の両脚支持状態では、両
脚体２，２にそれぞれ作用する床反力Ff，Frの合力であ
る。また、二足歩行移動体１が運動を行う床Ａに対して
固定した絶対座標系Ｃfにおける二足歩行移動体１の重
心G0の加速度ａのＸ軸方向（二足歩行移動体２の進行方
向での水平方向）、Ｚ軸方向（鉛直方向）の成分をそれ
ぞれａx，ａz、二足歩行移動体１に作用する全床反力Ｆ
のＸ軸方向、Ｚ軸方向の成分をそれぞれＦx，Ｆzとおく
と、重心Ｇ0の運動方程式（詳しくは、重心G0の並進運
動に関する運動方程式）は、次式（１）により表され
る。
全床反力をＦとおくと、該全床反力Ｆは、図１（ａ）の
単脚支持状態では、接地している脚体２に作用する床反
力に等しく、また、図１（ｂ）の両脚支持状態では、両
脚体２，２にそれぞれ作用する床反力Ff，Frの合力であ
る。また、二足歩行移動体１が運動を行う床Ａに対して
固定した絶対座標系Ｃfにおける二足歩行移動体１の重
心G0の加速度ａのＸ軸方向（二足歩行移動体２の進行方
向での水平方向）、Ｚ軸方向（鉛直方向）の成分をそれ
ぞれａx，ａz、二足歩行移動体１に作用する全床反力Ｆ
のＸ軸方向、Ｚ軸方向の成分をそれぞれＦx，Ｆzとおく
と、重心Ｇ0の運動方程式（詳しくは、重心G0の並進運
動に関する運動方程式）は、次式（１）により表され
る。
【０００９】
T(Ｆx，Ｆz−Ｍ・ｇ)＝Ｍ・T(ａx，ａz) ……（１）
（但し、Ｍ：二足歩行移動体の重量、ｇ：重力加速度）
尚、式（１）中の両辺の括弧部分T( ， ）は２成分の
ベクトルを意味している。本明細書ではT( ， ）とい
う形の表記は、ベクトルを表す。
ベクトルを意味している。本明細書ではT( ， ）とい
う形の表記は、ベクトルを表す。
【００１０】つまり、重心G0の運動方程式は、該重心G0
の加速度ａと二足歩行移動体１の重量Ｍとの積が、該重
心G0に作用する重力（＝Ｍ・ｇ）と、前記全床反力Ｆと
の合力に等しいという関係式になる。
の加速度ａと二足歩行移動体１の重量Ｍとの積が、該重
心G0に作用する重力（＝Ｍ・ｇ）と、前記全床反力Ｆと
の合力に等しいという関係式になる。
【００１１】従って、二足歩行移動体１の重心Ｇ0の加
速度ａ＝T(ａx，ａz)を把握すれば、その加速度ａと、
二足歩行移動体１の重量Ｍの値と、重力加速度ｇの値と
を用いて、次式（２）により、全床反力Ｆ＝T(Ｆx，Ｆ
z)の推定値を得ることができることとなる。
速度ａ＝T(ａx，ａz)を把握すれば、その加速度ａと、
二足歩行移動体１の重量Ｍの値と、重力加速度ｇの値と
を用いて、次式（２）により、全床反力Ｆ＝T(Ｆx，Ｆ
z)の推定値を得ることができることとなる。
【００１２】T
(Ｆx，Ｆz)＝Ｍ・T(ａx，ａz＋ｇ) ……（２）
【００１３】そして、図１（ａ）の単脚支持状態では、
接地している単一の脚体２に作用する床反力は、上記全
床反力Ｆに等しいので、式（２）によりその単一の脚体
２に作用する床反力Ｆの推定値が得られることとなる。
接地している単一の脚体２に作用する床反力は、上記全
床反力Ｆに等しいので、式（２）によりその単一の脚体
２に作用する床反力Ｆの推定値が得られることとなる。
【００１４】この場合、床反力Ｆの推定値を得るために
必要な重量Ｍは、あらかじめ計測等により把握すること
ができる。また、重心Ｇ0の位置や加速度ａについて
は、詳細は後述するが、二足歩行移動体１の各関節の屈
曲角度（回転角度）を検出するセンサや、加速度セン
サ、ジャイロセンサ等のセンサの出力を用いて公知の手
法等により逐次把握することが可能である。
必要な重量Ｍは、あらかじめ計測等により把握すること
ができる。また、重心Ｇ0の位置や加速度ａについて
は、詳細は後述するが、二足歩行移動体１の各関節の屈
曲角度（回転角度）を検出するセンサや、加速度セン
サ、ジャイロセンサ等のセンサの出力を用いて公知の手
法等により逐次把握することが可能である。
【００１５】また、図１（ｂ）の両脚支持状態では、前
側脚体２の床反力FfのＸ軸方向、Ｚ軸方向の成分をそれ
ぞれＦfx，Ｆfz、後側脚体２の床反力ＦrのＸ軸方向、
Ｚ軸方向の成分をそれぞれＦrx，Ｆrzとして、全床反力
ＦのＸ軸方向、Ｚ軸方向の成分Ｆx，ＦzはそれぞれＦfx
＋Ｆrx，Ｆfz＋Ｆrzになり、重心Ｇ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の向きに等しいと
いう関係を表す関係式が成立する。
２，２の床反力Ｆ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）とおくと、上記の関係式は次式（４）とな
る。
絶対座標系Ｃｆにおける重心Ｇ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)の
推定値を得ることができることとなる。
速度ａ＝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の
位置については、詳細は後述するが、二足歩行移動体１
の各関節の屈曲角度（回転角度）を検出するセンサや、
加速度センサ、ジャイロセンサ等のセンサの出力を用い
て、公知の手法等により逐次把握することが可能であ
る。
ために必要な重量Ｍは、あらかじめ計測等により把握す
ることができる。また、重心Ｇ0の加速度ａや重心Ｇ0の
位置、該重心Ｇ0に対する前記特定部位１２f，１２rの
位置については、詳細は後述するが、二足歩行移動体１
の各関節の屈曲角度（回転角度）を検出するセンサや、
加速度センサ、ジャイロセンサ等のセンサの出力を用い
て、公知の手法等により逐次把握することが可能であ
る。
【００２４】然し、上記先願の方法で求めた両脚支持状
態における各脚体の床反力の鉛直方向成分Ｆfz，Ｆrzの
推定値は必ずしも満足できる精度ではないことが判明し
た。これは、各脚体２，２の床反力Ｆf，Ｆrが各脚体
２，２の特定部位１２f，１２rから二足歩行移動体１の
重心Ｇ0に向かって作用するとは限らないためである。
そして、二足歩行移動体１の重量の影響で大きな値にな
る床反力の鉛直方向成分の推定値は進行方向成分に比し
誤差が大きくなる。
態における各脚体の床反力の鉛直方向成分Ｆfz，Ｆrzの
推定値は必ずしも満足できる精度ではないことが判明し
た。これは、各脚体２，２の床反力Ｆf，Ｆrが各脚体
２，２の特定部位１２f，１２rから二足歩行移動体１の
重心Ｇ0に向かって作用するとは限らないためである。
そして、二足歩行移動体１の重量の影響で大きな値にな
る床反力の鉛直方向成分の推定値は進行方向成分に比し
誤差が大きくなる。
【００２５】
【発明が解決しようとする課題】本発明は、以上の点に
鑑み、比較的簡単な手法で両脚支持状態における各脚体
の床反力の鉛直方向成分を精度よくリアルタイムで把握
することができ、特に二足歩行移動体としての人間に係
る床反力を把握する上で好適な床反力推定方法を提供す
ることを課題としている。
鑑み、比較的簡単な手法で両脚支持状態における各脚体
の床反力の鉛直方向成分を精度よくリアルタイムで把握
することができ、特に二足歩行移動体としての人間に係
る床反力を把握する上で好適な床反力推定方法を提供す
ることを課題としている。
【００２６】
【課題を解決するための手段】本発明の二足歩行移動体
の床反力推定方法、すなわち、二足歩行移動体の運動状
態が該二足歩行移動体の両脚体が接地している両脚支持
状態であるときの各脚体に作用する床反力の鉛直方向成
分を推定する方法は、上記課題を解決するため、二足歩
行移動体の重心の位置を逐次求めつつ、該重心の位置の
時系列データを用いて床に対して固定された絶対座標系
での該重心の加速度を逐次求める第１ステップと、二足
歩行移動体の重量と重力加速度と前記重心の加速度と各
脚体に作用する床反力の合力である全床反力とにより表
される該重心の運動方程式に基づき、該全床反力の推定
値を逐次求める第２ステップと、前記両脚支持状態にお
いて両脚体のうち少なくとも二足歩行移動体の進行方向
に向かって前側に存する前側脚体の足平部のあらかじめ
定めた特定部位の床面からの位置を逐次求める第３ステ
ップとを備え、前記両脚支持状態であるときには、両脚
体のうち該二足歩行移動体の進行方向に向かって後側に
存する後側脚体に作用する床反力の鉛直方向成分と、前
側脚体の足平部の前記特定部位の床面からの位置との間
に成立する所定の相関関係に基づき、前記第３ステップ
で求めた前側脚体の足平部の前記特定部位の床面からの
位置を用いて後側脚体に作用する床反力の鉛直方向成分
の推定値を逐次求め、その求めた後側脚体の床反力の鉛
直方向成分の推定値を前記第２ステップで求めた全床反
力の鉛直方向成分の推定値から差し引くことにより、前
側脚体に作用する床反力の鉛直方向成分の推定値を逐次
求めることを特徴とする。
の床反力推定方法、すなわち、二足歩行移動体の運動状
態が該二足歩行移動体の両脚体が接地している両脚支持
状態であるときの各脚体に作用する床反力の鉛直方向成
分を推定する方法は、上記課題を解決するため、二足歩
行移動体の重心の位置を逐次求めつつ、該重心の位置の
時系列データを用いて床に対して固定された絶対座標系
での該重心の加速度を逐次求める第１ステップと、二足
歩行移動体の重量と重力加速度と前記重心の加速度と各
脚体に作用する床反力の合力である全床反力とにより表
される該重心の運動方程式に基づき、該全床反力の推定
値を逐次求める第２ステップと、前記両脚支持状態にお
いて両脚体のうち少なくとも二足歩行移動体の進行方向
に向かって前側に存する前側脚体の足平部のあらかじめ
定めた特定部位の床面からの位置を逐次求める第３ステ
ップとを備え、前記両脚支持状態であるときには、両脚
体のうち該二足歩行移動体の進行方向に向かって後側に
存する後側脚体に作用する床反力の鉛直方向成分と、前
側脚体の足平部の前記特定部位の床面からの位置との間
に成立する所定の相関関係に基づき、前記第３ステップ
で求めた前側脚体の足平部の前記特定部位の床面からの
位置を用いて後側脚体に作用する床反力の鉛直方向成分
の推定値を逐次求め、その求めた後側脚体の床反力の鉛
直方向成分の推定値を前記第２ステップで求めた全床反
力の鉛直方向成分の推定値から差し引くことにより、前
側脚体に作用する床反力の鉛直方向成分の推定値を逐次
求めることを特徴とする。
【００２７】本願発明者は、鋭意努力の結果、両脚支持
状態において後側脚体に作用する床反力の鉛直方向成分
は、前側脚体の足平部の踵が着床して両脚支持状態に移
行してから、前側脚体の足平部の特定部位（例えば中足
趾節関節）の床面からの位置変化に対して顕著な相関性
を持って変化することを知見するに至った。従って、後
側脚体に作用する床反力の鉛直方向成分と前側脚体の足
平部の特定部位の床面からの位置との間に成立する相関
関係を各種実験やシミュレーション等であらかじめ調べ
ておけば、その相関関係に基づいて、本発明のように前
側脚体の足平部の特定部位の床面からの位置を用いて後
側脚体に作用する床反力の鉛直方向成分を推定すること
ができる。そして、後側脚体に作用する床反力と前側脚
体に作用する床反力の合力が全床反力であるので、この
全床反力の鉛直方向成分の推定値から、上記相関関係に
基づいて求められる後側脚体に作用する床反力の鉛直方
向成分の推定値を差し引くことにより、前側脚体に作用
する床反力の鉛直方向成分の推定値を求めることができ
る。
状態において後側脚体に作用する床反力の鉛直方向成分
は、前側脚体の足平部の踵が着床して両脚支持状態に移
行してから、前側脚体の足平部の特定部位（例えば中足
趾節関節）の床面からの位置変化に対して顕著な相関性
を持って変化することを知見するに至った。従って、後
側脚体に作用する床反力の鉛直方向成分と前側脚体の足
平部の特定部位の床面からの位置との間に成立する相関
関係を各種実験やシミュレーション等であらかじめ調べ
ておけば、その相関関係に基づいて、本発明のように前
側脚体の足平部の特定部位の床面からの位置を用いて後
側脚体に作用する床反力の鉛直方向成分を推定すること
ができる。そして、後側脚体に作用する床反力と前側脚
体に作用する床反力の合力が全床反力であるので、この
全床反力の鉛直方向成分の推定値から、上記相関関係に
基づいて求められる後側脚体に作用する床反力の鉛直方
向成分の推定値を差し引くことにより、前側脚体に作用
する床反力の鉛直方向成分の推定値を求めることができ
る。
【００２８】尚、後側と前側の各脚体に作用する床反力
の進行方向成分の推定値は、適宜の手法、例えば、上記
先願と同様に上記式（５）から求めればよい。
の進行方向成分の推定値は、適宜の手法、例えば、上記
先願と同様に上記式（５）から求めればよい。
【００２９】ここで、本発明における全床反力の推定値
は上記先願と同様の手法で求められる。そして、この全
床反力の推定値を求めるために必要な二足歩行移動体の
重量は、あらかじめ計測等により把握しておけばよい。
また、二足歩行移動体の重心の位置や加速度は、二足歩
行移動体の各関節の屈曲角度（回転角度）を検出するセ
ンサ（ポテンショメータ等）や、加速度センサ、ジャイ
ロセンサ等、比較的小型で二足歩行移動体への装備が容
易なセンサの出力のデータを用いてリアルタイムで把握
することが可能であり、足平部の特定部位の床面からの
位置も、履き物等に傾斜測定用の簡易な加速度センサ等
を装備しておくことによりリアルタイムで把握すること
が可能である。
は上記先願と同様の手法で求められる。そして、この全
床反力の推定値を求めるために必要な二足歩行移動体の
重量は、あらかじめ計測等により把握しておけばよい。
また、二足歩行移動体の重心の位置や加速度は、二足歩
行移動体の各関節の屈曲角度（回転角度）を検出するセ
ンサ（ポテンショメータ等）や、加速度センサ、ジャイ
ロセンサ等、比較的小型で二足歩行移動体への装備が容
易なセンサの出力のデータを用いてリアルタイムで把握
することが可能であり、足平部の特定部位の床面からの
位置も、履き物等に傾斜測定用の簡易な加速度センサ等
を装備しておくことによりリアルタイムで把握すること
が可能である。
【００３０】従って、本発明の床反力推定方法によれ
ば、二足歩行移動体の足首部や足平部に力センサを装着
したり、フォースプレートを使用したりすることなく、
比較的簡単な手法で床反力をリアルタイムで把握するこ
とができる。
ば、二足歩行移動体の足首部や足平部に力センサを装着
したり、フォースプレートを使用したりすることなく、
比較的簡単な手法で床反力をリアルタイムで把握するこ
とができる。
【００３１】
【発明の実施の形態】本発明の一実施形態を図２〜図９
を参照して説明する。
を参照して説明する。
【００３２】本実施形態は、二足歩行移動体としての人
間に本発明の床反力推定方法を適用した実施形態であ
る。
間に本発明の床反力推定方法を適用した実施形態であ
る。
【００３３】図２に模式化して示すように、人間１は、
その構成を大別すると、左右一対の脚体２，２と、腰部
３及び胸部４からなる胴体５と、頭部６と、左右一対の
腕体７，７とを有する。胴体５は、その腰部３が脚体
２，２のそれぞれに左右一対の股関節８，８を介して連
結され、両脚体２，２上に支持されている。また、胴体
５の胸部４は、腰部３の上側に該腰部３に対して人間１
の前方側に傾斜可能に存している。そして、この胸部４
の上部の左右両側部から腕体７，７が延設され、該胸部
４の上端部に頭部６が支持されている。
その構成を大別すると、左右一対の脚体２，２と、腰部
３及び胸部４からなる胴体５と、頭部６と、左右一対の
腕体７，７とを有する。胴体５は、その腰部３が脚体
２，２のそれぞれに左右一対の股関節８，８を介して連
結され、両脚体２，２上に支持されている。また、胴体
５の胸部４は、腰部３の上側に該腰部３に対して人間１
の前方側に傾斜可能に存している。そして、この胸部４
の上部の左右両側部から腕体７，７が延設され、該胸部
４の上端部に頭部６が支持されている。
【００３４】各脚体２，２は、股関節８から延在する大
腿部９と、該大腿部９の先端から膝関節１０を介して延
在する下腿部１１とを有し、下腿部１１の先端部に、足
首部（足首関節）１２を介して足平部１３が連結されて
いる。
腿部９と、該大腿部９の先端から膝関節１０を介して延
在する下腿部１１とを有し、下腿部１１の先端部に、足
首部（足首関節）１２を介して足平部１３が連結されて
いる。
【００３５】本実施形態では、このような構成を有する
人間１の各脚体２に作用する床反力の推定、さらには膝
関節１０及び股関節８に作用するモーメントの推定を行
うために、次のような装置を人間１に装備している。
人間１の各脚体２に作用する床反力の推定、さらには膝
関節１０及び股関節８に作用するモーメントの推定を行
うために、次のような装置を人間１に装備している。
【００３６】すなわち、胴体５の胸部４には、胸部４の
傾斜に伴う角速度に応じた出力を発生するジャイロセン
サ１４（以下、胸部ジャイロセンサ１４という）と、胸
部４の前後方向の加速度に応じた出力を発生する加速度
センサ１５（以下、胸部前後加速度センサ１５という）
と、CPU、RAM、ROM等から構成される演算処理装置１６
と、該演算処理装置１６等の電源となるバッテリ１７と
が装着されている。この場合、これらの胸部ジャイロセ
ンサ１４、胸部前後加速度センサ１５、演算処理装置１
６及びバッテリ１７は、例えば胸部４に図示しないベル
ト等を介して固定されるショルダーバッグ状の収容部材
１８に収容され、該収容部材１８を介して胸部４に一体
的に固定されている。
傾斜に伴う角速度に応じた出力を発生するジャイロセン
サ１４（以下、胸部ジャイロセンサ１４という）と、胸
部４の前後方向の加速度に応じた出力を発生する加速度
センサ１５（以下、胸部前後加速度センサ１５という）
と、CPU、RAM、ROM等から構成される演算処理装置１６
と、該演算処理装置１６等の電源となるバッテリ１７と
が装着されている。この場合、これらの胸部ジャイロセ
ンサ１４、胸部前後加速度センサ１５、演算処理装置１
６及びバッテリ１７は、例えば胸部４に図示しないベル
ト等を介して固定されるショルダーバッグ状の収容部材
１８に収容され、該収容部材１８を介して胸部４に一体
的に固定されている。
【００３７】尚、胸部加速度センサ１５の出力が表す加
速度は、より詳しくは、胸部４の水平断面方向（胸部４
の軸心と直交する方向）での前後方向の加速度であり、
人間１が平地に直立姿勢で起立した状態では、前後水平
方向（図２の絶対座標系のＸ軸方向）での加速度である
が、腰部３あるいは胸部４が鉛直方向（図２の絶対座標
系のＺ軸方向）から傾斜した状態では、胸部４の鉛直方
向に対する傾斜角度分だけ水平方向に対して傾斜した方
向での加速度となる。
速度は、より詳しくは、胸部４の水平断面方向（胸部４
の軸心と直交する方向）での前後方向の加速度であり、
人間１が平地に直立姿勢で起立した状態では、前後水平
方向（図２の絶対座標系のＸ軸方向）での加速度である
が、腰部３あるいは胸部４が鉛直方向（図２の絶対座標
系のＺ軸方向）から傾斜した状態では、胸部４の鉛直方
向に対する傾斜角度分だけ水平方向に対して傾斜した方
向での加速度となる。
【００３８】また、胴体５の腰部３には、腰部３の傾斜
に伴う角速度に応じた出力を発生するジャイロセンサ１
９（以下、腰部ジャイロセンサ１９という）と、腰部３
の前後方向の加速度に応じた出力を発生する加速度セン
サ２０（以下、腰部前後加速度センサ２０という）と、
腰部３の上下方向の加速度に応じた出力を発生する加速
度センサ２１（以下、腰部上下加速度センサ２１とい
う）とが、図示しないベルト等の固定手段を介して一体
的に装着・固定されている。
に伴う角速度に応じた出力を発生するジャイロセンサ１
９（以下、腰部ジャイロセンサ１９という）と、腰部３
の前後方向の加速度に応じた出力を発生する加速度セン
サ２０（以下、腰部前後加速度センサ２０という）と、
腰部３の上下方向の加速度に応じた出力を発生する加速
度センサ２１（以下、腰部上下加速度センサ２１とい
う）とが、図示しないベルト等の固定手段を介して一体
的に装着・固定されている。
【００３９】ここで、腰部前後加速度センサ２０は、よ
り詳しくは胸部前後加速度センサ１５と同様、腰部３の
水平断面方向（腰部３の軸心と直交する方向）での前後
方向の加速度を検出するセンサである。また、腰部上下
加速度センサ２１は、より詳しくは、腰部３の軸心方向
での上下方向の加速度（これは腰部前後加速度センサ２
０が検出する加速度と直交する）を検出するセンサであ
る。尚、腰部前後加速度センサ２０及び腰部上下加速度
センサ２１は、二軸型の加速度センサにより一体的に構
成されたものであってもよい。
り詳しくは胸部前後加速度センサ１５と同様、腰部３の
水平断面方向（腰部３の軸心と直交する方向）での前後
方向の加速度を検出するセンサである。また、腰部上下
加速度センサ２１は、より詳しくは、腰部３の軸心方向
での上下方向の加速度（これは腰部前後加速度センサ２
０が検出する加速度と直交する）を検出するセンサであ
る。尚、腰部前後加速度センサ２０及び腰部上下加速度
センサ２１は、二軸型の加速度センサにより一体的に構
成されたものであってもよい。
【００４０】さらに各脚体２の股関節８と膝関節１０と
には、それぞれの屈曲角度Δθc，Δθdに応じた出力を
発生する膝関節角度センサ２２及び股関節角度センサ２
３が装着されている。尚、股関節角度センサ２２につい
ては、図２では手前側（人間１の前方に向かって右側）
の脚体２の股関節８に係わる股関節角度センサ２２のみ
が図示されているが、他方側（人間１の前方に向かって
左側）の脚体２の股関節８には、手前側の股関節角度セ
ンサ２２と同心に、股関節角度センサ２２が装着されて
いる。
には、それぞれの屈曲角度Δθc，Δθdに応じた出力を
発生する膝関節角度センサ２２及び股関節角度センサ２
３が装着されている。尚、股関節角度センサ２２につい
ては、図２では手前側（人間１の前方に向かって右側）
の脚体２の股関節８に係わる股関節角度センサ２２のみ
が図示されているが、他方側（人間１の前方に向かって
左側）の脚体２の股関節８には、手前側の股関節角度セ
ンサ２２と同心に、股関節角度センサ２２が装着されて
いる。
【００４１】これらの角度センサ２２，２３は、例えば
ポテンショメータにより構成されたものであり、各脚体
２に図示しないバンド部材等の手段を介して装着されて
いる。ここで、各股関節角度センサ２２が検出する屈曲
角度Δθcは、より詳しくは、腰部３と各脚体２の大腿
部９との姿勢関係が所定の姿勢関係（例えば人間１の直
立姿勢状態のように腰部３の軸心と大腿部９の軸心とが
ほぼ平行となる姿勢関係）にあるときを基準とした、腰
部３に対する各脚体２の大腿部９の股関節８回り（人間
１の左右方向における股関節８の軸心回り）の回転角度
である。同様に、各膝関節角度センサ２３が検出する屈
曲角度Δθdは、各脚体２の大腿部９と下腿部１１との
姿勢関係が所定の姿勢関係（例えば大腿部９の軸心と下
腿部１１の軸心とがほぼ平行となる姿勢関係）にあると
きを基準とした、大腿部９に対する下腿部１１の膝関節
１０回り（人間１の左右方向における膝関節１０の軸心
回り）の回転角度である。
ポテンショメータにより構成されたものであり、各脚体
２に図示しないバンド部材等の手段を介して装着されて
いる。ここで、各股関節角度センサ２２が検出する屈曲
角度Δθcは、より詳しくは、腰部３と各脚体２の大腿
部９との姿勢関係が所定の姿勢関係（例えば人間１の直
立姿勢状態のように腰部３の軸心と大腿部９の軸心とが
ほぼ平行となる姿勢関係）にあるときを基準とした、腰
部３に対する各脚体２の大腿部９の股関節８回り（人間
１の左右方向における股関節８の軸心回り）の回転角度
である。同様に、各膝関節角度センサ２３が検出する屈
曲角度Δθdは、各脚体２の大腿部９と下腿部１１との
姿勢関係が所定の姿勢関係（例えば大腿部９の軸心と下
腿部１１の軸心とがほぼ平行となる姿勢関係）にあると
きを基準とした、大腿部９に対する下腿部１１の膝関節
１０回り（人間１の左右方向における膝関節１０の軸心
回り）の回転角度である。
【００４２】また、各脚体２の足平部１３の特定部位、
例えば、中足趾節関節の床面からの位置（以下ＭＰ高さ
と記す）を計測するためのセンサが設けられている。こ
れを図３を参照して詳述するに、足平部１３の踵１３ａ
から中足趾節関節１３ｂまでは剛体と仮定でき、ＭＰ高
さＨは、踵１３ａから中足趾節関節１３ｂまでの距離を
Ｄ、床面に対する足平部１３の傾斜角度をθとして、Ｈ
＝Ｄｓｉｎθになる。そして、足平部１３の長手方向の
加速度を検出する加速度センサ２４を履き物等に装備し
ておけば、この加速度センサ２４による計測加速度をｇ
ｓ、重力加速度をｇとして、θ＝Ａｒｃｓｉｎ（ｇｓ／
ｇ）の式でθを算出でき、このθを用いてＭＰ高さＨを
求められる。ここで、両脚支持状態では、人間１の進行
方向に向かって前側の脚体２の踵位置は加速せず、加速
度センサ２４は足平部１３の傾斜角度θに応じた加速度
を正確に検出する。従って、加速度センサ２４により足
平部１３の傾斜角度θひいてはＭＰ高さＨを正確に計測
できる。尚、加速度センサ２４に作用する接地衝撃を減
らすため、加速度センサ２４の装備位置は踵から離れた
つま先側にすることが望ましい。
例えば、中足趾節関節の床面からの位置（以下ＭＰ高さ
と記す）を計測するためのセンサが設けられている。こ
れを図３を参照して詳述するに、足平部１３の踵１３ａ
から中足趾節関節１３ｂまでは剛体と仮定でき、ＭＰ高
さＨは、踵１３ａから中足趾節関節１３ｂまでの距離を
Ｄ、床面に対する足平部１３の傾斜角度をθとして、Ｈ
＝Ｄｓｉｎθになる。そして、足平部１３の長手方向の
加速度を検出する加速度センサ２４を履き物等に装備し
ておけば、この加速度センサ２４による計測加速度をｇ
ｓ、重力加速度をｇとして、θ＝Ａｒｃｓｉｎ（ｇｓ／
ｇ）の式でθを算出でき、このθを用いてＭＰ高さＨを
求められる。ここで、両脚支持状態では、人間１の進行
方向に向かって前側の脚体２の踵位置は加速せず、加速
度センサ２４は足平部１３の傾斜角度θに応じた加速度
を正確に検出する。従って、加速度センサ２４により足
平部１３の傾斜角度θひいてはＭＰ高さＨを正確に計測
できる。尚、加速度センサ２４に作用する接地衝撃を減
らすため、加速度センサ２４の装備位置は踵から離れた
つま先側にすることが望ましい。
【００４３】前記各センサ１４，１５，１９〜２４は、
それらの出力を演算処理装置１６に入力すべく、図示を
省略する信号線を介して演算処理装置１６に接続されて
いる。
それらの出力を演算処理装置１６に入力すべく、図示を
省略する信号線を介して演算処理装置１６に接続されて
いる。
【００４４】前記演算処理装置１６は、図４に示すよう
な機能的手段を備えている。すなわち、演算処理装置１
６は、腰部上下加速度センサ２１の検出データと、後述
する床反力推定手段３８により求められた各脚体２の床
反力の推定値のデータとを用いて、人間１の脚体２，２
の運動状態が単脚支持状態（図１（ａ）の状態）である
か、両脚支持状態（図１（ｂ）の状態）であるかを判断
する脚体運動判断手段２５を備えている。また、演算処
理装置１６は、胸部前後加速度センサ１５及び胸部ジャ
イロセンサ１４の検出データを用いて、胸部４の絶対座
標系Ｃfにおける傾斜角度θa（具体的には例えば鉛直方
向に対する傾斜角度θa。図２参照）を計測する胸部傾
斜角度計測手段２６と、腰部前後加速度センサ２０及び
腰部ジャイロセンサ１９の検出データを用いて、腰部３
の絶対座標系Ｃfにおける傾斜角度θb（具体的には例え
ば鉛直方向に対する傾斜角度θb。図２参照）を計測す
る腰部傾斜角度計測手段２７とを備えている。
な機能的手段を備えている。すなわち、演算処理装置１
６は、腰部上下加速度センサ２１の検出データと、後述
する床反力推定手段３８により求められた各脚体２の床
反力の推定値のデータとを用いて、人間１の脚体２，２
の運動状態が単脚支持状態（図１（ａ）の状態）である
か、両脚支持状態（図１（ｂ）の状態）であるかを判断
する脚体運動判断手段２５を備えている。また、演算処
理装置１６は、胸部前後加速度センサ１５及び胸部ジャ
イロセンサ１４の検出データを用いて、胸部４の絶対座
標系Ｃfにおける傾斜角度θa（具体的には例えば鉛直方
向に対する傾斜角度θa。図２参照）を計測する胸部傾
斜角度計測手段２６と、腰部前後加速度センサ２０及び
腰部ジャイロセンサ１９の検出データを用いて、腰部３
の絶対座標系Ｃfにおける傾斜角度θb（具体的には例え
ば鉛直方向に対する傾斜角度θb。図２参照）を計測す
る腰部傾斜角度計測手段２７とを備えている。
【００４５】さらに、演算処理装置１６は、腰部前後加
速度センサ２０及び腰部上下加速度センサ２１の検出デ
ータと前記腰部傾斜角度計測手段２７により計測された
腰部３の傾斜角度θbのデータとを用いて、本実施形態
における人間１の基準点として図２に示すように腰部３
に設定される身体座標系Ｃp（図２のｘｚ座標）の原点
Ｏの絶対座標系Ｃfにおける加速度（並進加速度）ａ0＝
T(ａ0x，ａ0z)を求める基準加速度計測手段２８を備え
ている。ここで、身体座標系Ｃｐは、より詳しくは、例
えば人間１の左右の股関節８，８のそれぞれの中心を結
ぶ線の中点を原点Ｏとし、鉛直方向をｚ軸方向、人間１
の前方に向かう水平方向をｘ軸方向とした座標系（３軸
の方向が前記絶対座標系Ｃfと同一の座標系）である。
速度センサ２０及び腰部上下加速度センサ２１の検出デ
ータと前記腰部傾斜角度計測手段２７により計測された
腰部３の傾斜角度θbのデータとを用いて、本実施形態
における人間１の基準点として図２に示すように腰部３
に設定される身体座標系Ｃp（図２のｘｚ座標）の原点
Ｏの絶対座標系Ｃfにおける加速度（並進加速度）ａ0＝
T(ａ0x，ａ0z)を求める基準加速度計測手段２８を備え
ている。ここで、身体座標系Ｃｐは、より詳しくは、例
えば人間１の左右の股関節８，８のそれぞれの中心を結
ぶ線の中点を原点Ｏとし、鉛直方向をｚ軸方向、人間１
の前方に向かう水平方向をｘ軸方向とした座標系（３軸
の方向が前記絶対座標系Ｃfと同一の座標系）である。
【００４６】また、演算処理装置１６は、各脚体２の股
関節角度センサ２２及び膝関節角度センサ２３の検出デ
ータと、前記腰部傾斜角度計測手段２７による腰部３の
傾斜角度θbのデータとを用いて、絶対座標系Ｃfにおけ
る各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜
角度θc，θd（具体的には例えば鉛直方向に対する傾斜
角度θc，θd。図２参照）求める脚体姿勢算出手段２９
を備えている。
関節角度センサ２２及び膝関節角度センサ２３の検出デ
ータと、前記腰部傾斜角度計測手段２７による腰部３の
傾斜角度θ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)
(図１参照）を求める身体重心加速度算出手段３４とを
備えている。
角度計測手段２６、腰部傾斜角度計測手段２７及び脚体
姿勢算出手段２９により得られる胸部４の傾斜角度θ
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のデータを用いて接地している各
脚体２の床反力作用点の位置を推定する床反力作用点推
定手段３７とを備えている。
心位置算出手段３０による人間１の各剛体相当部の重心
の位置（詳しくは脚体２に係わる剛体相当部の重心の位
置）のデータと前記基準加速度計測手段２８による身体
座標系Cpの原点Ｏの加速度ａ 0のデータとを用いて絶対
座標系Ｃfにおける各脚体２の大腿部９及び下腿部１１
のそれぞれの重心の加速度（並進加速度）を求める脚体
各部加速度算出手段３５と、前記脚体姿勢算出手段２９
による各脚体２の大腿部９及び下腿部１１のそれぞれの
傾斜角度θc，θdのデータを用いて絶対座標系Ｃfにお
ける各脚体２，２の大腿部９及び下腿部１１の角加速度
を求める脚体各部角加速度算出手段３６と、前記脚体姿
勢算出手段２８による各脚体２，２の大腿部９及び下腿
部１１のそれぞれの傾斜角度θc，θdのうち、例えば大
腿部９の傾斜角度θcのデータを用いて接地している各
脚体２の床反力作用点の位置を推定する床反力作用点推
定手段３７とを備えている。
【００４９】また、演算処理装置１６は、前記身体重心
加速度算出手段３４による身体重心の加速度ａのデータ
と前記足首位置算出手段３２による足首位置のデータと
前記ＭＰ高さ算出手段３３によるＭＰ高さＨのデータと
前記脚体運動判断手段２５による脚体２の運動状態の判
断結果のデータとを用いて各脚体２に作用する床反力の
推定値を求める床反力推定手段３８と、この床反力の推
定値のデータと脚体各部加速度算出手段３５による各脚
体２の大腿部９及び下腿部１１の重心の加速度のデータ
と脚体各部角加速度算出手段３６による各脚体２の大腿
部９及び下腿部１１の角加速度のデータと床反力作用点
推定手段３７による床反力作用点の推定位置のデータと
前記脚体姿勢算出手段２９による各脚体２の大腿部９及
び下腿部１１のそれぞれの傾斜角度θc，θdのデータと
を用いて各脚体２の膝関節１０及び股関節８にそれぞれ
作用するモーメントを推定する関節モーメント推定手段
３９とを備えている。
加速度算出手段３４による身体重心の加速度ａのデータ
と前記足首位置算出手段３２による足首位置のデータと
前記ＭＰ高さ算出手段３３によるＭＰ高さＨのデータと
前記脚体運動判断手段２５による脚体２の運動状態の判
断結果のデータとを用いて各脚体２に作用する床反力の
推定値を求める床反力推定手段３８と、この床反力の推
定値のデータと脚体各部加速度算出手段３５による各脚
体２の大腿部９及び下腿部１１の重心の加速度のデータ
と脚体各部角加速度算出手段３６による各脚体２の大腿
部９及び下腿部１１の角加速度のデータと床反力作用点
推定手段３７による床反力作用点の推定位置のデータと
前記脚体姿勢算出手段２９による各脚体２の大腿部９及
び下腿部１１のそれぞれの傾斜角度θc，θdのデータと
を用いて各脚体２の膝関節１０及び股関節８にそれぞれ
作用するモーメントを推定する関節モーメント推定手段
３９とを備えている。
【００５０】次に、上述の演算処理装置１６の各手段の
より詳細な処理内容と併せて、本実施形態の作動を説明
する。
より詳細な処理内容と併せて、本実施形態の作動を説明
する。
【００５１】本実施形態では、例えば人間１が歩行等の
脚体２の運動を行うに際して、両脚体２，２を着床させ
た状態で演算処理装置１６の図示しない電源スイッチを
投入すると、該演算処理装置１６による処理が所定のサ
イクルタイム毎に以下に説明するように逐次実行され、
各脚体２に作用する床反力の推定値等が逐次求められ
る。
脚体２の運動を行うに際して、両脚体２，２を着床させ
た状態で演算処理装置１６の図示しない電源スイッチを
投入すると、該演算処理装置１６による処理が所定のサ
イクルタイム毎に以下に説明するように逐次実行され、
各脚体２に作用する床反力の推定値等が逐次求められ
る。
【００５２】すなわち、まず、演算処理装置１６は、前
記脚体運動判断手段２５の処理を実行する。この脚体運
動判断手段２５の処理では、前記サイクルタイム毎に、
前記腰部上下加速度センサ２１による腰部３の上向き方
向の加速度の検出データがあらかじめ定めた所定の閾値
と比較される。そして、該加速度の検出値がその閾値を
超えたときに、前記図１（ｂ）に示したような両脚支持
状態が開始し、且つ、前記図１（ａ）に示したような単
脚支持状態が終了すると判断される。すなわち、人間１
の歩行時に、単脚支持状態から両脚支持状態への移行の
際には、遊脚側の脚体２が着床することで、股関節８の
近傍の腰部３には、ほぼ上向きに比較的大きな加速度
（通常的な単脚支持状態では発生し得ない加速度）が発
生する。このため、前記脚体運動判断手段２５は、上記
のように腰部上下加速度センサ２１による腰部３の上向
き方向の加速度の検出データを所定の閾値と比較するこ
とで、両脚支持状態の開始及び単脚支持状態の終了を判
断する。
記脚体運動判断手段２５の処理を実行する。この脚体運
動判断手段２５の処理では、前記サイクルタイム毎に、
前記腰部上下加速度センサ２１による腰部３の上向き方
向の加速度の検出データがあらかじめ定めた所定の閾値
と比較される。そして、該加速度の検出値がその閾値を
超えたときに、前記図１（ｂ）に示したような両脚支持
状態が開始し、且つ、前記図１（ａ）に示したような単
脚支持状態が終了すると判断される。すなわち、人間１
の歩行時に、単脚支持状態から両脚支持状態への移行の
際には、遊脚側の脚体２が着床することで、股関節８の
近傍の腰部３には、ほぼ上向きに比較的大きな加速度
（通常的な単脚支持状態では発生し得ない加速度）が発
生する。このため、前記脚体運動判断手段２５は、上記
のように腰部上下加速度センサ２１による腰部３の上向
き方向の加速度の検出データを所定の閾値と比較するこ
とで、両脚支持状態の開始及び単脚支持状態の終了を判
断する。
【００５３】また、脚体運動判断手段２５の処理では、
両脚支持状態で床反力推定手段３８により後述するよう
に求められた両脚体２，２のそれぞれに作用する床反力
Ｆf，Ｆr（図１（ｂ）参照）の推定値のうち、人間１の
進行方向に対して後側の脚体２に係る床反力Ｆr＝T(Ｆr
x，Ｆrz)の推定値（詳しくは演算処理装置１６の前回の
サイクルタイムで求められた床反力Ｆrの絶対値＝√(Ｆ
rx2+Ｆrz2)）があらかじめ定めた所定の閾値（略「０」
の正の値）と比較される。そして、該床反力Ｆrの推定
値の絶対値がその閾値以下に低下したときに、両脚支持
状態が終了し、且つ単脚支持状態が開始すると判断され
る。尚、本実施形態では、脚体２の運動状態の初期状態
は、両脚支持状態であり、いずれか一方の脚体２に係る
床反力の推定値が上記閾値以下に低下するまでは、脚体
運動判断手段２５は、脚体２の運動状態が両脚支持状態
であると判断する。
両脚支持状態で床反力推定手段３８により後述するよう
に求められた両脚体２，２のそれぞれに作用する床反力
Ｆf，Ｆr（図１（ｂ）参照）の推定値のうち、人間１の
進行方向に対して後側の脚体２に係る床反力Ｆr＝T(Ｆr
x，Ｆrz)の推定値（詳しくは演算処理装置１６の前回の
サイクルタイムで求められた床反力Ｆrの絶対値＝√(Ｆ
rx2+Ｆrz2)）があらかじめ定めた所定の閾値（略「０」
の正の値）と比較される。そして、該床反力Ｆrの推定
値の絶対値がその閾値以下に低下したときに、両脚支持
状態が終了し、且つ単脚支持状態が開始すると判断され
る。尚、本実施形態では、脚体２の運動状態の初期状態
は、両脚支持状態であり、いずれか一方の脚体２に係る
床反力の推定値が上記閾値以下に低下するまでは、脚体
運動判断手段２５は、脚体２の運動状態が両脚支持状態
であると判断する。
【００５４】上述のような脚体運動判断手段２５の処理
と並行して、演算処理装置１６は、前記胸部傾斜角度計
測手段２６及び腰部傾斜角度計測手段２７による処理を
実行する。この場合、胸部傾斜角度計測手段２６の処理
では、胸部前後加速度センサ１５及び胸部ジャイロセン
サ１４からそれぞれ入力される胸部４の前後方向の加速
度、胸部４の角速度の検出データから、所謂カルマンフ
ィルタの処理を用いた公知の手法により、絶対座標系Ｃ
fにおける胸部４の傾斜角度θaが前記サイクルタイム毎
に逐次求められる。同様に、腰部傾斜角度計測手段２７
の処理では、腰部前後加速度センサ２０及び腰部ジャイ
ロセンサ１９からそれぞれ入力される腰部３の前後方向
の加速度、腰部３の角速度の検出データから、カルマン
フィルタの処理を用いて絶対座標系Ｃfにおける腰部３
の傾斜角度θbが逐次求められる。ここで、絶対座標系
Ｃfにおける胸部４及び腰部３のそれぞれの傾斜角度θ
a，θbは、本実施形態では例えば鉛直方向（重力方向）
に対する傾斜角度である。
と並行して、演算処理装置１６は、前記胸部傾斜角度計
測手段２６及び腰部傾斜角度計測手段２７による処理を
実行する。この場合、胸部傾斜角度計測手段２６の処理
では、胸部前後加速度センサ１５及び胸部ジャイロセン
サ１４からそれぞれ入力される胸部４の前後方向の加速
度、胸部４の角速度の検出データから、所謂カルマンフ
ィルタの処理を用いた公知の手法により、絶対座標系Ｃ
fにおける胸部４の傾斜角度θaが前記サイクルタイム毎
に逐次求められる。同様に、腰部傾斜角度計測手段２７
の処理では、腰部前後加速度センサ２０及び腰部ジャイ
ロセンサ１９からそれぞれ入力される腰部３の前後方向
の加速度、腰部３の角速度の検出データから、カルマン
フィルタの処理を用いて絶対座標系Ｃfにおける腰部３
の傾斜角度θbが逐次求められる。ここで、絶対座標系
Ｃfにおける胸部４及び腰部３のそれぞれの傾斜角度θ
a，θbは、本実施形態では例えば鉛直方向（重力方向）
に対する傾斜角度である。
【００５５】尚、例えばジャイロセンサ１４，１９によ
る角速度の検出データを積分することで、胸部４や腰部
３の傾斜角度を求めることも可能であるが、本実施形態
のようにカルマンフィルタの処理を用いることで、胸部
４や腰部３の傾斜角度θa，θbを精度よく計測すること
ができる。
る角速度の検出データを積分することで、胸部４や腰部
３の傾斜角度を求めることも可能であるが、本実施形態
のようにカルマンフィルタの処理を用いることで、胸部
４や腰部３の傾斜角度θa，θbを精度よく計測すること
ができる。
【００５６】次に、演算処理装置１６は、前記脚体姿勢
算出手段２９の処理と前記基準加速度計測手段２８の処
理とを実行する。
算出手段２９の処理と前記基準加速度計測手段２８の処
理とを実行する。
【００５７】前記脚体姿勢算出手段２９による処理で
は、絶対座標系Ｃfにおける各脚体２の大腿部９及び下
腿部１１の傾斜角度θc，θd（鉛直方向に対する傾斜角
度。図２参照）が前記サイクルタイム毎に次のように求
められる。すなわち、各脚体２の大腿部９の傾斜角度θ
cは、その脚体２に装着されている前記股関節角度セン
サ２２による股関節８の屈曲角度Δθcの検出データの
今回値と、前記腰部傾斜角度計測手段２５により求めら
れた腰部３の傾斜角度θbの今回値とから次式（６）に
より算出される。
は、絶対座標系Ｃfにおける各脚体２の大腿部９及び下
腿部１１の傾斜角度θc，θd（鉛直方向に対する傾斜角
度。図２参照）が前記サイクルタイム毎に次のように求
められる。すなわち、各脚体２の大腿部９の傾斜角度θ
cは、その脚体２に装着されている前記股関節角度セン
サ２２による股関節８の屈曲角度Δθcの検出データの
今回値と、前記腰部傾斜角度計測手段２５により求めら
れた腰部３の傾斜角度θbの今回値とから次式（６）に
より算出される。
【００５８】θc＝θb＋Δθc ……（６）
【００５９】ここで、腰部３の傾斜角度θbは、該腰部
３の上端部が下端部よりも人間１の前方側に突き出るよ
うに該腰部３が鉛直方向に対して傾斜している場合に負
の値となるものであり、股関節８の屈曲角度Δθcは、
大腿部９の下端部が人間１の前方側に突き出るように大
腿部９が腰部３の軸心に対して傾斜している場合に正の
値となるものである。
３の上端部が下端部よりも人間１の前方側に突き出るよ
うに該腰部３が鉛直方向に対して傾斜している場合に負
の値となるものであり、股関節８の屈曲角度Δθcは、
大腿部９の下端部が人間１の前方側に突き出るように大
腿部９が腰部３の軸心に対して傾斜している場合に正の
値となるものである。
【００６０】さらに、各脚体２の下腿部１１の傾斜角度
θdは、上記のように求められた大腿部９の傾斜角度θc
の今回値と、該脚体２に装着されている前記膝関節角度
センサ２３による膝関節１０の屈曲角度Δθdの検出デ
ータの今回値とから次式（７）により算出される。
θdは、上記のように求められた大腿部９の傾斜角度θc
の今回値と、該脚体２に装着されている前記膝関節角度
センサ２３による膝関節１０の屈曲角度Δθdの検出デ
ータの今回値とから次式（７）により算出される。
【００６１】θd＝θc−Δθd ……（７）
【００６２】ここで、膝関節１０の屈曲角度は、下腿部
１１が大腿部９の軸心に対して該大腿部９の背面側に傾
斜している場合に正の値となるものである。
１１が大腿部９の軸心に対して該大腿部９の背面側に傾
斜している場合に正の値となるものである。
【００６３】また、前記基準加速度計測手段２８の処理
では、前記身体座標系Ｃpの原点Ｏの絶対座標系Ｃfにお
ける加速度ａ0＝T(a0x，a0z）が次のように求められ
る。すなわち、前記腰部前後加速度センサ２０による腰
部３の前後方向の加速度の検出データの今回値をap、前
記腰部上下加速度センサ２１による腰部３の上下方向の
加速度の検出データの今回値をaqとすると、それらの検
出データap，aqと、前記腰部傾斜角度計測手段２７によ
り求められた腰部３の傾斜角度θbの今回値とから、次
式（８）により絶対座標系Ｃfにおける加速度ａ0＝T(a0
x，a0z）が求められる。
では、前記身体座標系Ｃpの原点Ｏの絶対座標系Ｃfにお
ける加速度ａ0＝T(a0x，a0z）が次のように求められ
る。すなわち、前記腰部前後加速度センサ２０による腰
部３の前後方向の加速度の検出データの今回値をap、前
記腰部上下加速度センサ２１による腰部３の上下方向の
加速度の検出データの今回値をaqとすると、それらの検
出データap，aqと、前記腰部傾斜角度計測手段２７によ
り求められた腰部３の傾斜角度θbの今回値とから、次
式（８）により絶対座標系Ｃfにおける加速度ａ0＝T(a0
x，a0z）が求められる。
【００６４】
a0＝T(a0x，a0z）
＝T(ap・cosθb−aq・sinθb，ap・sinθb＋aq・cosθb−ｇ)
……（８）
【００６５】次に、演算処理装置１６は、前記各部重心
位置算出手段３０の処理を実行し、以下に説明する剛体
リンクモデルを用いて、前記身体座標系Ｃpにおける人
間１の各剛体相当部の重心の位置（身体座標系Ｃpの原
点に対する位置）を求める。
位置算出手段３０の処理を実行し、以下に説明する剛体
リンクモデルを用いて、前記身体座標系Ｃpにおける人
間１の各剛体相当部の重心の位置（身体座標系Ｃpの原
点に対する位置）を求める。
【００６６】図５に示すように、本実施形態で用いる剛
体リンクモデルＲは、人間１を、各脚体２の大腿部９に
相当する剛体R1，R1と、下腿部１１に相当する剛体R2，
R2と、腰部３に相当する剛体R3と、前記胸部４、腕体
７，７及び頭部６を合わせた部分（以下、上体部とい
う）４０に相当する剛体R4とを連結してなるものとして
表現するモデルである。この場合、各剛体R1と剛体R3と
の連結部、並びに、各剛体R1と剛体R2との連結部がそれ
ぞれ股関節８、膝関節１０に相当する。また、剛体R3と
剛体R4との連結部は腰部３に対する胸部４の傾動支点部
４１である。
体リンクモデルＲは、人間１を、各脚体２の大腿部９に
相当する剛体R1，R1と、下腿部１１に相当する剛体R2，
R2と、腰部３に相当する剛体R3と、前記胸部４、腕体
７，７及び頭部６を合わせた部分（以下、上体部とい
う）４０に相当する剛体R4とを連結してなるものとして
表現するモデルである。この場合、各剛体R1と剛体R3と
の連結部、並びに、各剛体R1と剛体R2との連結部がそれ
ぞれ股関節８、膝関節１０に相当する。また、剛体R3と
剛体R4との連結部は腰部３に対する胸部４の傾動支点部
４１である。
【００６７】そして、本実施形態では、このような剛体
リンクモデルＲの各剛体R1〜R4に対応する人間１の剛体
相当部（各脚体２の大腿部９及び下腿部１１、腰部３、
上体部４０）のそれぞれの重心G1、G2、G3、G4の各剛体
相当部における位置があらかじめ求められ、演算処理装
置１６の図示しないメモリに記憶されている。
リンクモデルＲの各剛体R1〜R4に対応する人間１の剛体
相当部（各脚体２の大腿部９及び下腿部１１、腰部３、
上体部４０）のそれぞれの重心G1、G2、G3、G4の各剛体
相当部における位置があらかじめ求められ、演算処理装
置１６の図示しないメモリに記憶されている。
【００６８】ここで、演算処理装置１６に記憶保持して
いる各剛体相当部の重心G 1、G2、G3、G4の位置は、各
剛体相当部に対して固定した座標系での位置である。こ
の場合、各剛体相当部の重心G1、G2、G3、G4の位置を表
すデータとして、例えば、各剛体相当部の一端部の関節
の中心点から該剛体相当部の軸心方向の距離が用いられ
る。具体的には、例えば図４に示すように、各大腿部９
の重心G1の位置は、該大腿部９の股関節８の中心から大
腿部９の軸心方向に距離ｄ1の位置、各下腿部１１の重
心G2の位置は、該下腿部１１の膝関節１０の中心から下
腿部１１の軸心方向に距離ｄ2の位置として表され、そ
れらの距離ｄ1，ｄ2の値があらかじめ求められて演算処
理装置１６に記憶保持されている。他の剛体相当部の重
心、G3、G4の位置についても同様である。
いる各剛体相当部の重心G 1、G2、G3、G4の位置は、各
剛体相当部に対して固定した座標系での位置である。こ
の場合、各剛体相当部の重心G1、G2、G3、G4の位置を表
すデータとして、例えば、各剛体相当部の一端部の関節
の中心点から該剛体相当部の軸心方向の距離が用いられ
る。具体的には、例えば図４に示すように、各大腿部９
の重心G1の位置は、該大腿部９の股関節８の中心から大
腿部９の軸心方向に距離ｄ1の位置、各下腿部１１の重
心G2の位置は、該下腿部１１の膝関節１０の中心から下
腿部１１の軸心方向に距離ｄ2の位置として表され、そ
れらの距離ｄ1，ｄ2の値があらかじめ求められて演算処
理装置１６に記憶保持されている。他の剛体相当部の重
心、G3、G4の位置についても同様である。
【００６９】尚、上体部４０の重心G4の位置は、厳密に
は、該上体部４０に含まれる腕体７，７の動きの影響を
受けるが、歩行時における各腕体７，７は、一般に胸部
４の軸心に対して対称的な位置関係になるので、上体部
４０の重心G4の位置はさほど変動せず、例えば直立姿勢
状態における上体部４０の重心G4の位置とほぼ同一とな
る。
は、該上体部４０に含まれる腕体７，７の動きの影響を
受けるが、歩行時における各腕体７，７は、一般に胸部
４の軸心に対して対称的な位置関係になるので、上体部
４０の重心G4の位置はさほど変動せず、例えば直立姿勢
状態における上体部４０の重心G4の位置とほぼ同一とな
る。
【００７０】また、本実施形態では、各剛体相当部（各
脚体２の大腿部９及び下腿部１１、腰部３、上体部４
０）の重心G1、G2、G3、G4の位置を表すデータの他、各
剛体相当部の重量のデータや、各剛体相当部のサイズの
データ（例えば各剛体相当部の長さのデータ）があらか
じめ求められて、演算処理装置１６に記憶保持されてい
る。
脚体２の大腿部９及び下腿部１１、腰部３、上体部４
０）の重心G1、G2、G3、G4の位置を表すデータの他、各
剛体相当部の重量のデータや、各剛体相当部のサイズの
データ（例えば各剛体相当部の長さのデータ）があらか
じめ求められて、演算処理装置１６に記憶保持されてい
る。
【００７１】尚、下腿部１１の重量は、足平部１３を含
めた重量である。また、上述のように演算処理装置１６
にあらかじめ記憶保持したデータは、実測等により求め
ておいてもよいが、人間１の身長や体重から、人間の平
均的な統計データに基づいて推測するようにしてもよ
い。一般に、上記各剛体相当部の重心G1、G2、G3、G 4
の位置や、重量、サイズは、人間の身長や体重と相関性
があり、その相関データに基づいて、人間の身長及び体
重のデータから、上記各剛体相当部の重心G1、G2、G3、
G4の位置や、重量、サイズを比較的精度よく推測するこ
とが可能である。
めた重量である。また、上述のように演算処理装置１６
にあらかじめ記憶保持したデータは、実測等により求め
ておいてもよいが、人間１の身長や体重から、人間の平
均的な統計データに基づいて推測するようにしてもよ
い。一般に、上記各剛体相当部の重心G1、G2、G3、G 4
の位置や、重量、サイズは、人間の身長や体重と相関性
があり、その相関データに基づいて、人間の身長及び体
重のデータから、上記各剛体相当部の重心G1、G2、G3、
G4の位置や、重量、サイズを比較的精度よく推測するこ
とが可能である。
【００７２】前記各部重心位置算出手段３０は、上述の
ように演算処理装置１６にあらかじめ記憶保持したデー
タと、前記胸部傾斜角度計測手段２６及び腰部傾斜角度
計測手段２７によりそれぞれ求められた胸部４の傾斜角
度θa（＝上体部３９の傾斜角度）及び腰部３の傾斜角
度θbの今回値と、前記脚体姿勢算出手段２９により求
められた各脚体２の大腿部９及び下腿部１１のそれぞれ
の傾斜角度θc，θdの今回値とから、腰部３に固定され
た原点Ｏを有する身体座標系Ｃp（図５のｘｚ座標）で
の各剛体相当部の重心G1、G2、G3、G4の位置を求める。
ように演算処理装置１６にあらかじめ記憶保持したデー
タと、前記胸部傾斜角度計測手段２６及び腰部傾斜角度
計測手段２７によりそれぞれ求められた胸部４の傾斜角
度θa（＝上体部３９の傾斜角度）及び腰部３の傾斜角
度θbの今回値と、前記脚体姿勢算出手段２９により求
められた各脚体２の大腿部９及び下腿部１１のそれぞれ
の傾斜角度θc，θdの今回値とから、腰部３に固定され
た原点Ｏを有する身体座標系Ｃp（図５のｘｚ座標）で
の各剛体相当部の重心G1、G2、G3、G4の位置を求める。
【００７３】この場合、各剛体相当部（各脚体２の大腿
部９及び下腿部１１、腰部３、上体部４０）の傾斜角度
θa〜θdが上述のように求められているので、その傾斜
角度θa〜θｄのデータと、各剛体相当部のサイズのデ
ータとから身体座標系Ｃpにおける各剛体相当部の位置
及び姿勢が判る。従って、身体座標系Cpにおける各剛体
相当部の重心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における傾斜角度（ｚ軸方向に対する傾斜角度）
はθ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における各剛体相当部の重心G
1、G2、G3、G4の位置を求めた後、演算処理装置１６
は、前記身体重心位置算出手段３１の処理実行し、各剛
体相当部の重心G1、G2、G3、G4の位置のデータと、各剛
体相当部の重量のデータとを用いて身体座標系Ｃpにお
ける人間１の身体重心G0の位置（xg，zg）を求める。
０により、身体座標系Ｃpにおける各剛体相当部の重心G
1、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、右側の脚体２の大腿部９の重心G
1の位置及び重量をそれぞれ（x1R，z1R）、m1R、同脚体
２の下腿部１１の重心G2の位置及び重量をそれぞれ（x2
R，z2R）、m2R、人間１の体重をＭ（＝m1L＋m2L＋m1R＋
m2R＋m3＋m4）とすると、身体座標系Ｃpにおける人間１
の身体重心G0の位置（xg，zg）は次式（９）により求め
られる。
重心G3の位置及び重量をそれぞれ（x3，z3）、m3、上体
部４０の重心G4の位置及び重量をそれぞれ（x4，z4）、
m4、人間１の前方に向かって左側の脚体２の大腿部９の
重心G1の位置及び重量をそれぞれ（x1L，z1L）、m1L、
同脚体２の下腿部１１の重心G2の位置及び重量をそれぞ
れ（x2L，z2L）、m2L、右側の脚体２の大腿部９の重心G
1の位置及び重量をそれぞれ（x1R，z1R）、m1R、同脚体
２の下腿部１１の重心G2の位置及び重量をそれぞれ（x2
R，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)が
求められる。
処理では、まず、前記サイクルタイム毎に身体重心位置
算出手段３０により求められる身体座標系Ｃ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＜０）。他方の脚体２
についても同様である。
は、まず、前記脚体姿勢算出手段２９により求められた
各脚体２の大腿部９及び下腿部１１のそれぞれの傾斜角
度θ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における身体重心G
0の位置（xg，zg）のデータの今回値とから、身体重心
Ｇ0に対する各脚体２の足首部１２の位置ベクトルT(x12
−xg，z12−zg）、すなわち、前記式（５）におけるΔ
Ｘf，ΔＺf，ΔＸr，ΔＺrが求められる。
における位置（x12，z12）と前記身体重心位置算出手段
３１により求められた身体座標系Ｃpにおける身体重心G
0の位置（xg，zg）のデータの今回値とから、身体重心
Ｇ0に対する各脚体２の足首部１２の位置ベクトルT(x12
−xg，z12−zg）、すなわち、前記式（５）におけるΔ
Ｘf，ΔＺf，ΔＸr，ΔＺrが求められる。
【００８２】また、前記ＭＰ高さ算出手段３３の処理で
は、前記足平部加速度センサ２４の検出データを用い、
図３を参照して先に説明したように、各脚体２の足平部
１３の床面に対する傾斜角度θを算出して、この傾斜角
度θからＭＰ高さＨを求める。尚、履き物等に加速度セ
ンサ２４に代えてジャイロセンサを装備し、このジャイ
ロセンサの検出データから足平部１３の傾斜角度θを算
出してＭＰ高さＨを求めるようにしても良く、更には、
履き物等に光学式距離センサを装備して、ＭＰ高さＨを
直接的に計測することも可能である。
は、前記足平部加速度センサ２４の検出データを用い、
図３を参照して先に説明したように、各脚体２の足平部
１３の床面に対する傾斜角度θを算出して、この傾斜角
度θからＭＰ高さＨを求める。尚、履き物等に加速度セ
ンサ２４に代えてジャイロセンサを装備し、このジャイ
ロセンサの検出データから足平部１３の傾斜角度θを算
出してＭＰ高さＨを求めるようにしても良く、更には、
履き物等に光学式距離センサを装備して、ＭＰ高さＨを
直接的に計測することも可能である。
【００８３】次に、演算処理手段１６は、前記床反力推
定手段３８の処理を次のように実行する。すなわち、こ
の処理では、人間１の体重Ｍ及び重力加速度ｇの値（こ
れらはあらかじめ演算処理装置１６に記憶されている）
と、前記身体重心加速度算出手段３４により求められた
絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ａx，
ａz)の今回値とから、前記式（２）により、全床反力Ｆ
＝T(Ｆx，Ｆz)の推定値が各サイクルタイム毎に逐次求
められる。この場合、前記脚体運動判断手段２５により
今回のサイクルタイムで判断された脚体２の運動状態が
単脚支持状態であれば、上記全床反力Ｆ＝T(Ｆx，Ｆz)
の推定値がそのまま接地している単一の脚体２に作用す
る床反力の推定値として求められることになる。尚、こ
の場合、非接地側の脚体２（遊脚側の脚体２）に作用す
る床反力は、T(０，０)である。
定手段３８の処理を次のように実行する。すなわち、こ
の処理では、人間１の体重Ｍ及び重力加速度ｇの値（こ
れらはあらかじめ演算処理装置１６に記憶されている）
と、前記身体重心加速度算出手段３４により求められた
絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ａx，
ａz)の今回値とから、前記式（２）により、全床反力Ｆ
＝T(Ｆx，Ｆz)の推定値が各サイクルタイム毎に逐次求
められる。この場合、前記脚体運動判断手段２５により
今回のサイクルタイムで判断された脚体２の運動状態が
単脚支持状態であれば、上記全床反力Ｆ＝T(Ｆx，Ｆz)
の推定値がそのまま接地している単一の脚体２に作用す
る床反力の推定値として求められることになる。尚、こ
の場合、非接地側の脚体２（遊脚側の脚体２）に作用す
る床反力は、T(０，０)である。
【００８４】また、脚体運動判断手段２５により今回の
サイクルタイムで判断された脚体２の運動状態が両脚支
持状態である場合には、先ず、人間１の進行方向に向か
って後側に存する後側脚体２に作用する床反力Ｆrの鉛
直方向成分Ｆrzと人間１の進行方向に向かって前側に存
する前側脚体２のＭＰ高さＨとの間に成立する相関関係
に基づいて、前記ＭＰ高さ算出手段３３により求めた前
側脚体２のＭＰ高さＨのデータを用いて後側脚体２に作
用する床反力Ｆrの鉛直方向成分Ｆrzの推定値が求めら
れる。
サイクルタイムで判断された脚体２の運動状態が両脚支
持状態である場合には、先ず、人間１の進行方向に向か
って後側に存する後側脚体２に作用する床反力Ｆ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の推定値とが求められる。
本願発明者は、鋭意努力の結果、通常歩行時において前
側脚体２の足平部１３の踵が着床してからつま先が着床
するまでの各時点における前側脚体２のＭＰ高さをＨ
（ｔ）、後側脚体２に作用する床反力の鉛直方向成分を
Ｆ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における大腿部９及び下腿部１１の重心G
1，G2のそれぞれの加速度（身体座標系Ｃpの原点Ｏに対
する加速度）が求められる。そして、このそれぞれの加
速度と、前記基準加速度計測手段２８による腰部３の絶
対座標系Ｃfにおける加速度a0＝T(a0x，a0z）とのベク
トル和を求めることにより、絶対座標系Ｃfにおける大
腿部９及び下腿部１１のそれぞれの加速度（より詳しく
は、該加速度の絶対座標系Ｃfにおける座標成分）が求
められる。
５の処理では、前記身体重心加速度算出手段３４の処理
と同様、まず、前記サイクルタイム毎に前記各部重心位
置算出手段３０により求められる身体座標系Ｃpにおけ
る各脚体２の剛体相当部である大腿部９及び下腿部１１
の重心G1，G2の位置のそれぞれの時系列データを用い
て、身体座標系Ｃpにおける大腿部９及び下腿部１１の
重心G1，G2の位置のそれぞれの２階微分値、すなわち、
身体座標系Ｃpにおける大腿部９及び下腿部１１の重心G
1，G2のそれぞれの加速度（身体座標系Ｃpの原点Ｏに対
する加速度）が求められる。そして、このそれぞれの加
速度と、前記基準加速度計測手段２８による腰部３の絶
対座標系Ｃfにおける加速度a0＝T(a0x，a0z）とのベク
トル和を求めることにより、絶対座標系Ｃfにおける大
腿部９及び下腿部１１のそれぞれの加速度（より詳しく
は、該加速度の絶対座標系Ｃfにおける座標成分）が求
められる。
【００８８】また、前記脚体各部角加速度算出手段３６
の処理では、前記サイクルタイム毎に前記脚体姿勢算出
手段２９により求められる各脚体２の大腿部９及び下腿
部１１のそれぞれの傾斜角度θc，θdの時系列データを
用いて、該大腿部９及び下腿部１１のそれぞれ傾斜角度
θc，θdの２階微分値、すなわち、大腿部９及び下腿部
１１のそれぞれの角加速度が求められる。
の処理では、前記サイクルタイム毎に前記脚体姿勢算出
手段２９により求められる各脚体２の大腿部９及び下腿
部１１のそれぞれの傾斜角度θc，θdの時系列データを
用いて、該大腿部９及び下腿部１１のそれぞれ傾斜角度
θc，θdの２階微分値、すなわち、大腿部９及び下腿部
１１のそれぞれの角加速度が求められる。
【００８９】また、床反力作用点推定手段３７の処理で
は、接地している脚体２について、例えば前記脚体姿勢
算出手段２９により算出された大腿部９の傾斜角度θc
の今回値から、図７及び図８に示すようにあらかじめ定
められた相関データに基づいて該脚体２の足首部１２か
ら、該脚体２の足平部１３の床反力作用点（足平部１３
の接地箇所に作用する全床反力が集中するとみなせる
点）へのベクトル（足首部１２に対する床反力作用点の
位置ベクトル。以下、床反力作用点ベクトルという）を
該床反力作用点の位置を表すデータとして求める。
は、接地している脚体２について、例えば前記脚体姿勢
算出手段２９により算出された大腿部９の傾斜角度θc
の今回値から、図７及び図８に示すようにあらかじめ定
められた相関データに基づいて該脚体２の足首部１２か
ら、該脚体２の足平部１３の床反力作用点（足平部１３
の接地箇所に作用する全床反力が集中するとみなせる
点）へのベクトル（足首部１２に対する床反力作用点の
位置ベクトル。以下、床反力作用点ベクトルという）を
該床反力作用点の位置を表すデータとして求める。
【００９０】すなわち、本願発明者等の知見によれば、
接地している脚体２の大腿部９や下腿部１１の傾斜角度
θc，θdは、床反力作用点と比較的顕著な相関性を有
し、例えば大腿部９の傾斜角度θcに対して、前記床反
力作用点ベクトル、詳しくは、人間１の進行方向（Ｘ軸
方向）における該床反力作用点ベクトルの成分と、鉛直
方向（Ｚ軸方向）における該床反力作用点ベクトルの成
分は、それぞれ図７、図８に示すように変化する。ここ
で、大腿部９の負の傾斜角度θcは、脚体２が人間１の
後側に延びているとき（例えば図２の人間１の前方に向
かって右側の脚体２）の傾斜角度であり、正の傾斜角度
θcは、脚体２が人間１の前側に存するとき（例えば図
２の人間１の前方に向かって左側の脚体２）の傾斜角度
である。
接地している脚体２の大腿部９や下腿部１１の傾斜角度
θc，θdは、床反力作用点と比較的顕著な相関性を有
し、例えば大腿部９の傾斜角度θcに対して、前記床反
力作用点ベクトル、詳しくは、人間１の進行方向（Ｘ軸
方向）における該床反力作用点ベクトルの成分と、鉛直
方向（Ｚ軸方向）における該床反力作用点ベクトルの成
分は、それぞれ図７、図８に示すように変化する。ここ
で、大腿部９の負の傾斜角度θcは、脚体２が人間１の
後側に延びているとき（例えば図２の人間１の前方に向
かって右側の脚体２）の傾斜角度であり、正の傾斜角度
θcは、脚体２が人間１の前側に存するとき（例えば図
２の人間１の前方に向かって左側の脚体２）の傾斜角度
である。
【００９１】そこで、本実施形態では、図７及び図８の
相関データがあらかじめデータテーブルや、それらの相
関データをそれぞれ近似する多項式関数の形態で、演算
処理装置１６にあらかじめ記憶保持されている。そし
て、前記床反力作用点推定手段３７の処理では、前記脚
体姿勢算出手段２９により算出された大腿部９の傾斜角
度θcの今回値から、上記の相関データに基づいて、前
記床反力作用点ベクトル（詳しくは該床反力作用点ベク
トルのＸ軸方向、Ｚ軸方向の成分）が求められる。
相関データがあらかじめデータテーブルや、それらの相
関データをそれぞれ近似する多項式関数の形態で、演算
処理装置１６にあらかじめ記憶保持されている。そし
て、前記床反力作用点推定手段３７の処理では、前記脚
体姿勢算出手段２９により算出された大腿部９の傾斜角
度θcの今回値から、上記の相関データに基づいて、前
記床反力作用点ベクトル（詳しくは該床反力作用点ベク
トルのＸ軸方向、Ｚ軸方向の成分）が求められる。
【００９２】尚、床反力作用点の位置は、接地している
脚体２の大腿部９と下腿部１１の相対角度（膝関節１０
の屈曲角度）との相関性もあり、大腿部９の傾斜角度θ
cの代わりに、上記相対角度から、床反力作用点の位置
を推定するようにしてもよく、あるいは、大腿部９の傾
斜角度θc及び上記相対角度の両者を用いて、マップ等
により床反力作用点の位置を推定するようにしてもよ
い。
脚体２の大腿部９と下腿部１１の相対角度（膝関節１０
の屈曲角度）との相関性もあり、大腿部９の傾斜角度θ
cの代わりに、上記相対角度から、床反力作用点の位置
を推定するようにしてもよく、あるいは、大腿部９の傾
斜角度θc及び上記相対角度の両者を用いて、マップ等
により床反力作用点の位置を推定するようにしてもよ
い。
【００９３】次に、演算処理装置１６は、前記関節モー
メント推定手段３９の処理を実行して、各脚体２の膝関
節１０及び股関節８に作用するモーメントを求める。こ
の処理は、前記床反力推定手段３８、脚体各部加速度算
出手段３５、脚体各部角加速度算出手段３６、床反力作
用点推定手段３７、及び脚体姿勢算出手段２９によりそ
れぞれ求められたデータの今回値を用いて、所謂逆動力
学モデルに基づいて行われる。この逆動力学モデルは、
人間１の各剛体相当部の並進運動に関する運動方程式と
回転運動に関する運動方程式とを用いて、床反力作用点
により近い関節から順番に該関節に作用するモーメント
を求めるものであり、本実施形態では、各脚体２の膝関
節１０、股関節８に作用するモーメントが順番に求めら
れる。
メント推定手段３９の処理を実行して、各脚体２の膝関
節１０及び股関節８に作用するモーメントを求める。こ
の処理は、前記床反力推定手段３８、脚体各部加速度算
出手段３５、脚体各部角加速度算出手段３６、床反力作
用点推定手段３７、及び脚体姿勢算出手段２９によりそ
れぞれ求められたデータの今回値を用いて、所謂逆動力
学モデルに基づいて行われる。この逆動力学モデルは、
人間１の各剛体相当部の並進運動に関する運動方程式と
回転運動に関する運動方程式とを用いて、床反力作用点
により近い関節から順番に該関節に作用するモーメント
を求めるものであり、本実施形態では、各脚体２の膝関
節１０、股関節８に作用するモーメントが順番に求めら
れる。
【００９４】さらに詳細には、図９を参照して、まず、
各脚体２の下腿部１１に関し、下腿部１１の先端部の足
首部１２に作用する力（関節反力）、下腿部１１の膝関
節１０の部分に作用する力（関節反力）、及び下腿部１
１の重心G2の並進加速度を、それぞれ絶対座標系Ｃfに
おける成分表記によって、T(Ｆ1x，Ｆ1z)、T(Ｆ2x，Ｆ 2
z)、T(a2x，a2z)とし、該下腿部１１の重量をm2とす
る。このとき、下腿部１１の重心G2の並進運動に関する
運動方程式は、次式（１０）となる。
各脚体２の下腿部１１に関し、下腿部１１の先端部の足
首部１２に作用する力（関節反力）、下腿部１１の膝関
節１０の部分に作用する力（関節反力）、及び下腿部１
１の重心G2の並進加速度を、それぞれ絶対座標系Ｃfに
おける成分表記によって、T(Ｆ1x，Ｆ1z)、T(Ｆ2x，Ｆ 2
z)、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(a2
x，a2z)は、前記脚体各部加速度算出手段３５により求
められるものである。また、下腿部１１の先端部の足首
部１２に作用する関節反力T(Ｆ1x，Ｆ1z)は、近似的に
は、該下腿部１１を有する脚体２について前記床反力推
定手段３８により求められる床反力の推定値に等しい。
より詳しくは、単脚支持状態において、該脚体２が接地
しているときには、関節反力T(Ｆ1x，Ｆ1z)は、前記式
（２）により求められる全床反力T(Fx，Fz）であり、該
脚体２が遊脚側の脚体であるときには、T(Ｆ1x，Ｆ1z)
＝T(０，０)である。また、両脚支持状態において、該
脚体２が人間１の進行方向前方に向かって後側の脚体で
あるときには、関節反力T(Ｆ1x，Ｆ1z)は前記後側脚体
の床反力T(Frx，Frz）であり、該脚体２が前側の脚体で
あるときには、前記前側脚体の床反力T(Ffx，Ffz）であ
る。
x，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(a
2x，a2z)のデータと、床反力推定手段３８により求めら
れる床反力（＝T(Ｆ1x，Ｆ1z)）のデータと、下腿部１
１のあらかじめ求められた重量m2のデータと、重力加速
度ｇの値とから、上記式（１０）により求められる。
関節反力T(Ｆ2x，Ｆ2z)は、脚体各部加速度算出手段３
５により求められた下腿部１１の重心G2の加速度T(a
2x，a2z)のデータと、床反力推定手段３８により求めら
れる床反力（＝T(Ｆ1x，Ｆ1z)）のデータと、下腿部１
１のあらかじめ求められた重量m2のデータと、重力加速
度ｇの値とから、上記式（１０）により求められる。
【００９８】また、図９を参照して、下腿部１１の先端
部の足首部１２に作用するモーメントをＭ1、下腿部１
１の膝関節１０の部分に作用するモーメントをＭ2、下
腿部１１の重心G2の回りの慣性モーメントをIG2、下腿
部１１の重心G2の回りの角加速度をα2とする。また、
前記図４に対応させて、下腿部１１の重心G2と膝関節１
０の中心との間の距離をd2、下腿部１１の重心G2と足首
部１２との間の距離をd2’（＝Dd−d2）とすると、下腿
部１１の重心G2の回りの回転運動に関する運動方程式
は、次式（１１）となる。
部の足首部１２に作用するモーメントをＭ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やサイズのデータ等と共に、あらかじめ求めら
れて演算処理装置１６に記憶されるものである。
１）に係わる下腿部１１を有する脚体２について前記床
反力作用点推定手段３７により求められる床反力作用点
ベクトルと、該脚体２について前記床反力推定手段３８
により求められる床反力ベクトルとの外積（ベクトル
積）として得られるモーメントである。また、α2は、
前記脚体各部角加速度算出手段３４により求められる下
腿部１１の角加速度である。また、θdは前記脚体姿勢
算出手段２９により求められる下腿部１１の傾斜角度で
ある。また、T(Ｆ1x，Ｆ1z)は、前述の通り、床反力推
定手段３８により求められる床反力の推定値である。さ
らに、T(F2x，F2z)は、前記式（１０）により求められ
るものである。また、慣性モーメントIG2は下腿部１１
の重量m2やサイズのデータ等と共に、あらかじめ求めら
れて演算処理装置１６に記憶されるものである。
【０１０１】従って、膝関節１０に作用するモーメント
M2は、床反力推定手段３８による床反力の推定値のデー
タと、床反力作用点推定手段３７による床反力作用点ベ
クトルのデータと、脚体各部角加速度算出手段３６によ
る下腿部１１の角加速度α2のデータと、脚体姿勢算出
手段２９による下腿部１１の傾斜角度θdのデータと、
前記式（１０）により求められた関節反力T(F2x，F2z)
のデータと、あらかじめ求めた下腿部１１の慣性モーメ
ントIG2、サイズ（Dd）、重心G2の位置(d2)のデータと
から前記式（１１）により求められる。
M2は、床反力推定手段３８による床反力の推定値のデー
タと、床反力作用点推定手段３７による床反力作用点ベ
クトルのデータと、脚体各部角加速度算出手段３６によ
る下腿部１１の角加速度α2のデータと、脚体姿勢算出
手段２９による下腿部１１の傾斜角度θdのデータと、
前記式（１０）により求められた関節反力T(F2x，F2z)
のデータと、あらかじめ求めた下腿部１１の慣性モーメ
ントIG2、サイズ（Dd）、重心G2の位置(d2)のデータと
から前記式（１１）により求められる。
【０１０２】関節モーメント推定手段３９は、上記のよ
うにして下腿部１１の膝関節１０の部分に作用するモー
メントM2を求めた後、その算出処理と同様の処理によっ
て、大腿部９の股関節８の部分に作用するモーメントを
求める。この処理の基本的な考え方は、膝関節１０のモ
ーメントM2を求める手法と同一であるので、詳細な図示
及び説明は省略するが、その概要は次の通りである。
うにして下腿部１１の膝関節１０の部分に作用するモー
メントM2を求めた後、その算出処理と同様の処理によっ
て、大腿部９の股関節８の部分に作用するモーメントを
求める。この処理の基本的な考え方は、膝関節１０のモ
ーメントM2を求める手法と同一であるので、詳細な図示
及び説明は省略するが、その概要は次の通りである。
【０１０３】すなわち、まず、大腿部９の重心G1（図５
参照）の並進運動に関する運動方程式に基づく次式（１
２）（前記式（１０）と同じ形の式）により、大腿部９
の股関節８の部分に作用する関節反力T(F3x，F3z)が求
められる。
参照）の並進運動に関する運動方程式に基づく次式（１
２）（前記式（１０）と同じ形の式）により、大腿部９
の股関節８の部分に作用する関節反力T(F3x，F3z)が求
められる。
【０１０４】
T(Ｆ3x，Ｆ3z)＝T(Ｆ2x−m1・a1x，Ｆ2z−m1・a1z−m1・ｇ)
……（１２）
【０１０５】ここで、T(Ｆ2x，Ｆ2z)は、先に前記式
（１０）により求めた膝関節１０の関節反力である。ま
た、T(a1x，a1z)は、前記脚体各部加速度算出手段３５
により求められる大腿部９の重心G1の絶対座標系Ｃfに
おける加速度（並進加速度）である。また、m1はあらか
じめ求めた大腿部９の重量、ｇは重力加速度である。
（１０）により求めた膝関節１０の関節反力である。ま
た、T(a1x，a1z)は、前記脚体各部加速度算出手段３５
により求められる大腿部９の重心G1の絶対座標系Ｃfに
おける加速度（並進加速度）である。また、m1はあらか
じめ求めた大腿部９の重量、ｇは重力加速度である。
【０１０６】次いで、大腿部９の重心G1の回りの回転運
動に関する運動方程式に基づく次式（１３）（前記式
（１１）と同じ形の式）により、大腿部９の股関節８の
部分に作用するモーメントM3が求められる。
動に関する運動方程式に基づく次式（１３）（前記式
（１１）と同じ形の式）により、大腿部９の股関節８の
部分に作用するモーメント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までの距離（図５参照）、d
1’は、膝関節１０の中心から大腿部９の重心G1までの
距離（図５ではDc−d1）であり、これらは、あらかじめ
求めた重心G1の位置や大腿部９のサイズ（長さ）から定
まるものである。
られた膝関節１０のモーメント、T(Ｆ2x，Ｆ2z)は、前
記式（１０）により求められた膝関節１０の関節反力、
T(Ｆ3x，Ｆ3z)は、前記式（１２）により求められた股
関節８の関節反力、IG1は、あらかじめ求めた大腿部９
の重心G1の回りの慣性モーメント、α1は前記脚体各部
角加速度算出手段３６により求められる大腿部９の角加
速度、θcは前記脚体姿勢算出手段２９により求められ
る大腿部９の傾斜角度である。また、d1は、股関節８の
中心から大腿部９の重心G1までの距離（図５参照）、d
1’は、膝関節１０の中心から大腿部９の重心G1までの
距離（図５ではDc−d1）であり、これらは、あらかじめ
求めた重心G1の位置や大腿部９のサイズ（長さ）から定
まるものである。
【０１０９】以上説明した処理が、前記演算処理装置１
６のサイクルタイム毎に逐次実行され、各脚体２に作用
する床反力や、各脚体２の膝関節１０及び股関節８に作
用するモーメントが逐次リアルタイムで推定される。
６のサイクルタイム毎に逐次実行され、各脚体２に作用
する床反力や、各脚体２の膝関節１０及び股関節８に作
用するモーメントが逐次リアルタイムで推定される。
【０１１０】尚、本明細書での詳細な説明は省略する
が、求められた膝関節１０や股関節８のモーメントの推
定値は、例えば人間１の歩行を補助する装置（膝関節１
０や股関節８に補助トルクを付与可能な電動モータ等を
含む装置）の制御に用いられる。
が、求められた膝関節１０や股関節８のモーメントの推
定値は、例えば人間１の歩行を補助する装置（膝関節１
０や股関節８に補助トルクを付与可能な電動モータ等を
含む装置）の制御に用いられる。
【０１１１】前述した演算処理装置１６の処理により求
められた床反力の推定値（詳しくは、該床反力の推定値
の絶対値）の経時変化の様子を図１０に実線で例示す
る。また、演算処理装置１６の処理により求められた膝
関節１０及び股関節８のモーメントの推定値の経時変化
の様子を図１１に実線で例示する。ここで、図１０及び
図１１は、人間１が平地をほぼ一定速度で歩行した場合
の例示である。この場合、図１０では、フォースメータ
等を用いて床反力を実測した比較例（床反力の真値に相
当するもの）が仮想線で併記されている。また、図１１
ではトルクメータ等を用いて膝関節１０及び股関節８の
モーメントを実測した比較例（膝関節１０及び股関節８
のモーメントの真値に相当するもの）が仮想線で併記さ
れている。
められた床反力の推定値（詳しくは、該床反力の推定値
の絶対値）の経時変化の様子を図１０に実線で例示す
る。また、演算処理装置１６の処理により求められた膝
関節１０及び股関節８のモーメントの推定値の経時変化
の様子を図１１に実線で例示する。ここで、図１０及び
図１１は、人間１が平地をほぼ一定速度で歩行した場合
の例示である。この場合、図１０では、フォースメータ
等を用いて床反力を実測した比較例（床反力の真値に相
当するもの）が仮想線で併記されている。また、図１１
ではトルクメータ等を用いて膝関節１０及び股関節８の
モーメントを実測した比較例（膝関節１０及び股関節８
のモーメントの真値に相当するもの）が仮想線で併記さ
れている。
【０１１２】図１０を参照して明らかなように、本実施
形態によれば精度のよい床反力の推定値が得られている
ことが判る。また、本実施形態ではこの床反力の推定値
を用いることによって、図１１に示されるように、膝関
節１０や股関節８のモーメントも比較的精度よく推定す
ることができる。
形態によれば精度のよい床反力の推定値が得られている
ことが判る。また、本実施形態ではこの床反力の推定値
を用いることによって、図１１に示されるように、膝関
節１０や股関節８のモーメントも比較的精度よく推定す
ることができる。
【０１１３】以上のように、本実施形態によれば、脚体
２に人間１の歩行の邪魔となったり、脚体２の運動に負
担がかかるようなセンサを装着したりすることなく、股
関節８や股関節８に装着した角度センサ２２，２３や、
胴体５に装備したジャイロセンサ１４，１９及び加速度
センサ１５，２０，２１や、履き物等に装備する加速度
センサ２４というような比較的小型で軽量なセンサを用
いて各脚体２に作用する床反力や、各脚体２の股関節８
及び膝関節１０に作用するモーメントをリアルタイムで
容易に推定することができる。
２に人間１の歩行の邪魔となったり、脚体２の運動に負
担がかかるようなセンサを装着したりすることなく、股
関節８や股関節８に装着した角度センサ２２，２３や、
胴体５に装備したジャイロセンサ１４，１９及び加速度
センサ１５，２０，２１や、履き物等に装備する加速度
センサ２４というような比較的小型で軽量なセンサを用
いて各脚体２に作用する床反力や、各脚体２の股関節８
及び膝関節１０に作用するモーメントをリアルタイムで
容易に推定することができる。
【０１１４】また、前記実施形態では、本発明を人間１
に適用した場合を例にとって説明したが、二足歩行移動
体としての二足歩行ロボットにも本発明を適用すること
ができる。ここで、二足歩行ロボットでは、腰部と胸部
とが一体的な構造となっている場合があるが、この場合
には、ジャイロセンサや前後方向の加速度センサを腰部
及び胸部のいずれか一方だけに取り付けて、床反力や脚
体の関節のモーメントを本実施形態と同様に推定するよ
うにすることも可能である。また、二足歩行ロボットで
は、股関節や膝関節の屈曲角度は、それらの関節のアク
チュエータに対する制御装置の制御量により把握するよ
うにすることも可能である。
に適用した場合を例にとって説明したが、二足歩行移動
体としての二足歩行ロボットにも本発明を適用すること
ができる。ここで、二足歩行ロボットでは、腰部と胸部
とが一体的な構造となっている場合があるが、この場合
には、ジャイロセンサや前後方向の加速度センサを腰部
及び胸部のいずれか一方だけに取り付けて、床反力や脚
体の関節のモーメントを本実施形態と同様に推定するよ
うにすることも可能である。また、二足歩行ロボットで
は、股関節や膝関節の屈曲角度は、それらの関節のアク
チュエータに対する制御装置の制御量により把握するよ
うにすることも可能である。
【０１１５】また、前記実施形態では、脚体２の運動状
態を判断するために、腰部上下加速度センサ２１の検出
データをそのまま用いたが、該検出データの代わりに、
例えば前記基準加速度計測手段２８により求められる絶
対座標系Ｃfでの腰部３の加速度ａ0の鉛直方向（Ｚ軸方
向）の成分の値を用いるようにしても良い。
態を判断するために、腰部上下加速度センサ２１の検出
データをそのまま用いたが、該検出データの代わりに、
例えば前記基準加速度計測手段２８により求められる絶
対座標系Ｃfでの腰部３の加速度ａ0の鉛直方向（Ｚ軸方
向）の成分の値を用いるようにしても良い。
【０１１６】ところで、前記実施形態では、両脚支持状
態における前側と後側の各脚体２に作用する床反力の進
行方向成分Ｆfx，Ｆrxの推定値を上記先願と同様の手法
で求めるようにしたが、後側脚体に作用する床反力の進
行方向成分の、両脚支持状態の経過時間及び二足歩行移
動体の移動速度に対する変化の特性を表すものとしてあ
らかじめ定めた特性データに基づき、後側脚体に作用す
る床反力の進行方向成分Ｆrxの推定値を逐次求めると共
に、このＦrxを全床反力の進行方向成分Ｆxの推定値か
ら差し引くことにより、前側脚体に作用する床反力の進
行方向成分Ｆfxの推定値を逐次求めることも可能であ
る。
態における前側と後側の各脚体２に作用する床反力の進
行方向成分Ｆfx，Ｆrxの推定値を上記先願と同様の手法
で求めるようにしたが、後側脚体に作用する床反力の進
行方向成分の、両脚支持状態の経過時間及び二足歩行移
動体の移動速度に対する変化の特性を表すものとしてあ
らかじめ定めた特性データに基づき、後側脚体に作用す
る床反力の進行方向成分Ｆrxの推定値を逐次求めると共
に、このＦrxを全床反力の進行方向成分Ｆxの推定値か
ら差し引くことにより、前側脚体に作用する床反力の進
行方向成分Ｆfxの推定値を逐次求めることも可能であ
る。
【０１１７】以下、このような手法で各脚体２に作用す
る床反力の進行方向成分Ｆfx，Ｆrxの推定値を求める第
２の実施形態について説明する。第２実施形態では、演
算処理装置１６に、図１２に示す如く、前記第１実施形
態の足首位置算出手段３２に代えて、脚体運動判断手段
２５により両脚支持状態の開始（単脚支持状態の終了）
が把握される毎に、その両脚支持状態の開始時からの経
過時間を計時する計時手段４２と、脚体運動判断手段２
５により両脚支持状態の開始（単脚支持状態の終了）が
把握される毎に、前記脚体姿勢算出手段２９による各脚
体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θ
c，θdのデータと前記計時手段４２の計時データとを用
いて人間１の移動速度を推定する移動速度推定手段４３
と、この移動速度推定手段４３により求められた移動速
度のデータから両脚支持状態の開始時から終了時までの
時間（両脚支持状態の継続時間。以下、両脚支持期間と
いう）を推定する両脚支持期間推定手段４４とを設け
る。
る床反力の進行方向成分Ｆfx，Ｆrxの推定値を求める第
２の実施形態について説明する。第２実施形態では、演
算処理装置１６に、図１２に示す如く、前記第１実施形
態の足首位置算出手段３２に代えて、脚体運動判断手段
２５により両脚支持状態の開始（単脚支持状態の終了）
が把握される毎に、その両脚支持状態の開始時からの経
過時間を計時する計時手段４２と、脚体運動判断手段２
５により両脚支持状態の開始（単脚支持状態の終了）が
把握される毎に、前記脚体姿勢算出手段２９による各脚
体２の大腿部９及び下腿部１１のそれぞれの傾斜角度θ
c，θdのデータと前記計時手段４２の計時データとを用
いて人間１の移動速度を推定する移動速度推定手段４３
と、この移動速度推定手段４３により求められた移動速
度のデータから両脚支持状態の開始時から終了時までの
時間（両脚支持状態の継続時間。以下、両脚支持期間と
いう）を推定する両脚支持期間推定手段４４とを設け
る。
【０１１８】そして、脚体運動判断手段２５の処理で
は、第１実施形態のものと同様に腰部上下加速度センサ
２１による腰部３の上向き方向の加速度の検出データに
基づいて両脚支持状態の開始が把握されると、該両脚支
持状態の開始時点から前記計時手段４２により計測され
る経過時間が、該両脚支持状態の開始時点で前記両脚支
持期間推定手段４４により後述するように求められる両
脚支持期間（両脚支持状態の開始時から終了時までの該
両脚支持状態の継続時間）の推定値に達したか否かがサ
イクルタイム毎に逐次監視される。そして、脚体運動判
断手段２５は、該経過時間が両脚支持期間の推定値に達
した時に、両脚支持状態が終了し、且つ、単脚支持状態
が開始すると判断する。
は、第１実施形態のものと同様に腰部上下加速度センサ
２１による腰部３の上向き方向の加速度の検出データに
基づいて両脚支持状態の開始が把握されると、該両脚支
持状態の開始時点から前記計時手段４２により計測され
る経過時間が、該両脚支持状態の開始時点で前記両脚支
持期間推定手段４４により後述するように求められる両
脚支持期間（両脚支持状態の開始時から終了時までの該
両脚支持状態の継続時間）の推定値に達したか否かがサ
イクルタイム毎に逐次監視される。そして、脚体運動判
断手段２５は、該経過時間が両脚支持期間の推定値に達
した時に、両脚支持状態が終了し、且つ、単脚支持状態
が開始すると判断する。
【０１１９】このように脚体運動判断手段２５の処理が
実行され、また、脚体姿勢算出手段２９による処理が第
１実施形態のものと同様に実行された後、演算処理装置
１６は、前記移動速度推定手段４３の処理及び両脚支持
期間推定手段４４の処理を順次実行する。
実行され、また、脚体姿勢算出手段２９による処理が第
１実施形態のものと同様に実行された後、演算処理装置
１６は、前記移動速度推定手段４３の処理及び両脚支持
期間推定手段４４の処理を順次実行する。
【０１２０】移動速度推定手段４３による処理は次のよ
うに行われる。すなわち、図１３を参照して、人間１の
歩行時に、時刻t1において実線で示す人間１の前側の脚
体２（図では人間１の前方に向かって右側の脚体２）が
着床して両脚支持状態が開始し、時刻t2において仮想線
示の人間１で表すように、次の両脚支持状態が開始した
場合（時刻t1で人間１の後側の脚体２が離床後に時刻t2
で着床した場合）を想定する。このとき、時刻t1から時
刻t2までの人間１の移動距離Ｌは、絶対座標系ＣfのＸ
軸方向（人間１の進行方向）における腰部３の股関節８
の中心の移動距離（これは、本実施形態では、身体座標
系Ｃpの原点ＯのＸ軸方向の移動量に等しい）である。
うに行われる。すなわち、図１３を参照して、人間１の
歩行時に、時刻t1において実線で示す人間１の前側の脚
体２（図では人間１の前方に向かって右側の脚体２）が
着床して両脚支持状態が開始し、時刻t2において仮想線
示の人間１で表すように、次の両脚支持状態が開始した
場合（時刻t1で人間１の後側の脚体２が離床後に時刻t2
で着床した場合）を想定する。このとき、時刻t1から時
刻t2までの人間１の移動距離Ｌは、絶対座標系ＣfのＸ
軸方向（人間１の進行方向）における腰部３の股関節８
の中心の移動距離（これは、本実施形態では、身体座標
系Ｃpの原点ＯのＸ軸方向の移動量に等しい）である。
【０１２１】そして、この移動距離Ｌは、時刻t1におけ
る股関節８の中心から人間１の前側の脚体２の足首部１
２までのＸ軸方向の距離ΔL1と、時刻t2における股関節
８の中心から人間１の後側の脚体２（これは時刻t1で人
間１の前側にあった脚体２である）の足首部１２までの
Ｘ軸方向の距離ΔL2との総和にほぼ一致する。
る股関節８の中心から人間１の前側の脚体２の足首部１
２までのＸ軸方向の距離ΔL1と、時刻t2における股関節
８の中心から人間１の後側の脚体２（これは時刻t1で人
間１の前側にあった脚体２である）の足首部１２までの
Ｘ軸方向の距離ΔL2との総和にほぼ一致する。
【０１２２】従って、上記距離ΔL1，ΔL2と、時刻t1か
ら時刻t2までの経過時間（t2−t1）、すなわち、両脚支
持状態が開始してから次に両脚支持状態が開始するまで
の１歩分の経過時間を把握することによって、それらの
距離ΔL1，ΔL2と、該１歩分経過時間（t2−t1）とを用
いて次式（１４）により時刻t1からt2までの人間１の移
動速度Ｖ（時刻t1から時刻t2までの平均移動速度）を求
めることができる。
ら時刻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とが以下に説明するように求められ、それらの距
離ΔL1，ΔL2の算出値が記憶保持される。そして、今回
の両脚支持状態の開始時に求められた後側の脚体２に係
わる距離ΔL2と、前回の両脚支持状態の開始時に求めら
れた前側の脚体２に係わる距離ΔL1と、前回の両脚支持
状態の開始時から今回の両脚支持状態の開始時までに前
記計時手段４２により計測された時間（＝t2−t1）とか
ら前記式（１４）により人間１の移動速度Ｖを求める。
【０１２５】この場合、上記距離ΔL1，ΔL2は次によう
に求められる。すなわち、両脚支持状態の開始時におけ
る人間１の前側の脚体２については、該両脚支持状態の
開始時（脚体運動判断手段２５により両脚支持状態の開
始が把握されたサイクルタイム）に前記脚体姿勢算出手
段２９により求められる大腿部９及び下腿部１１のそれ
ぞれの傾斜角度をθc1、θd1（図１３の時刻t1の図を参
照）とする。このとき、該脚体２に係わる距離ΔL1は、
これらの傾斜角度θc1，θd1（θc1＞０，θd1＞０）の
データと、大腿部９及び下腿部１１のそれぞれの長さD
c，Ddのデータとを用いて、次式（１５）により算出さ
れる。
に求められる。すなわち、両脚支持状態の開始時におけ
る人間１の前側の脚体２については、該両脚支持状態の
開始時（脚体運動判断手段２５により両脚支持状態の開
始が把握されたサイクルタイム）に前記脚体姿勢算出手
段２９により求められる大腿部９及び下腿部１１のそれ
ぞれの傾斜角度をθc1、θd1（図１３の時刻t1の図を参
照）とする。このとき、該脚体２に係わる距離ΔL1は、
これらの傾斜角度θc1，θd1（θc1＞０，θd1＞０）の
データと、大腿部９及び下腿部１１のそれぞれの長さD
c，Ddのデータとを用いて、次式（１５）により算出さ
れる。
【０１２６】
ΔL1＝Dc・sinθc1＋Dd・sinθd1 ……（１５）
【０１２７】同様に、両脚支持状態の開始時における人
間１の後側の脚体２については、該両脚支持状態の開始
時に前記脚体姿勢算出手段２９により求められる大腿部
９及び下腿部１１のそれぞれの傾斜角度をθc2、θd2
（図１３の時刻t2の図を参照）とすると、該脚体２に係
わる距離ΔL2は、これらの傾斜角度θc2，θd2（θc2＜
０，θd2＜０）のデータと、大腿部９及び下腿部１１の
それぞれの長さDc，Ddのデータとを用いて、次式（１
６）により算出される。
間１の後側の脚体２については、該両脚支持状態の開始
時に前記脚体姿勢算出手段２９により求められる大腿部
９及び下腿部１１のそれぞれの傾斜角度をθ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)の推定
値がそのまま接地している単一の脚体２に作用する床反
力の推定値として求められることとなる。
形態と同様に身体重心加速度算出手段３４により求めら
れた身体重心G0の加速度T(ａx，ａz)のデータと、人間
１の重量Ｍのデータとから、前記式（２）により、全床
反力Ｆ＝T(Ｆx，Ｆz)の推定値が前記サイクルイタイム
毎に逐次求められる。この場合、脚体運動判断手段２５
により把握されている脚体２の運動状態が単脚支持状態
である場合には、上記全床反力Ｆ＝T(Ｆx，Ｆz)の推定
値がそのまま接地している単一の脚体２に作用する床反
力の推定値として求められることとなる。
【０１３３】一方、脚体運動判断手段２５により把握さ
れている脚体２の運動状態が両脚支持状態である場合に
は、床反力推定手段３８は、図６の相関関係に基づき、
第１実施形態と同様に後側脚体２に作用する床反力の鉛
直方向成分Ｆrzの推定値を前側脚体２のＭＰ高さＨを用
いて求め、このＦrzを全床反力の鉛直方向成分Ｆzから
差し引いて、前側脚体２に作用する床反力の鉛直方向成
分Ｆfzの推定値を求める。
れている脚体２の運動状態が両脚支持状態である場合に
は、床反力推定手段３８は、図６の相関関係に基づき、
第１実施形態と同様に後側脚体２に作用する床反力の鉛
直方向成分Ｆrzの推定値を前側脚体２のＭＰ高さＨを用
いて求め、このＦrzを全床反力の鉛直方向成分Ｆzから
差し引いて、前側脚体２に作用する床反力の鉛直方向成
分Ｆfzの推定値を求める。
【０１３４】また、前側と後側の各脚体２に作用する床
反力の進行方向成分Ｆfx，Ｆrxの推定値は以下の如く求
められる。すなわち、本願発明者等の知見によれば、両
脚支持状態で後側脚体２に作用する床反力の進行方向成
分Ｆrxの、該両脚支持状態の開始時における全床反力の
進行方向成分Ｆxに対する割合（以下、床反力比とい
う）と、該両脚支持状態の開始時からの経過時間の前記
両脚支持期間に対する割合（＝経過時間／両脚支持期
間。以下、両脚支持時間比とい）との関係に着目したと
き、それらの間には特徴的な相関性があり、この相関性
は、人間１の移動速度Ｖ等の影響をほとんど受けない。
反力の進行方向成分Ｆfx，Ｆrxの推定値は以下の如く求
められる。すなわち、本願発明者等の知見によれば、両
脚支持状態で後側脚体２に作用する床反力の進行方向成
分Ｆrxの、該両脚支持状態の開始時における全床反力の
進行方向成分Ｆxに対する割合（以下、床反力比とい
う）と、該両脚支持状態の開始時からの経過時間の前記
両脚支持期間に対する割合（＝経過時間／両脚支持期
間。以下、両脚支持時間比とい）との関係に着目したと
き、それらの間には特徴的な相関性があり、この相関性
は、人間１の移動速度Ｖ等の影響をほとんど受けない。
【０１３５】具体的には、後側脚体２に作用する床反力
の進行方向成分成分Ｆrxの、両脚支持状態の開始時にお
ける全床反力の進行方向成分Ｆx（以下、参照符号Ｆxs
により表す）に対する割合である床反力比Ｆrx／Ｆxs
は、人間１の移動速度Ｖ等によらずに、前記両脚支持時
間比に対して図１５に示すようなほぼ一定の相関関係を
有し、両脚支持状態の時間の経過に伴い、一旦、「１」
から増加した後、「０」まで減少していく。
の進行方向成分成分Ｆrxの、両脚支持状態の開始時にお
ける全床反力の進行方向成分Ｆx（以下、参照符号Ｆxs
により表す）に対する割合である床反力比Ｆrx／Ｆxs
は、人間１の移動速度Ｖ等によらずに、前記両脚支持時
間比に対して図１５に示すようなほぼ一定の相関関係を
有し、両脚支持状態の時間の経過に伴い、一旦、「１」
から増加した後、「０」まで減少していく。
【０１３６】そこで、第２実施形態では、図１５の相関
データ（特性データ）があらかじめデータテーブルや、
それらの相関データをそれぞれ近似する多項式関数の形
態で、演算処理装置１６にあらかじめ記憶保持されてい
る。そして、計時手段４２による経過時間の計時データ
の今回値と、両脚支持期間推定手段４４により求められ
た両脚支持期間の推定値のデータの最新値とから前記両
脚支持時間比が前記サイクルタイム毎に逐次求められ
る。そして、この求めた両脚支持時間比のデータから図
１５の相関データに基づいて、床反力比Ｆrx／Ｆxsが逐
次求められ、この床反力比Ｆrx／Ｆxsに両脚支持状態の
開始時の全床反力の進行方向成分Ｆxsを乗算することに
より、後側脚体２に作用する床反力の進行方向成分Ｆrx
の推定値が求められ、このＦrxを全床反力の進行方向成
分Ｆxから差し引くことにより前側脚体２に作用する床
反力の進行方向成分Ｆfxの推定値が求められる。
データ（特性データ）があらかじめデータテーブルや、
それらの相関データをそれぞれ近似する多項式関数の形
態で、演算処理装置１６にあらかじめ記憶保持されてい
る。そして、計時手段４２による経過時間の計時データ
の今回値と、両脚支持期間推定手段４４により求められ
た両脚支持期間の推定値のデータの最新値とから前記両
脚支持時間比が前記サイクルタイム毎に逐次求められ
る。そして、この求めた両脚支持時間比のデータから図
１５の相関データに基づいて、床反力比Ｆrx／Ｆxsが逐
次求められ、この床反力比Ｆrx／Ｆxsに両脚支持状態の
開始時の全床反力の進行方向成分Ｆxsを乗算することに
より、後側脚体２に作用する床反力の進行方向成分Ｆrx
の推定値が求められ、このＦrxを全床反力の進行方向成
分Ｆxから差し引くことにより前側脚体２に作用する床
反力の進行方向成分Ｆfxの推定値が求められる。
【０１３７】このようにして各脚体２に作用する床反力
Ｆr＝T(Ｆrx，Ｆrz)，Ｆf＝T(Ｆfx，Ｆfz)を求めた後、
関節モーメント推定手段３９での処理により、第１実施
形態と同様に各脚体２の膝関節１０及び股関節８に作用
するモーメントが逐次リアルタイムで推定される。
Ｆr＝T(Ｆrx，Ｆrz)，Ｆf＝T(Ｆfx，Ｆfz)を求めた後、
関節モーメント推定手段３９での処理により、第１実施
形態と同様に各脚体２の膝関節１０及び股関節８に作用
するモーメントが逐次リアルタイムで推定される。
【０１３８】尚、履き物等に検出方向をＸ軸方向とした
一軸型の力センサを装備して、両脚支持状態における前
側と後側の各脚体２に作用する床反力の進行方向成分Ｆ
fx，Ｆrxを力センサにより計測することも可能である。
一軸型の力センサを装備して、両脚支持状態における前
側と後側の各脚体２に作用する床反力の進行方向成分Ｆ
fx，Ｆrxを力センサにより計測することも可能である。
【図１】先願の床反力推定方法の基本的原理を説明する
ための図。
ための図。
【図２】本発明の一実施形態における二足歩行移動体と
しての人間と該人間に装備する装置構成を模式化して示
す図。
しての人間と該人間に装備する装置構成を模式化して示
す図。
【図３】足平部の特定部位の床面からの位置（ＭＰ高
さ）の計測原理を説明するための図。
さ）の計測原理を説明するための図。
【図４】図２の装置に備える演算処理装置の機能を説明
するためのブロック図。
するためのブロック図。
【図５】図３の演算処理装置の処理に用いる剛体リンク
モデルを示す図。
モデルを示す図。
【図６】前側脚体のＭＰ高さと後側脚体に作用する床反
力の鉛直方向成分との相関関係を示す線図。
力の鉛直方向成分との相関関係を示す線図。
【図７】大腿部の傾斜角度と床反力作用点ベクトルの進
行方向成分との相関関係を示す線図。
行方向成分との相関関係を示す線図。
【図８】大腿部の傾斜角度と床反力作用点ベクトルの鉛
直方向成分との相関関係を示す線図。
直方向成分との相関関係を示す線図。
【図９】関節モーメントの計測原理を説明するための
図。
図。
【図１０】本発明の実施形態により求められた床反力の
推定値の経時変化の様子を例示するグラフ。
推定値の経時変化の様子を例示するグラフ。
【図１１】本発明の実施形態により求められた膝関節及
び股関節のモーメントの推定値の経時変化の様子を例示
するグラフ。
び股関節のモーメントの推定値の経時変化の様子を例示
するグラフ。
【図１２】本発明の第２の実施形態における演算処理装
置の機能を説明するためのブロック図。
置の機能を説明するためのブロック図。
【図１３】移動速度の推定原理を説明するための図。
【図１４】移動速度と両脚支持期間との相関関係をしめ
す線図。
す線図。
【図１５】両脚支持時間比と後側脚体に作用する床反力
の進行方向成分との相関関係を示す線図。
の進行方向成分との相関関係を示す線図。
１…人間（二足歩行移動体）、２…脚体、１３…足平
部、１３ｂ…中足趾節関節（特定部位）。
部、１３ｂ…中足趾節関節（特定部位）。
─────────────────────────────────────────────────────
フロントページの続き
Ｆターム(参考） 2F051 AB06 BA08 DA01
3C007 CS08 KS21 KS23 KS24 KX02
MT00 WA03 WA13
Claims (2)
- 【請求項１】二足歩行移動体の運動状態が該二足歩行移
動体の両脚体が接地している両脚支持状態であるときの
各脚体に作用する床反力の鉛直方向成分を推定する方法
であって、 前記二足歩行移動体の重心の位置を逐次求めつつ、該重
心の位置の時系列データを用いて床に対して固定された
絶対座標系での該重心の加速度を逐次求める第１ステッ
プと、前記二足歩行移動体の重量と重力加速度と前記重
心の加速度と各脚体に作用する床反力の合力である全床
反力とにより表される該重心の運動方程式に基づき、該
全床反力の推定値を逐次求める第２ステップと、前記両
脚支持状態において両脚体のうち少なくとも前記二足歩
行移動体の進行方向に向かって前側に存する前側脚体の
足平部のあらかじめ定めた特定部位の床面からの位置を
逐次求める第３ステップとを備え、 前記両脚支持状態であるときには、両脚体のうち該二足
歩行移動体の進行方向に向かって後側に存する後側脚体
に作用する床反力の鉛直方向成分と、前側脚体の足平部
の前記特定部位の床面からの位置との間に成立する所定
の相関関係に基づき、前記第３ステップで求めた前側脚
体の足平部の前記特定部位の床面からの位置を用いて後
側脚体に作用する床反力の鉛直方向成分の推定値を逐次
求め、その求めた後側脚体の床反力の鉛直方向成分の推
定値を前記第２ステップで求めた全床反力の鉛直方向成
分の推定値から差し引くことにより、前側脚体に作用す
る床反力の鉛直方向成分の推定値を逐次求めることを特
徴とする二足歩行移動体の床反力推定方法。 - 【請求項２】前記足平部の特定部位は、中足趾節関節で
あることを特徴とする請求項１記載の二足歩行移動体の
床反力推定方法。
Priority Applications (5)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002018789A JP4130739B2 (ja) | 2002-01-28 | 2002-01-28 | 二足歩行移動体の床反力推定方法 |
| US10/502,727 US7017395B2 (en) | 2002-01-28 | 2003-01-22 | Method of estimating floor reaction of bipedal movable body |
| DE60327307T DE60327307D1 (de) | 2002-01-28 | 2003-01-22 | Verfahren zur abschätzung von bodenreaktion von zweibeinigen beweglichen körpern |
| 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 true JP2003220583A (ja) | 2003-08-05 |
| JP4130739B2 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) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP7381709B2 (ja) | 2019-08-06 | 2023-11-15 | ボストン ダイナミクス，インコーポレイテッド | 足跡接触検出 |
Families Citing this family (9)
| 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 |
| EP2432392B1 (en) * | 2009-05-20 | 2017-03-08 | Koninklijke Philips N.V. | Sensing device for detecting a wearing position |
| KR101283464B1 (ko) * | 2009-09-29 | 2013-07-12 | 한국전자통신연구원 | 동작 인식용 신발을 이용한 동작 인식 시스템 |
| JP6414664B2 (ja) * | 2014-06-13 | 2018-10-31 | 国立大学法人 筑波大学 | 義肢装着式動作補助装置 |
| JP6228097B2 (ja) * | 2014-10-06 | 2017-11-08 | 本田技研工業株式会社 | 移動ロボット |
| JP6709281B2 (ja) * | 2016-05-18 | 2020-06-10 | 株式会社東芝 | 行動推定方法、行動推定システム、サービス提供方法、信号検出方法、信号検出部および信号処理システム |
| CN111374676B (zh) * | 2020-03-09 | 2022-10-11 | 南方科技大学 | 人体地面反力间接测量系统、测量方法、装置及控制器 |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE69943148D1 (de) * | 1998-04-20 | 2011-03-03 | Honda Motor Co Ltd | Steuereinheit für einen mit beinen beweglichen roboter |
| 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 | 本田技研工業株式会社 | 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 |
| JP3679105B2 (ja) * | 2001-12-28 | 2005-08-03 | 本田技研工業株式会社 | 脚式移動ロボットの歩容生成装置 |
| 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 EP EP03703015A patent/EP1481771B1/en not_active Expired - Fee Related
- 2003-01-22 US US10/502,727 patent/US7017395B2/en not_active Expired - Fee Related
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP7381709B2 (ja) | 2019-08-06 | 2023-11-15 | ボストン ダイナミクス，インコーポレイテッド | 足跡接触検出 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP4130739B2 (ja) | 2008-08-06 |
| WO2003064117A1 (fr) | 2003-08-07 |
| DE60327307D1 (de) | 2009-06-04 |
| EP1481771A4 (en) | 2006-08-23 |
| EP1481771A1 (en) | 2004-12-01 |
| US20050080590A1 (en) | 2005-04-14 |
| US7017395B2 (en) | 2006-03-28 |
| EP1481771B1 (en) | 2009-04-22 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4188607B2 (ja) | 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 | |
| JP4282419B2 (ja) | 脚体の関節部分に与えるトルクを求める方法および演算処理装置 | |
| JP4184679B2 (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 | |
| JP4246535B2 (ja) | 二足歩行移動体の床反力作用点推定方法及び二足歩行移動体の関節モーメント推定方法 | |
| JP3844695B2 (ja) | 二足歩行移動体の床反力作用点推定方法 | |
| JP4130739B2 (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 |