JP2003089083A - 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 - Google Patents

二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法

Info

Publication number
JP2003089083A
JP2003089083A JP2002039201A JP2002039201A JP2003089083A JP 2003089083 A JP2003089083 A JP 2003089083A JP 2002039201 A JP2002039201 A JP 2002039201A JP 2002039201 A JP2002039201 A JP 2002039201A JP 2003089083 A JP2003089083 A JP 2003089083A
Authority
JP
Japan
Prior art keywords
leg
gravity
center
reaction force
acceleration
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2002039201A
Other languages
English (en)
Other versions
JP4188607B2 (ja
Inventor
Masakazu Kawai
雅和 河合
Yasushi Ikeuchi
康 池内
Hisashi Kato
久 加藤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Priority to JP2002039201A priority Critical patent/JP4188607B2/ja
Application filed by Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to CA2451730A priority patent/CA2451730C/en
Priority to CNB028128966A priority patent/CN1290676C/zh
Priority to EP02736183A priority patent/EP1415770B1/en
Priority to US10/481,858 priority patent/US6915230B2/en
Priority to KR1020037016830A priority patent/KR100847319B1/ko
Priority to DE60237288T priority patent/DE60237288D1/de
Priority to PCT/JP2002/006467 priority patent/WO2003002309A1/ja
Publication of JP2003089083A publication Critical patent/JP2003089083A/ja
Application granted granted Critical
Publication of JP4188607B2 publication Critical patent/JP4188607B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00—Manipulators mounted on wheels or on carriages
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/1036—Measuring load distribution, e.g. podologic studies
    • A61B5/1038—Measuring plantar pressure during gait
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/45—For evaluating or diagnosing the musculoskeletal system or teeth
    • A61B5/4528—Joints
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H3/00—Appliances for aiding patients or disabled persons to walk about
    • A61H3/008—Using suspension devices for supporting the body in an upright walking or standing position, e.g. harnesses
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/0006—Exoskeletons, i.e. resembling a human figure
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/02—Detecting, measuring or recording pulse, heart rate, blood pressure or blood flow; Combined pulse/heart-rate/blood pressure determination; Evaluating a cardiovascular condition not otherwise provided for, e.g. using combinations of techniques provided for in this group with electrocardiography or electroauscultation; Heart catheters for measuring blood pressure
    • A61B5/024—Detecting, measuring or recording pulse rate or heart rate
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/11—Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb
    • A61B5/1116—Determining posture transitions
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61F—FILTERS IMPLANTABLE INTO BLOOD VESSELS; PROSTHESES; DEVICES PROVIDING PATENCY TO, OR PREVENTING COLLAPSING OF, TUBULAR STRUCTURES OF THE BODY, e.g. STENTS; ORTHOPAEDIC, NURSING OR CONTRACEPTIVE DEVICES; FOMENTATION; TREATMENT OR PROTECTION OF EYES OR EARS; BANDAGES, DRESSINGS OR ABSORBENT PADS; FIRST-AID KITS
    • A61F2/00—Filters implantable into blood vessels; Prostheses, i.e. artificial substitutes or replacements for parts of the body; Appliances for connecting them with the body; Devices providing patency to, or preventing collapsing of, tubular structures of the body, e.g. stents
    • A61F2/50—Prostheses not implantable in the body
    • A61F2/68—Operating or control means
    • A61F2/70—Operating or control means electrical
    • A61F2/72—Bioelectric control, e.g. myoelectric
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/50—Control means thereof
    • A61H2201/5058—Sensors or detectors
    • A61H2201/5061—Force sensors
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/50—Control means thereof
    • A61H2201/5058—Sensors or detectors
    • A61H2201/5069—Angle sensors
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/50—Control means thereof
    • A61H2201/5058—Sensors or detectors
    • A61H2201/5079—Velocity sensors
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/50—Control means thereof
    • A61H2201/5058—Sensors or detectors
    • A61H2201/5084—Acceleration sensors
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
    • A61H3/00—Appliances for aiding patients or disabled persons to walk about

Abstract

(57)【要約】 【課題】比較的簡単な手法で人間等の二足歩行移動体の
脚体に作用する床反力や脚体の関節に作用するモーメン
トを精度よくリアルタイムで把握することができる方法
を提供する。 【解決手段】脚体２の運動状態が単脚支持状態であるか
両脚支持状態であるかを判断し、単脚支持状態であると
きには、二足歩行移動体１の重心G0の運動方程式に基づ
いて接地している脚体２に作用する床反力Ｆを推定す
る。両脚支持状態であるときには、二足歩行移動体１の
重心G0の運動方程式と、各脚体２の床反力Ｆr，Ｆfの成
分と二足歩行移動体１の重心G0に対する各脚体２の足首
部１２の位置との間の関係式とに基づき各脚体２のそれ
ぞれに作用する床反力Ｆr，Ｆfを推定する。

Description

【発明の詳細な説明】
【０００１】
【発明の属する技術分野】本発明は、人間や二足歩行ロ
ボット等の二足歩行移動体の脚体に作用する床反力を推
定する方法に関する。さらに、その床反力の推定値を用
いて二足歩行移動体の脚体の関節に作用するモーメント
を推定する方法に関する。
【０００２】
【従来の技術】例えば人間の歩行動作を補助する歩行ア
シスト装置の動作制御や、二足歩行ロボットの移動動作
の制御を行なう場合、人間や二足歩行ロボットの脚体に
作用する床反力（詳しくは、脚体の接地部に床から作用
する力）を逐次把握することが必要となる。この床反力
を把握することで、二足歩行移動体の脚体の関節に作用
するモーメント等を把握することが可能となり、その把
握されたモーメント等に基づいて歩行アシスト装置の目
標補助力や、二足歩行ロボットの各関節の目標駆動トル
ク等を決定することが可能となる。
【０００３】前記床反力を把握する手法としては、例え
ば特開2000-249570号公報に開示されているものが知ら
れている。この技術では、二足歩行移動体の定常的な歩
行時に各脚体の床反力の経時変化の波形が周期的に変化
することから、各脚体の床反力を、歩行周期の１／ｎ
（ｎ＝１，２，…）の互いに異なる周期を有する複数の
三角関数の合成値（一次結合）として把握するものであ
る。この場合、複数の三角関数を合成する際の各三角関
数の重み係数は、二足歩行移動体毎にあらかじめ定めた
所定値やそれを地形に応じて調整した値が用いられてい
る。
【０００４】しかしながら、かかる技術では、二足歩行
移動体の一歩分もしくは複数歩分について脚体の床反力
を把握しようとするものであるため、二足歩行移動体の
歩容が逐次変化するような場合には、床反力を精度よく
把握することは困難である。また、把握される床反力の
精度を高めるためには、前記三角関数の重み係数を二足
歩行移動体毎に設定したり、地形等に応じて調整したり
しなければならないので、二足歩行移動体の移動環境や
二足歩行移動体の個体差の影響を少なくして、床反力を
精度よく把握するようにすることが困難である。
【０００５】また、例えば二足歩行ロボットにおいて
は、各脚体の足首部や足平部に６軸力センサ等の力セン
サを取り付け、この力センサの出力により床反力を把握
するものも知られている。さらに、床に設置したフォー
スプレート上で二足歩行移動体を歩行させ、該フォース
プレートの出力により床反力を把握する手法も知られて
いる。
【０００６】しかしながら、力センサを用いる技術で
は、特に人間の脚体の床反力を把握しようとする場合に
は、人間の足首部や足平部に力センサを取り付けなけれ
ばならないため、通常的な生活環境下では、該力センサ
が歩行の邪魔になってしまうという不都合がある。ま
た、フォースプレートを用いるものでは、該フォースプ
レートが設置された環境下でしか床反力を把握できな
い。
【０００７】
【発明が解決しようとする課題】本発明はかかる背景に
鑑みてなされたものであり、比較的簡単な手法で床反力
を精度よくリアルタイムで把握することができ、特に二
足歩行移動体としての人間に係る床反力を把握する上で
好適な床反力推定方法を提供することを目的とする。
【０００８】さらに、その床反力の推定値を用いて脚体
の膝関節等の関節に作用するモーメントを精度よくリア
ルタイムで把握することができる二足歩行移動体の関節
モーメント推定方法を提供することを目的とする。
【０００９】
【課題を解決するための手段】まず、本発明の二足歩行
移動体の床反力推定方法の基本的な考え方を説明する。
【００１０】二足歩行移動体の脚体の運動状態、例えば
歩行動作時の脚体の運動状態は、図１（ａ）に例示する
ように二足歩行移動体１の両脚体２，２のうちの一方の
脚体２（図では進行方向で前側の脚体）のみが接地する
単脚支持状態と、図１（ｂ）に示すように両脚体２，２
が接地する両脚支持状態とがある。
【００１１】ここで、まず、前記単脚支持状態におい
て、二足歩行移動体が運動を行う床に対して固定的な絶
対座標系における該二足歩行移動体の重心の運動方程式
（詳しくは重心の並進運動に関する運動方程式）は、該
重心の加速度と二足歩行移動体の重量との積が、該重心
に作用する重力（＝二足歩行移動体の重量×重力加速
度）と、接地している脚体の接地部に床から作用する床
反力との合力に等しいという関係式になる。具体的に
は、例えば図１（ａ）に示すように、床Ａに対して固定
した絶対座標系Ｃｆにおいて、二足歩行移動体１の重心
Ｇ0の加速度ａのＸ軸方向（二足歩行移動体１の進行方
向での水平方向）、Ｚ軸方向（鉛直方向）の成分をそれ
ぞれａx，ａz、接地している脚体２（支持脚側の脚体
２）に係る床反力ＦのＸ軸方向、Ｚ軸方向の成分をそれ
ぞれＦx，Ｆzとおくと、重心Ｇ0の運動方程式は、次式
（１）により表される。
【００１２】T (Ｆx，Ｆz−Ｍ・ｇ)＝Ｍ・T(ａx，ａz) ……（１） （但し、Ｍ：二足歩行移動体の重量、ｇ：重力加速度）
【００１３】尚、式（１）中の両辺の括弧部分T( ，
）は２成分のベクトルを意味している。本明細書では
T( ， ）という形の表記は、ベクトルを表す。
【００１４】従って、二足歩行移動体１の重心Ｇ0の加
速度ａ＝T(ａx，ａz)を把握すれば、その加速度ａと、
二足歩行移動体１の重量Ｍの値と、重力加速度ｇの値と
を用いて、次式（２）により、床反力Ｆ＝T(Ｆx，Ｆz)
の推定値を得ることができることとなる。
【００１５】T (Ｆx，Ｆz)＝Ｍ・T(ａx，ａz−ｇ) ……（２）
【００１６】この場合、床反力Ｆの推定値を得るために
必要な重量Ｍは、あらかじめ計測等により把握すること
ができる。また、重心Ｇ0の位置や加速度ａについて
は、詳細は後述するが、二足歩行移動体１の各関節の屈
曲角度（回転角度）を検出するセンサや、加速度セン
サ、ジャイロセンサ等のセンサの出力を用いて公知の手
法等により逐次把握することが可能である。
【００１７】次に、前記両脚接地状態における二足歩行
移動体の重心の運動方程式（詳しくは重心の並進運動に
関する運動方程式）は、該重心の加速度と二足歩行移動
体の重量との積が、該重心に作用する重力（＝二足歩行
移動体の重量×重力加速度）と、両脚体のそれぞれの接
地部に床から作用する床反力（両脚体にそれぞれ対応す
る二つの床反力）との合力に等しいという関係式にな
る。具体的には、図１（ｂ）に示すように二足歩行移動
体１の進行方向に向かって前側の脚体２に係る床反力Ｆ
fのＸＺ座標成分をＦfx，Ｆfz、後側の脚体２に係る床
反力ＦrのＸＺ座標成分をＦrx，Ｆrzとおくと、重心Ｇ0
の運動方程式は、次式（３）により表される。
【００１８】 T(Ｆfx＋Ｆrx，Ｆfz＋Ｆrz−Ｍ・ｇ)＝Ｍ・T(ａx，ａz) ……（３） 尚、式（３）中のａ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) Ｆfz＝Ｍ・｛ΔＺf・(ΔＺr・ａx−ΔＸr・ａz −ΔＸr・ｇ)｝／(ΔＸf・ΔＺr−ΔＸr・ΔＺf) Ｆrx＝Ｍ・｛ΔＸr・(−ΔＺf・ａx＋ΔＸf・ａz ＋ΔＸf・ｇ)｝／(ΔＸ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(Ｆf
x，Ｆfz)、Ｆr＝T(Ｆrx，Ｆrz)の推定値を得ることがで
きることとなる。
【００２５】この場合、床反力Ｆf，Ｆrの推定値を得る
ために必要な重量Ｍは、あらかじめ計測等により把握す
ることができる。また、重心Ｇ0の加速度ａや重心Ｇ0の
位置、該重心Ｇ0に対する前記特定部位３f，３rの位置
については、詳細は後述するが、二足歩行移動体１の各
関節の屈曲角度（回転角度）を検出するセンサや、加速
度センサ、ジャイロセンサ等のセンサの出力を用いて、
公知の手法等により逐次把握することが可能である。
【００２６】以上説明したことを基礎として、本発明を
次に説明する。本発明の二足歩行移動体の床反力推定方
法、すなわち、二足歩行移動体の各脚体に作用する床反
力を推定する方法は、前記の目的を達成するために、前
記二足歩行移動体の脚体の運動状態がその一方のみの脚
体が接地している単脚支持状態であるか両脚体が接地し
ている両脚支持状態であるかを判断する第１ステップ
と、前記二足歩行移動体の重心の位置を逐次求めつつ、
該重心の位置の時系列データを用いて床に対して固定さ
れた絶対座標系での該重心の加速度を逐次求める第２ス
テップと、少なくとも前記両脚支持状態において各脚体
の下端部近傍にあらかじめ定めた特定部位の前記重心に
対する位置を逐次求める第３ステップとを備える。そし
て、本発明の床反力推定方法は、前記二足歩行移動体の
単脚支持状態であるときには、二足歩行移動体の重量と
重力加速度と前記重心の加速度と接地している脚体に作
用する前記床反力とにより表される該重心の運動方程式
に基づき、接地している脚体に作用する前記床反力の推
定値を逐次求め、前記二足歩行移動体の両脚支持状態で
あるときには、二足歩行移動体の重量と重力加速度と前
記重心の加速度と両脚体のそれぞれに作用する前記床反
力とにより表される該重心の運動方程式と、各脚体に作
用する前記床反力が該脚体の前記特定部位から前記重心
に向かって作用すると仮定して定まる、各脚体の特定部
位の前記重心に対する位置と該脚体に作用する前記床反
力との間の関係式とに基づき両脚体のそれぞれに作用す
る前記床反力の推定値を逐次求めることを特徴とするも
のである。
【００２７】かかる本発明によれば、前記第１ステップ
において、二足歩行移動体の脚体の運動状態が単脚支持
状態であるか両脚支持状態であるかが判断され、それぞ
れの支持状態に応じた手法により前記床反力の推定値が
求められる。すなわち、二足歩行移動体の単脚支持状態
では、二足歩行移動体の重心の前述の運動方程式（式
（１）参照）に基づいて、二足歩行移動体の重量、重力
加速度及び重心の加速度の値から、接地している脚体に
作用する前記床反力の推定値が求められる（式（２）参
照）。
【００２８】また、二足歩行移動体の両脚支持状態で
は、二足歩行移動体の重心の前述の運動方程式（式
（３）参照）と、各脚体の特定部位の前記重心に対する
位置と該脚体に作用する前記床反力との間の関係式（式
（４））とに基づいて、二足歩行移動体の重量、重力加
速度及び重心の加速度、並びに、重心に対する各脚体の
特定部位の位置から、両脚体のそれぞれに作用する床反
力の推定値が求められる（式（５）参照）。尚、単脚支
持状態では、遊脚側の脚体（接地していない脚体）に作
用する床反力は「０」である。
【００２９】この場合、床反力の推定値を求めるために
必要な二足歩行移動体の重量は、あらかじめ計測等によ
り把握しておけばよい。また、二足歩行移動体の重心の
位置や加速度、該重心に対する各脚体の特定部位の位置
は、二足歩行移動体の各関節の屈曲角度（回転角度）を
検出するセンサ（ポテンショメータ等）や、加速度セン
サ、ジャイロセンサ等、比較的小型で二足歩行移動体へ
の装備が容易なセンサの出力のデータを用いてリアルタ
イムで把握することが可能である。
【００３０】従って、本発明の床反力推定方法によれ
ば、二足歩行移動体の足首部や足平部に力センサを装着
したり、フォースプレートを使用したりすることなく、
比較的簡単な手法で床反力をリアルタイムで把握するこ
とができる。
【００３１】かかる本発明の床反力推定方法では、前記
各脚体の特定部位は、該脚体の足首部であることが好適
である。このようにすることにより、特に、両脚接地状
態における前述の仮定の信頼性が高まる。このため、前
記単脚支持状態における床反力の推定値はもちろん、両
脚支持状態における床反力の推定値の精度を高めること
ができる。つまり、脚体の運動状態によらずに、精度よ
く床反力を推定することができる。
【００３２】また、本発明の床反力推定方法では、前記
両脚体上に各脚体の股関節を介して支持された胴体の股
関節寄りの下部の上下方向の加速度を計測するステップ
を備え、前記第１ステップでは、前記胴体の下部の上下
方向の加速度があらかじめ定めた所定の閾値以上に上昇
した時に前記両脚支持状態が開始すると共に前記単脚支
持状態が終了し、且つ、前記両脚支持状態で先行して離
床する側の脚体に作用する前記床反力の推定値があらか
じめ定めた所定の閾値以下に低下した時に前記両脚支持
状態が終了すると共に前記単脚支持状態が開始するとし
て、前記二足歩行移動体の運動状態を判断する。
【００３３】すなわち、二足歩行移動体の移動時（歩行
時）に、脚体の運動状態が単脚支持状態から両脚支持状
態に移行する際に、遊脚側の脚体が接地することで、胴
体の下部の上下方向の加速度（上向きの加速度）が一時
的に顕著に大きなものとなる。そして、この現象は、脚
体の他の運動状態では一般には生じない。また、脚体の
運動状態が両脚支持状態から単脚支持状態に移行する際
には、一方の脚体の離床動作が行なわれることで、その
脚体に作用する床反力は、「０」に低下していく。従っ
て、上記のように脚体の運動状態を判断することで、単
脚支持状態であるか両脚支持状態であるかの判断を適正
に行うことができる。この結果、単脚支持状態と両脚支
持状態とで異なるものとなる床反力の推定値の算出手法
を的確なタイミングで切換えることができ、ひいては、
該床反力の推定値の精度を高めることができる。また、
脚体の運動状態の判断のために必要な胴体の下部の上下
方向の加速度は、例えば該胴体の下部に加速度センサを
取り付けておくことで、該加速度センサの出力により容
易に把握することができる。
【００３４】尚、人間のように、前記胴体が両脚体に股
関節を介して連結された腰部と、該腰部上に該腰部に対
して傾斜可能に存する胸部とを有するよう場合には、計
測する胴体の下部の上下方向の加速度は、前記腰部の上
下方向の加速度であることが好適である。
【００３５】また、本発明の床反力推定方法では、前記
第２ステップで二足歩行移動体の重心の位置や該重心の
加速度を把握する手法としては、種々の手法が考えら
れ、また、種々の公知の手法を用いることが可能である
が、次のような手法により、該重心の位置や該重心の加
速度を把握することが好適である。
【００３６】すなわち、前記両脚体上に各脚体の股関節
を介して支持された胴体の傾斜角度と、各脚体の少なく
とも股関節及び膝関節のそれぞれの屈曲角度と、前記二
足歩行移動体のあらかじめ定めた基準点の前記絶対座標
系における加速度とをそれぞれ計測するステップを備
え、前記第２ステップでは、前記胴体の傾斜角度と、前
記股関節及び膝関節のそれぞれの屈曲角度と、前記二足
歩行移動体を複数の剛体の連結体として表してなる剛体
リンクモデルと、該剛体リンクモデルの各剛体に対応す
る二足歩行移動体の各剛体相当部のあらかじめ求めた重
量と、各剛体相当部における該剛体相当部のあらかじめ
求めた重心の位置とに基づき、前記基準点に対する前記
二足歩行移動体の重心の位置を逐次求めると共に、その
重心の位置の時系列データに基づき該基準点に対する該
重心の加速度を逐次求め、その基準点に対する該重心の
加速度と、前記絶対座標系における該基準点の加速度と
から該絶対座標系での前記重心の加速度を求める。
【００３７】すなわち、二足歩行移動体に任意に基準点
を定めたとき、該基準点に対する二足歩行移動体の重心
の位置は、概ね、胴体と、各脚体の股関節から膝関節に
かけての大腿部と、膝関節から下側の下腿部との相互の
姿勢関係により定まる。そして、その姿勢関係は、胴体
の傾斜角度と、股関節及び膝関節のそれぞれの屈曲角度
とを計測することで、それらの計測データから把握する
ことが可能である。さらに、詳細は後述するが、二足歩
行移動体に対して前記剛体リンクモデル（例えば二足歩
行移動体の両脚体の股関節の上側の部分（胴体を含
む）、各脚体の大腿部、下腿部を剛体とみなすモデル）
を想定したとき、二足歩行移動体の各剛体相当部の重量
と、各剛体相当部における該剛体相当部の重心の位置
（詳しくは、各剛体相当部に対して固定した座標系にお
ける該剛体相当部の位置）と、上記の姿勢関係とに基づ
いて前記基準点に対する二足歩行移動体の重心の位置を
求めることができる。さらに、基準点に対する該重心の
加速度は、該重心の位置の時系列データから把握される
該重心の位置の２階微分値として求められる。従って、
前記絶対座標系における前記基準点の加速度を計測して
おくことにより、該絶対座標系における二足歩行移動体
の重心の加速度は、該基準点に対する該重心の加速度
と、該基準点の加速度との合成加速度として求められる
こととなる。
【００３８】この場合、上述のように二足歩行移動体の
加速度を把握するために必要な胴体の傾斜角度は、該胴
体に取り付けた加速度センサとジャイロセンサ、又は傾
斜計等のセンサの出力から把握することが可能であり、
各脚体の股関節及び膝関節の屈曲角度はそれぞれの関節
の箇所に取り付けたポテンショメータ等のセンサの出力
により把握することが可能である。また、前記絶対座標
系における前記基準点の加速度は、該基準点と一体的な
部分に取り付けた加速度センサ等のセンサの出力により
把握することが可能である。さらに、二足歩行移動体の
各剛体相当部の重量や、各剛体相当部における該剛体相
当部の重心の位置は、あらかじめ計測等により把握する
ことが可能である。
【００３９】従って、二足歩行移動体に比較的大型なセ
ンサ等を装備したりすることなく、二足歩行移動体の重
心の位置や加速度をリアルタイムで容易に把握すること
が可能となる。
【００４０】このように二足歩行移動体の重心の位置や
加速度を求める場合、前記基準点は、前記胴体に設定さ
れていることが好適である。これによれば、前記絶対座
標系における該基準点の加速度を計測するための加速度
センサ等のセンサを胴体に装備することができるため、
脚体に装備するセンサを少なくでき、該センサが二足歩
行移動体の歩行動作の邪魔になるような事態を回避でき
る。
【００４１】また、人間のように、前記両脚体に股関節
を介して連結された腰部と、該腰部上に該腰部に対して
傾斜可能に存する胸部とを有し、前記重心の位置を求め
るために用いる前記胴体の傾斜角度は、前記腰部及び胸
部のそれぞれの傾斜角度であることが好適である。そし
て、特にこの場合、前記剛体リンクモデルは、前記二足
歩行移動体の各脚体の膝関節の下側に存する下腿部と、
該膝関節及び前記股関節の間の大腿部と、前記腰部と、
該腰部の上側に存する前記胸部を含む上体部とをそれぞ
れ剛体として表したモデルであることが好適である。
【００４２】これによれば、特に二足歩行移動体が人間
である場合に、その重心の位置や加速度を精度よく把握
することができ、ひいては、床反力の推定値の精度を高
めることができる。
【００４３】尚、上述のように胴体の傾斜角度等から前
記基準点に対する二足歩行移動体の重心の位置を求める
場合には、前記第３ステップでは、該基準点に対する各
脚体の前記特定部位の位置を求めることで、二足歩行移
動体の重心に対する前記特定部位の位置を求めることが
できる。この場合、基準点に対する前記特定部位の位置
を求めるために必要なパラメータは、前記基準点の設定
位置によって異なる。例えば、前記特定部位が各脚体の
足首部であり、また、前記基準点を胴体に設定した場合
には、該胴体の傾斜角度（胴体が前記腰部及び胸部を有
する場合で、基準点が腰部に設定されている場合には、
該腰部の傾斜角度）と、各脚体の股関節及び膝関節の屈
曲角度と、各脚体の大腿部及び下腿部のサイズ（長さ）
とに基づいて、基準点に対する各脚体の特定部位の位置
を求めることが可能である。
【００４４】次に、本発明の二足歩行移動体の関節モー
メント推定方法は、前述した本発明の床反力推定方法に
より逐次求めた前記各脚体に係る床反力の推定値を用い
て前記二足歩行移動体の各脚体の少なくとも一つの関節
に作用するモーメントを推定する方法である。そして、
本発明の関節モーメント推定方法は、前記両脚体上に各
脚体の股関節を介して支持された胴体の傾斜角度と前記
各脚体の少なくとも股関節及び膝関節のそれぞれの屈曲
角度と記二足歩行移動体のあらかじめ定めた基準点の前
記絶対座標系における加速度とをそれぞれ計測するステ
ップと、前記胴体の傾斜角度と前記各脚体の股関節及び
膝関節のそれぞれの屈曲角度と前記二足歩行移動体を複
数の剛体の連結体として表してなる剛体リンクモデルと
に基づき、該剛体リンクモデルの各剛体に対応する二足
歩行移動体の各剛体相当部の傾斜角度を逐次求めるステ
ップと、前記各剛体相当部の傾斜角度と各剛体相当部の
あらかじめ求めた重量と各剛体相当部における該剛体相
当部のあらかじめ求めた重心の位置とに基づき、前記基
準点に対する各剛体相当部の重心の位置を逐次求めると
共に、その各剛体相当部の重心の位置の時系列データに
基づき該基準点に対する各剛体相当部の重心の加速度を
逐次求めるステップと、該基準点に対する各剛体相当部
の重心の加速度と前記絶対座標系における前記基準点の
加速度とから該絶対座標系における各剛体相当部の重心
の加速度を逐次求めるステップと、前記各剛体相当部の
傾斜角度の時系列データに基づき各剛体相当部の角加速
度を逐次求めるステップと、前記二足歩行移動体の剛体
相当部としての各脚体の大腿部の傾斜角度と、該脚体の
膝関節の屈曲角度とのうちの少なくとも一方に基づき該
二足歩行移動体における各脚体の床反力作用点の推定位
置を逐次求めるステップとを備え、前記床反力の推定値
と、前記床反力作用点の推定位置と、前記絶対座標系に
おける各剛体相当部の重心の加速度及び該剛体相当部の
角加速度と、各剛体相当部の傾斜角度と、各剛体相当部
のあらかじめ求めた重量及びサイズと、各剛体相当部に
おける該剛体相当部のあらかじめ求めた重心の位置と、
各剛体相当部のあらかじめ求めた慣性モーメントとを用
いて逆動力学モデルに基づき前記二足歩行移動体の各脚
体の少なくとも一つの関節に作用するモーメントを推定
することを特徴とするものである。
【００４５】尚、前述のように、前記床反力推定方法に
おける前記第２ステップで基準点に対する二足歩行移動
体の重心の位置等を求めるために、胴体の傾斜角度と、
各脚体の股関節及び膝関節のそれぞれの屈曲角度と二足
歩行移動体の基準点の前記絶対座標系における加速度と
をそれぞれ計測するステップを備えたときには、それら
を改めて計測する必要はなく、また、前記剛体リンクモ
デルは、二足歩行移動体の重心の位置等を求めるために
用いた剛体リンクモデルと同一の剛体リンクモデルを使
用すればよい。
【００４６】かかる本発明の関節モーメント推定方法で
は、胴体の傾斜角度と、股関節及び膝関節のそれぞれの
屈曲角度とを計測することで、それらの計測データから
胴体、大腿部、下腿部等の二足歩行移動体の各剛体相当
部の傾斜角度（これは各剛体相当部の相互の姿勢関係を
表す）を把握することが可能である。そして、各剛体相
当部の重量と、各剛体相当部における該剛体相当部の重
心の位置（詳しくは、各剛体相当部に対して固定した座
標系における該剛体相当部の位置）と、上記の各剛体相
当部の傾斜角度とに基づいて前記基準点に対する各剛体
相当部の重心の位置を求めることができる。さらに、基
準点に対する各剛体相当部の重心の加速度は、該重心の
位置の時系列データから把握される該重心の位置の２階
微分値として求められる。従って、前記絶対座標系にお
ける前記基準点の加速度を計測しておくことにより、該
絶対座標系における二足歩行移動体の各剛体相当部の重
心の加速度が、該重心の基準点に対する加速度と、前記
基準点の加速度（絶対座標系での加速度）との合成加速
度として求められることとなる。
【００４７】さらに、前記各剛体相当部の傾斜角度の時
系列データから把握される該傾斜角度の２階微分値とし
て、各剛体相当部の角加速度が求められる。
【００４８】また、本願発明者等の知見によれば、二足
歩行移動体における各脚体の床反力作用点の位置、例え
ば、各脚体の足首部に対する該脚体の床反力作用点の位
置は、前記二足歩行移動体の剛体相当部としての各脚体
の大腿部の傾斜角度や、該脚体の膝関節の屈曲角度と密
接な相関関係を有する。従って、該脚体の大腿部の傾斜
角度と、膝関節の屈曲角度とのうちの少なくとも一方に
基づいて、二足歩行移動体における床反力作用点の推定
位置を求めることができる。
【００４９】そして、上述のように二足歩行移動体の各
剛体相当部の重心の加速度、該剛体相当部の角加速度、
床反力作用点の推定位置を求めたとき、前記床反力推定
方法により求められる床反力の推定値と併せて、それら
のデータ等から、公知の所謂逆動力学モデルに基づいて
各脚体の膝関節や股関節に作用するモーメントを推定す
ることができる。この逆動力学モデルに基づく手法は、
それを簡略的に言えば、二足歩行移動体の各剛体相当部
の重心の並進運動に関する運動方程式と、該剛体相当部
の回転運動（例えば該剛体相当部の重心の回りの回転運
動）に関する運動方程式とを用いて剛体リンクモデルの
各関節に相当する二足歩行移動体の各関節に作用するモ
ーメントを床反力作用点により近いものから順番に求め
ていくものである。詳細は後述するが、例えば各脚体が
大腿部及び下腿部をそれぞれ剛体相当部として有する連
結体であるとした場合、各脚体の下腿部の重心の並進運
動に関する運動方程式に、該下腿部の重心の加速度、該
脚体に作用する床反力の推定値、下腿部の重量の値を適
用することで、該脚体の膝関節に作用する力（関節反
力）が判る。さらに、該脚体の膝関節に作用する関節反
力と、該脚体の下腿部の角加速度と、該脚体の床反力作
用点の推定位置と、該脚体の床反力の推定値と、該下腿
部における該下腿部の重心の位置及び該下腿部のサイズ
（長さ）に係わるデータ値と、該下腿部の慣性モーメン
トの値と、該下腿部の傾斜角度の値とを該下腿部の回転
運動に関する運動方程式に適用することで、該脚体の膝
関節のモーメントを推定することができる。
【００５０】また、各脚体の大腿部の重心の並進運動に
関する運動方程式に、該大腿部の重心の加速度、該脚体
の膝関節に作用する関節反力、大腿部の重量の値とを適
用することで、該脚体の股関節に作用する関節反力が判
る。さらに、該脚体の膝関節及び股関節にそれぞれ作用
する関節反力と、該脚体の大腿部の角加速度と、該大腿
部における該大腿部の重心の位置及び該大腿部のサイズ
（長さ）に係わるデータ値と、該大腿部の慣性モーメン
トの値と、該大腿部の傾斜角度の値とを該大腿部の回転
運動に関する運動方程式に適用することで、該脚体の股
関節のモーメントを推定することができる。
【００５１】かかる本発明の関節モーメント推定方法に
よれば、前述の本発明の床反力推定方法により求められ
た床反力の推定値を用いて脚体の関節に作用するモーメ
ントを推定することにより、二足歩行移動体に比較的大
型なセンサ等を装備したりすることなく、脚体の関節に
作用するモーメントを比較的精度よくリアルタイムで推
定することができる。
【００５２】
【発明の実施の形態】本発明の一実施形態を前記図１並
びに図２〜図１０を参照して説明する。
【００５３】本実施形態は、二足歩行移動体としての人
間に本発明の床反力推定方法及び関節モーメント推定方
法を適用した実施形態である。
【００５４】図２に模式化して示すように、人間１は、
その構成を大別すると、左右一対の脚体２，２と、腰部
３及び胸部４からなる胴体５と、頭部６と、左右一対の
腕体７，７とを有する。胴体５は、その腰部３が脚体
２，２のそれぞれに左右一対の股関節８，８を介して連
結され、両脚体２，２上に支持されている。また、胴体
５の胸部４は、腰部３の上側に該腰部３に対して人間１
の前方側に傾斜可能に存している。そして、この胸部４
の上部の左右両側部から腕体７，７が延設され、該胸部
４の上端部に頭部６が支持されている。
【００５５】各脚体２，２は、股関節８から延在する大
腿部９と、該大腿部９の先端から膝関節１０を介して延
在する下腿部１１とを有し、下腿部１１の先端部に、足
首部（足首関節）１２を介して足平部１３が連結されて
いる。
【００５６】本実施形態では、このような構成を有する
人間１の各脚体２に作用する床反力の推定、さらには膝
関節１０及び股関節８に作用するモーメントの推定を行
うために、次のような装置を人間１に装備している。
【００５７】すなわち、胴体５の胸部４には、胸部４の
傾斜に伴う角速度に応じた出力を発生するジャイロセン
サ１４（以下、胸部ジャイロセンサ１４という）と、胸
部４の前後方向の加速度に応じた出力を発生する加速度
センサ１５（以下、胸部前後加速度センサ１５という）
と、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，θdのデータとを用いて各脚体２
の膝関節１０及び股関節８にそれぞれ作用するモーメン
トを推定する関節モーメント推定手段３７とを備えてい
る。
【００７０】次に、上述の演算処理装置１６の各手段の
より詳細な処理内容と併せて、本実施形態の作動を説明
する。
【００７１】本実施形態では、例えば人間１が歩行等の
脚体２の運動を行うに際して、両脚体２，２を着床させ
た状態で演算処理装置１６の図示しない電源スイッチを
投入すると、該演算処理装置１６による処理が所定のサ
イクルタイム毎に以下に説明するように逐次実行され、
各脚体２に作用する床反力の推定値等が逐次求められ
る。
【００７２】すなわち、まず、演算処理装置１６は、前
記脚体運動判断手段２４の処理を実行する。この脚体運
動判断手段２４の処理では、前記サイクルタイム毎に、
前記腰部上下加速度センサ２１による腰部３の上向き方
向の加速度の検出データがあらかじめ定めた所定の閾値
と比較される。そして、該加速度の検出値がその閾値を
超えたときに、前記図１（ｂ）に示したような両脚支持
状態が開始し、且つ、前記図１（ａ）に示したような単
脚支持状態が終了すると判断される。すなわち、人間１
の歩行時に、単脚支持状態から両脚支持状態への移行の
際には、遊脚側の脚体２が着床することで、股関節８の
近傍の腰部３には、ほぼ上向きに比較的大きな加速度
（通常的な単脚支持状態では発生し得ない加速度）が発
生する。このため、前記脚体運動判断手段２４は、上記
のように腰部上下加速度センサ２１による腰部３の上向
き方向の加速度の検出データを所定の閾値と比較するこ
とで、両脚支持状態の開始及び単脚支持状態の終了を判
断する。
【００７３】また、脚体運動判断手段２４の処理では、
両脚支持状態で床反力推定手段３５により後述するよう
に求められた両脚体２，２のそれぞれに作用する床反力
Ｆf，Ｆr（図１（ｂ）参照）の推定値のうち、人間の進
行方向に対して後側の脚体２に係る床反力Ｆr＝T(Ｆr
x，Ｆ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(a0
x，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の各剛体
相当部における位置があらかじめ求められ、演算処理装
置１６の図示しないメモリに記憶されている。
【００８８】ここで、演算処理装置１６に記憶保持して
いる各剛体相当部の重心G1、G2、G3、G4の位置は、各剛
体相当部に対して固定した座標系での位置である。この
場合、各剛体相当部の重心G1、G2、G3、G4の位置を表す
データとして、例えば、各剛体相当部の一端部の関節の
中心点から該剛体相当部の軸心方向の距離が用いられ
る。具体的には、例えば図４に示すように、各大腿部９
の重心G1の位置は、該大腿部９の股関節８の中心から大
腿部９の軸心方向に距離t1の位置、各下腿部１１の重心
G2の位置は、該下腿部１１の膝関節１０の中心から下腿
部１１の軸心方向に距離t2の位置として表され、それら
の距離t1，t2の値があらかじめ求められて演算処理装置
１６に記憶保持されている。他の剛体相当部の重心、G
3、G4の位置についても同様である。
【００８９】尚、上体部３８の重心G4の位置は、厳密に
は、該上体部３８に含まれる腕体７，７の動きの影響を
受けるが、歩行時における各腕体７，７は、一般に胸部
４の軸心に対して対称的な位置関係になるので、上体部
３８の重心G4の位置はさほど変動せず、例えば直立姿勢
状態における上体部３８の重心G4の位置とほぼ同一とな
る。
【００９０】また、本実施形態では、各剛体相当部（各
脚体２の大腿部９及び下腿部１１、腰部３、上体部３
８）の重心G1、G2、G3、G4の位置を表すデータの他、各
剛体相当部の重量のデータや、各剛体相当部のサイズの
データ（例えば各剛体相当部の長さのデータ）があらか
じめ求められて、演算処理装置１６に記憶保持されてい
る。
【００９１】尚、下腿部１１の重量は、足平部１３を含
めた重量である。また、上述のように演算処理装置１６
にあらかじめ記憶保持したデータは、実測等により求め
ておいてもよいが、人間１の身長や体重から、人間の平
均的な統計データに基づいて推測するようにしてもよ
い。一般に、上記各剛体相当部の重心G1、G2、G3、G4の
位置や、重量、サイズは、人間の身長や体重と相関性が
あり、その相関関係に基づいて、人間の身長及び体重の
データから、上記各剛体相当部の重心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の位置の
座標は、（t1・sinθc，−t1・cosθc）となる。また、
下腿部１１の身体座標系Ｃpにおける傾斜角度はθd（図
４ではθd＜０）であるので、身体座標系Ｃpにおける下
腿部１１の重心G2の位置の座標は、大腿部９の長さをＬ
cとすると、（Ｌc・sinθc＋t2・sinθd，−Lc・cosθc
−t2・cosθd）となる。他の脚体２の大腿部９及び下腿
部１１並びに、腰部３及び上体部３８の重心についても
上記と同様に求められる。
【００９５】このようにして、各部重心位置算出手段２
９により、身体座標系Ｃ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）は次式（９）により求め
られる。
【００９７】 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）は、（Lc・sin
θc＋Ld・sinθd，−Lc・cosθc−Ld・cosθd）となる
（但し、図４ではθc＜０、θd＜０）。他方の脚体２に
ついても同様である。
【０１０１】そして、この足首部１２の身体座標系Ｃp
における位置（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(０，０)
である。
【０１０３】また、脚体運動判断手段２４により今回の
サイクルタイムで判断された脚体２の運動状態が両脚支
持状態である場合には、人間１の体重Ｍ及び重力加速度
ｇと、前記身体重心加速度算出手段３２により求められ
た絶対座標系Ｃfにおける身体重心G0の加速度ａ＝T(ａ
x，ａz)の今回値と、前記足首位置算出手段３１により
求められた各脚体２の足首部１２の身体重心G0に対する
位置の今回値のデータ（式（５）のΔＸf，ΔＺf，ΔＸ
r，ΔＺrのデータの今回値）とから、前記式（５）によ
り、各脚体２毎の床反力Ｆf＝T(Ｆfx，Ｆfz)、Ｆr＝
T(Ｆrx，Ｆrz)の推定値が求められる。
【０１０４】一方、演算処理装置１６は、上述のような
身体重心位置算出手段３０、身体重心加速度加速度算出
手段３２、足首位置算出手段３１、及び床反力推定手段
３６の処理と並行して、前記脚体各部加速度算出手段３
３、脚体各部角加速度算出手段３４、床反力作用点推定
手段３５の処理を実行する。
【０１０５】この場合、前記脚体各部加速度算出手段３
３の処理では、前記身体重心加速度算出手段３２の処理
と同様、まず、前記サイクルタイム毎に前記各部重心位
置算出手段２９により求められる身体座標系Ｃpにおけ
る各脚体２の剛体相当部である大腿部９及び下腿部１１
の重心G1，G2の位置のそれぞれの時系列データを用い
て、身体座標系Ｃpにおける大腿部９及び下腿部１１の
重心G1，G2の位置のそれぞれの２階微分値、すなわち、
身体座標系Ｃpにおける大腿部９及び下腿部１１の重心G
1，G2のそれぞれの加速度（身体座標系Ｃpの原点Ｏに対
する加速度）が求められる。そして、このそれぞれの加
速度と、前記基準加速度計測手段２７による腰部３の絶
対座標系Ｃfにおける加速度a0＝T(a0x，a0z）とのベク
トル和を求めることにより、絶対座標系Ｃfにおける大
腿部９及び下腿部１１のそれぞれの加速度（より詳しく
は、該加速度の絶対座標系Ｃfにおける座標成分）が求
められる。
【０１０６】また、前記脚体各部角加速度算出手段３４
の処理では、前記サイクルタイム毎に前記脚体姿勢算出
手段２８により求められる各脚体２の大腿部９及び下腿
部１１のそれぞれの傾斜角度θc，θdの時系列データを
用いて、該大腿部９及び下腿部１１のそれぞれ傾斜角度
θc，θdの２階微分値、すなわち、大腿部９及び下腿部
１１のそれぞれの角加速度が求められる。
【０１０７】また、床反力作用点推定手段３５の処理で
は、接地している脚体２について、例えば前記脚体姿勢
算出手段２８により求められた大腿部９の傾斜角度θc
の今回値から、図５及び図６に示すようにあらかじめ定
められた相関関係に基づいて該脚体２の足首部１２か
ら、該脚体２の足平部１３の床反力作用点（足平部１３
の接地箇所に作用する全床反力が集中するとみなせる
点）へのベクトル（足首部１２に対する床反力作用点の
位置ベクトル。以下、床反力作用点ベクトルという）を
該床反力作用点の位置を表すデータとして求める。
【０１０８】すなわち、本願発明者の知見によれば、接
地している脚体２の大腿部９の傾斜角度θcや膝関節１
０の屈曲角度Δθdは、床反力作用点と比較的顕著な相
関性を有し、例えば大腿部９の傾斜角度θcに対して、
前記床反力作用点ベクトル、詳しくは、人間１の進行方
向（Ｘ軸方向）における該床反力作用点ベクトルの成分
と、鉛直方向（Ｚ軸方向）における該床反力作用点ベク
トルの成分とは、それぞれ図５、図６に示すように変化
する。ここで、大腿部９の負の傾斜角度θcは、脚体２
が人間１の後側に延びるように大腿部９が腰部３の軸心
に対して傾斜しているとき（例えば図２の人間１の前方
に向かって右側の脚体２）の角度であり、正の傾斜角度
θcは、脚体２が人間１の前側に存するように大腿部９
が腰部３の軸心に対して傾斜しているとき（例えば図２
の人間１の前方に向かって左側の脚体２）の角度であ
る。
【０１０９】そこで、本実施形態では、図５及び図６の
相関関係を表す、大腿部９の傾斜角度θcをパラメータ
とする近似式を作成して、この近似式を演算処理装置１
６にあらかじめ記憶保持させている。そして、前記床反
力作用点推定手段３５の処理では、前記脚体姿勢算出手
段２８により求められた大腿部９の傾斜角度θcの今回
値を上記近似式に代入して、前記床反力作用点ベクトル
（詳しくは該床反力作用点ベクトルのＸ軸方向、Ｚ軸方
向の成分）を求めている。
【０１１０】ここで、図５及び図６のように、大腿部９
の傾斜角度θcが極小値を持つ相関関係では、大腿部９
の傾斜角度θcが同一であっても傾斜角度θcの減少過程
と増加過程とで床反力作用点ベクトルの値が異なる。そ
こで、本実施形態では、上記近似式を作成する際、足平
部１３の踵が着床してからつま先が離床するまでの前記
相関関係の推移を、大腿部９の傾斜角度θcが正である
第１の相（図５ではａ１の相、図６ではｂ１の相）と、
大腿部９の傾斜角度θcが負で、且つ、大腿部９の傾斜
角度θcの変化速度、即ち、大腿部９の傾斜角速度が負
である第２の相（図５ではａ２の相、図６ではｂ２の
相）と、大腿部９の傾斜角度θcが負で、且つ、大腿部
９の傾斜角速度が正である第３の相（図５ではａ３の
相、図６ではｂ３の相）とに区分し、床反力作用点ベク
トルのＸ軸方向成分、Ｚ軸方向成分のそれぞれについ
て、各相を同一または異なる関数で近似するようにし
た。図５の相関関係における第１および第２の相ａ１，
ａ２を合わせた相の近似式は、床反力作用点ベクトルの
Ｘ軸方向成分をｐxとして、例えば、 ｐx＝x1・θc6＋x2・θc5＋x3・θc4＋x4・θc3＋x5・
θc2＋x6・θc＋x7 という形の６次の多項式関数（x1〜x7は定数値）により
表される。また、図５の相関関係における第３の相ａ３
の近似式は、例えば ｐx＝x8・θc4＋x9・θc3＋x10・θc2＋x11・θc＋x12 という形の４次の多項式関数（x8〜x12は定数値）によ
り表される。
【０１１１】また、図6の相関関係における第１および
第２の相ｂ１，ｂ２を合わせた相の近似式は、床反力作
用点ベクトルのＺ軸方向成分をｐzとして、例えば ｐz＝z1・θc6＋z2・θc5＋z3・θc4＋z4・θc3＋z5・
θc2＋z6・θc＋z7 という形の６次の多項式関数（z1〜z7は定数値）により
表される。また、図６の相関関係における第３の相ｂ３
の近似式は、例えば ｐz＝z8・θc3＋z9・θc2＋z10・θc＋z11 という形の３次の多項式関数（z8〜z11は定数値）によ
り表される。
【０１１２】そして、床反力作用点ベクトルを求める際
は、大腿部９の傾斜角度θcの正負を識別すると共に、
大腿部９の傾斜角度θcの時系列データの一階微分で算
出される大腿部９の傾斜角速度の正負を識別する。さら
に、これらの識別された傾斜角度θcの正負と傾斜角速
度の正負とから現在どの相に存するかを判別して、判別
された相の近似式に大腿部９の傾斜角度θcの今回値を
代入することにより床反力作用点ベクトルを算出する。
これにより、大腿部９の傾斜角度θcの減少過程での床
反力作用点ベクトルの値と増加過程での床反力作用点ベ
クトルの値とを区別して算出することができる。
【０１１３】尚、本実施形態では、脚体２の大腿部９の
傾斜角度θcと床反力作用点ベクトルとの相関関係を多
項式で近似して、床反力作用点ベクトルを求めるように
したが、図５及び図６に示した相関関係をデータテーブ
ルにより記憶保持しておき、そのデータテーブルを用い
て、大腿部９の傾斜角度θcから床反力作用点ベクトル
を求めるようにすることも可能である。
【０１１４】また、床反力作用点の位置は、接地してい
る脚体２の膝関節１０の屈曲角度との相関性もあり、大
腿部９の傾斜角度θcの代わりに、膝関節角度センサ２
３で計測される膝関節１０の屈曲角度Δθdから、床反
力作用点の位置を推定するようにしてもよく、あるい
は、大腿部９の傾斜角度θcと膝関節１０の屈曲角度Δ
θdとの両者を用いて、マップ等により床反力作用点の
位置を推定するようにしてもよい。
【０１１５】さらに、人間１が椅子に座るときや椅子に
座っている状態から立ち上がるときは、床反力作用点の
位置と膝関節１０の屈曲角度Δθdとの間に図７（椅子
座り時），図８（椅子立ち時）に示す相関関係が成立
し、階段を上るときや下るときは、床反力作用点の位置
と大腿部９の傾斜角度θcとの間に図９（階段上り
時）、図１０（階段下り時）が成立する。従って、椅子
に座ったり立ち上がるときは、膝関節１０の屈曲角度Δ
θdから図７，図８の相関関係に基づいて床反力作用点
の位置を推定でき、また、階段を上り下りするときは、
大腿部９の傾斜角度θ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(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）であ
る。
【０１２０】従って、各脚体２の膝関節１０に作用する
関節反力T(Ｆ2x，Ｆ2z)は、脚体各部加速度算出手段３
３により求められた下腿部１１の重心G2の加速度T(a
2x，a2z)のデータと、床反力推定手段３６により求めら
れる床反力（＝T(Ｆ1x，Ｆ1z)）のデータと、下腿部１
１のあらかじめ求められた重量m2のデータと、重力加速
度ｇの値とから、上記式（１０）により求められる。
【０１２１】また、図１１を参照して、下腿部１１の先
端部の足首部１２に作用するモーメントをＭ1、下腿部
１１の膝関節１０の部分に作用するモーメントをＭ2、
下腿部１１の重心G2の回りの慣性モーメントをIG2、下
腿部１１の重心G2の回りの角加速度をα2とする。ま
た、前記図４に対応させて、下腿部１１の重心G2と膝関
節１０の中心との間の距離をt2、下腿部１１の重心G2と
足首部１２との間の距離をt2’（＝Ld−t2）とすると、
下腿部１１の重心G2の回りの回転運動に関する運動方程
式は、次式（１１）となる。
【０１２２】 IG2・α2＝M1−M2＋F1x・t2’・cosθd−F1z・t2’・sinθd ＋F2x・t2・cosθd−F2z・t2・sinθd ゆえに M2＝M1−IG2・α2＋F1x・t2’・cosθd−F1z・t2’・sinθd ＋F2x・t2・cosθd−F2z・t2・sinθd ……（１１）
【０１２３】ここで、式（１１）中のM1は、同式（１
１）に係わる下腿部１１を有する脚体２について前記床
反力作用点推定手段３５により求められる床反力作用点
ベクトルと、該脚体２について前記床反力推定手段３６
により求められる床反力ベクトルとの外積（ベクトル
積）として得られるモーメントである。また、α2は、
前記脚体各部角加速度算出手段３４により求められる下
腿部１１の角加速度である。また、θdは前記脚体姿勢
算出手段２８により求められる下腿部１１の傾斜角度で
ある。また、T(Ｆ1x，Ｆ1z)は、前述の通り、床反力推
定手段３６により求められる床反力の推定値である。さ
らに、T(F2x，F2z)は、前記式（１０）により求められ
るものである。また、慣性モーメントIG2は下腿部１１
の重量m2やサイズのデータ等と共に、あらかじめ求めら
れて演算処理装置１６に記憶されるものである。
【０１２４】従って、膝関節１０に作用するモーメント
M2は、床反力推定手段３６による床反力の推定値のデー
タと、床反力作用点推定手段３５による床反力作用点ベ
クトルのデータと、脚体各部角加速度算出手段３４によ
る下腿部１１の角加速度α2のデータと、脚体姿勢算出
手段２８による下腿部１１の傾斜角度θdのデータと、
前記式（１０）により求められた関節反力T(F2x，F2z)
のデータと、あらかじめ求めた下腿部１１の慣性モーメ
ントIG2、サイズ（Ld）、重心G2の位置(t2)のデータと
から前記式（１１）により求められる。
【０１２５】関節モーメント推定手段３７は、上記のよ
うにして下腿部１１の膝関節１０の部分に作用するモー
メント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・t1’・cosθc−F2z・t1’・sinθc ＋F3x・t1・cosθc−F3z・t1・sinθc ……（１３）
【０１３１】ここで、M2は、前記式（１１）により求め
られた膝関節１０のモーメント、T(Ｆ2x，Ｆ2z)は、前
記式（１０）により求められた膝関節１０の関節反力、
T(Ｆ3x，Ｆ3z)は、前記式（１２）により求められた股
関節８の関節反力、IG1は、あらかじめ求めた大腿部９
の重心G1の回りの慣性モーメント、α1は前記脚体各部
角加速度算出手段３４により求められる大腿部９の角加
速度、θcは前記脚体姿勢算出手段２８により求められ
る大腿部９の傾斜角度である。また、t1は、股関節８の
中心から大腿部９の重心G1までの距離（図４参照）、t
1’は、膝関節１０の中心から大腿部９の重心G1までの
距離（図４ではLc−t1）であり、これらは、あらかじめ
求めた重心G1の位置や大腿部９のサイズ（長さ）から定
まるものである。
【０１３２】以上説明した処理が、前記演算処理装置１
６のサイクルタイム毎に逐次実行され、各脚体２に作用
する床反力や、各脚体２の膝関節１０及び股関節８に作
用するモーメントが逐次リアルタイムで推定される。
【０１３３】尚、本明細書での詳細な説明は省略する
が、求められた膝関節１０や股関節８のモーメントの推
定値は、例えば人間１の歩行を補助する装置（膝関節１
０や股関節８に補助トルクを付与可能な電動モータ等を
含む装置）の制御に用いられる。
【０１３４】前述した演算処理装置１６の処理により求
められた床反力の推定値（詳しくは、該床反力の推定値
の絶対値）の経時変化の様子を図１２〜図１４に実線で
例示する。また、演算処理装置１６の処理により求めら
れた膝関節１０及び股関節８のモーメントの推定値の経
時変化の様子を図１５に実線で例示する。ここで、図１
２及び図１５は、人間１が平地をほぼ一定速度で歩行し
た場合の例示、図１３は人間１が階段を歩行して昇った
場合の例示、図１４は人間１が椅子に座った状態から立
ち上がった場合の例示である。この場合、図１２〜図１
４では、フォースメータ等を用いて床反力を実測した比
較例（床反力の真値に相当するもの）が仮想線で併記さ
れている。また、図１５ではトルクメータ等を用いて膝
関節１０及び股関節８のモーメントを実測した比較例
（膝関節１０及び股関節８のモーメントの真値に相当す
るもの）が仮想線で併記されている。
【０１３５】図１２〜図１４を参照して明らかなよう
に、本実施形態によれば、脚体２の運動形態や運動環境
によらずに精度のよい床反力の推定値が得られているこ
とが判る。また、本実施形態ではこの床反力の推定値を
用いることによって、図１５に示されるように、膝関節
１０や股関節８のモーメントも比較的精度よく推定する
ことができる。
【０１３６】以上のように、本実施形態によれば、脚体
２に人間１の歩行の邪魔となったり、脚体２の運動に負
担がかかるようなセンサを装着したりすることなく、股
関節８や股関節８に装着した角度センサ２２，２３や、
胴体５に装備したジャイロセンサ１４，１９及び加速度
センサ１５，２０，２１というような比較的小型で軽量
なセンサを用いて各脚体２に作用する床反力や、各脚体
２の股関節８及び膝関節１０に作用するモーメントをリ
アルタイムで容易に推定することができる。しかも、そ
の推定を、平地での歩行、階段での歩行等、脚体２の運
動形態や運動環境によらずに比較的精度よく行うことが
できる。
【０１３７】尚、以上説明した実施形態では、本発明を
人間１に適用した場合を例にとって説明したが、二足歩
行移動体としての二足歩行ロボットにも本発明を適用す
ることができる。ここで、二足歩行ロボットでは、腰部
と胸部とが一体的な構造となっている場合があるが、こ
の場合には、ジャイロセンサや前後方向の加速度センサ
を腰部及び胸部のいずれか一方だけに取り付けて、床反
力や脚体の関節のモーメントを本実施形態と同様に推定
するようにすることも可能である。また、二足歩行ロボ
ットでは、股関節や膝関節の屈曲角度は、それらの関節
のアクチュエータに対する制御装置の制御量により把握
するようにすることも可能である。
【０１３８】また、前記実施形態では、脚体２の運動状
態を判断するために、腰部上下加速度センサ２１の検出
データをそのまま用いたが、該検出データの代わりに、
例えば前記基準加速度計測手段２７により求められる絶
対座標系Ｃfでの腰部３の加速度ａ0の鉛直方向（Ｚ軸方
向）の成分の値を用いるようにしてもよい。
【図面の簡単な説明】
【図１】本発明の床反力推定方法の基本的原理を説明す
るための図。
【図２】本発明の一実施形態における二足歩行移動体と
しての人間と該人間に装備する装置構成を模式化して示
す図。
【図３】図２の装置に備える演算処理装置の機能を説明
するためのブロック図。
【図４】図３の演算処理装置の処理に用いる剛体リンク
モデルを示す図。
【図５】通常歩行時における床反力作用点ベクトルの進
行方向成分と大腿部の傾斜角度との相関関係を示す線
図。
【図６】通常歩行時における床反力作用点ベクトルの鉛
直方向成分と大腿部の傾斜角度との相関関係を示す線
図。
【図７】椅子座り時における床反力作用点ベクトルの進
行方向成分と膝関節の屈曲角度との相関関係を示す線
図。
【図８】椅子立ち上がり時における床反力作用点ベクト
ルの進行方向成分と膝関節の屈曲角度との相関関係を示
す線図。
【図９】階段上り時における床反力作用点ベクトルの進
行方向成分と大腿部の傾斜角度との相関関係を示す線
図。
【図１０】階段下り時における床反力作用点ベクトルの
進行方向成分と大腿部の傾斜角度との相関関係を示す線
図。
【図１１】図３の演算処理装置の関節モーメント推定手
段における処理を説明するための図。
【図１２】本発明の実施形態により求められた通常歩行
時の床反力の推定値の経時変化の様子を例示するグラ
フ。
【図１３】本発明の実施形態により求められた階段上り
時の床反力の推定値の経時変化の様子を例示するグラ
フ。
【図１４】本発明の実施形態により求められた椅子立ち
上がり時の床反力の推定値の経時変化の様子を例示する
グラフ。
【図１５】本発明の実施形態により求められた膝関節及
び股関節のモーメントの推定値の経時変化の様子を例示
するグラフ。
【符号の説明】
１…人間（二足歩行移動体）、２…脚体、３…腰部、４
…胸部、５…胴体、８…股関節、９…大腿部、１０…膝
関節、１１…下腿部、１２…足首部（特定部位）、Ｏ…
基準点。
───────────────────────────────────────────────────── フロントページの続き (72)発明者 加藤 久 埼玉県和光市中央１丁目４番１号 株式会 社本田技術研究所内 Ｆターム(参考） 3C007 CS08 KS21 KS23 KS24 KS33 KX02 MT00 WA03 WA13

Claims (9)

    【特許請求の範囲】
  1. 【請求項１】二足歩行移動体の各脚体に作用する床反力
    を推定する方法であって、 前記二足歩行移動体の脚体の運動状態がその一方のみの
    脚体が接地している単脚支持状態であるか両脚体が接地
    している両脚支持状態であるかを判断する第１ステップ
    と、前記二足歩行移動体の重心の位置を逐次求めつつ、
    該重心の位置の時系列データを用いて床に対して固定さ
    れた絶対座標系での該重心の加速度を逐次求める第２ス
    テップと、少なくとも前記両脚支持状態において各脚体
    の下端部近傍にあらかじめ定めた特定部位の前記重心に
    対する位置を逐次求める第３ステップとを備え、 前記二足歩行移動体の単脚支持状態であるときには、二
    足歩行移動体の重量と重力加速度と前記重心の加速度と
    接地している脚体に作用する前記床反力とにより表され
    る該重心の運動方程式に基づき、接地している脚体に作
    用する前記床反力の推定値を逐次求め、 前記二足歩行移動体の両脚支持状態であるときには、二
    足歩行移動体の重量と重力加速度と前記重心の加速度と
    両脚体のそれぞれに作用する前記床反力とにより表され
    る該重心の運動方程式と、各脚体に作用する前記床反力
    が該脚体の前記特定部位から前記重心に向かって作用す
    ると仮定して定まる、各脚体の特定部位の前記重心に対
    する位置と該脚体に作用する前記床反力との間の関係式
    とに基づき両脚体のそれぞれに作用する前記床反力の推
    定値を逐次求めることを特徴とする二足歩行移動体の床
    反力推定方法。
  2. 【請求項２】前記各脚体の特定部位は、該脚体の足首部
    であることを特徴とする請求項１記載の二足歩行移動体
    の床反力推定方法。
  3. 【請求項３】前記両脚体上に各脚体の股関節を介して支
    持された胴体の股関節寄りの下部の上下方向の加速度を
    計測するステップを備え、前記第１ステップでは、前記
    胴体の下部の上下方向の加速度があらかじめ定めた所定
    の閾値以上に上昇した時に前記両脚支持状態が開始する
    と共に前記単脚支持状態が終了し、且つ、前記両脚支持
    状態で先行して離床する側の脚体に作用する前記床反力
    の推定値があらかじめ定めた所定の閾値以下に低下した
    時に前記両脚支持状態が終了すると共に前記単脚支持状
    態が開始するとして、前記二足歩行移動体の運動状態を
    判断することを特徴とする請求項１又は２記載の二足歩
    行移動体の床反力推定方法。
  4. 【請求項４】前記両脚体上に各脚体の股関節を介して支
    持された胴体の傾斜角度と、各脚体の少なくとも股関節
    及び膝関節のそれぞれの屈曲角度と、前記二足歩行移動
    体のあらかじめ定めた基準点の前記絶対座標系における
    加速度とをそれぞれ計測するステップを備え、前記第２
    ステップでは、前記胴体の傾斜角度と、前記股関節及び
    膝関節のそれぞれの屈曲角度と、前記二足歩行移動体を
    複数の剛体の連結体として表してなる剛体リンクモデル
    と、該剛体リンクモデルの各剛体に対応する二足歩行移
    動体の各剛体相当部のあらかじめ求めた重量と、各剛体
    相当部における該剛体相当部のあらかじめ求めた重心の
    位置とに基づき、前記基準点に対する前記二足歩行移動
    体の重心の位置を逐次求めると共に、その重心の位置の
    時系列データに基づき該基準点に対する該重心の加速度
    を逐次求め、その基準点に対する該重心の加速度と、前
    記絶対座標系における該基準点の加速度とから該絶対座
    標系での前記重心の加速度を求めることを特徴とする請
    求項１〜３のいずれか１項に記載の二足歩行移動体の床
    反力推定方法。
  5. 【請求項５】前記基準点は、前記胴体に設定されている
    ことを特徴とする請求項４記載の二足歩行移動体の床反
    力推定方法。
  6. 【請求項６】前記胴体は、前記両脚体に股関節を介して
    連結された腰部と、該腰部上に該腰部に対して傾斜可能
    に存する胸部とを有し、前記重心の位置を求めるために
    用いる前記胴体の傾斜角度は、前記腰部及び胸部のそれ
    ぞれの傾斜角度であることを特徴とする請求項４又は５
    記載の二足歩行移動体の床反力推定方法。
  7. 【請求項７】前記剛体リンクモデルは、前記二足歩行移
    動体の各脚体の膝関節の下側に存する下腿部と、該膝関
    節及び前記股関節の間の大腿部と、前記腰部と、該腰部
    の上側に存する前記胸部を含む上体部とをそれぞれ剛体
    として表したモデルであることを特徴とする請求項６記
    載の二足歩行移動体の床反力推定方法。
  8. 【請求項８】請求項１〜３のいずれか１項に記載の二足
    歩行移動体の床反力推定方法により逐次求めた前記各脚
    体に係る床反力の推定値を用いて前記二足歩行移動体の
    各脚体の少なくとも一つの関節に作用するモーメントを
    推定する方法であって、 前記両脚体上に各脚体の股関節を介して支持された胴体
    の傾斜角度と、前記各脚体の少なくとも股関節及び膝関
    節のそれぞれの屈曲角度と、記二足歩行移動体のあらか
    じめ定めた基準点の前記絶対座標系における加速度とを
    それぞれ計測するステップと、 前記胴体の傾斜角度と、前記各脚体の股関節及び膝関節
    のそれぞれの屈曲角度と、前記二足歩行移動体を複数の
    剛体の連結体として表してなる剛体リンクモデルとに基
    づき、該剛体リンクモデルの各剛体に対応する二足歩行
    移動体の各剛体相当部の傾斜角度を逐次求めるステップ
    と、 前記各剛体相当部の傾斜角度と各剛体相当部のあらかじ
    め求めた重量と各剛体相当部における該剛体相当部のあ
    らかじめ求めた重心の位置とに基づき、前記基準点に対
    する各剛体相当部の重心の位置を逐次求めると共に、そ
    の各剛体相当部の重心の位置の時系列データに基づき該
    基準点に対する各剛体相当部の重心の加速度を逐次求め
    るステップと、 該基準点に対する各剛体相当部の重心の加速度と、前記
    絶対座標系における前記基準点の加速度とから該絶対座
    標系における各剛体相当部の重心の加速度を逐次求める
    ステップと、 前記各剛体相当部の傾斜角度の時系列データに基づき各
    剛体相当部の角加速度を逐次求めるステップと、 前記二足歩行移動体の剛体相当部としての各脚体の大腿
    部の傾斜角度と、該脚体の膝関節の屈曲角度とのうちの
    少なくとも一方に基づき該二足歩行移動体における各脚
    体の床反力作用点の推定位置を逐次求めるステップとを
    備え、 前記床反力の推定値と、前記床反力作用点の推定位置
    と、前記絶対座標系における各剛体相当部の重心の加速
    度及び該剛体相当部の角加速度と、各剛体相当部の傾斜
    角度と、各剛体相当部のあらかじめ求めた重量及びサイ
    ズと、各剛体相当部における該剛体相当部のあらかじめ
    求めた重心の位置と、各剛体相当部のあらかじめ求めた
    慣性モーメントとを用いて逆動力学モデルに基づき前記
    二足歩行移動体の各脚体の少なくとも一つの関節に作用
    するモーメントを推定することを特徴とする二足歩行移
    動体の関節モーメント推定方法。
  9. 【請求項９】請求項４〜７のいずれか１項に記載の二足
    歩行移動体の床反力推定方法により逐次求めた前記各脚
    体に係る床反力の推定値を用いて前記二足歩行移動体の
    各脚体の少なくとも一つの関節に作用するモーメントを
    推定する方法であって、 前記胴体の傾斜角度と、前記各脚体の股関節及び膝関節
    のそれぞれの屈曲角度と、前記剛体リンクモデルとに基
    づき、該剛体リンクモデルの各剛体に対応する二足歩行
    移動体の各剛体相当部の前記絶対座標系における傾斜角
    度を逐次求めるステップと、 前記各剛体相当部の傾斜角度と各剛体相当部のあらかじ
    め求めた重量と各剛体相当部における該剛体相当部の重
    心の位置とに基づき、前記基準点に対する各剛体相当部
    の重心の位置を逐次求めると共に、その各剛体相当部の
    重心の位置の時系列データに基づき該基準点に対する各
    剛体相当部の重心の加速度を逐次求めるステップと、 該基準点に対する各剛体相当部の重心の加速度と、前記
    絶対座標系における前記基準点の加速度とから該絶対座
    標系における各剛体相当部の重心の加速度を逐次求める
    ステップと、 前記各剛体相当部の傾斜角度の時系列データに基づき各
    剛体相当部の角加速度を逐次求めるステップと、 前記二足歩行移動体の剛体相当部としての各脚体の大腿
    部の傾斜角度と、該脚体の膝関節の屈曲角度とのうちの
    少なくとも一方に基づき該二足歩行移動体における各脚
    体の床反力作用点の推定位置を逐次求めるステップとを
    備え、 前記床反力の推定値と、前記床反力作用点の推定位置
    と、前記絶対座標系における各剛体相当部の重心の加速
    度及び該剛体相当部の角加速度と、各剛体相当部の傾斜
    角度と、各剛体相当部のあらかじめ求めた重量及びサイ
    ズと、各剛体相当部における該剛体相当部のあらかじめ
    求めた重心の位置と、各剛体相当部のあらかじめ求めた
    慣性モーメントとを用いて逆動力学モデルに基づき前記
    二足歩行移動体の各脚体の少なくとも一つの関節に作用
    するモーメントを推定することを特徴とする二足歩行移
    動体の関節モーメント推定方法。
JP2002039201A 2001-06-27 2002-02-15 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 Expired - Fee Related JP4188607B2 (ja)

Priority Applications (8)

Application Number Priority Date Filing Date Title
JP2002039201A JP4188607B2 (ja) 2001-06-27 2002-02-15 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法
CNB028128966A CN1290676C (zh) 2001-06-27 2002-06-27 双脚行走移动体所受地面反向力及关节力矩的推定方法
EP02736183A EP1415770B1 (en) 2001-06-27 2002-06-27 Method of estimating floor reactions of bipedal walking body; and method of estimating joint moments of bipedal walking body
US10/481,858 US6915230B2 (en) 2001-06-27 2002-06-27 Method of estimating floor reactions of bipedal walking body, and method of estimating joint moments of bipedal walking body
CA2451730A CA2451730C (en) 2001-06-27 2002-06-27 Method of estimating floor reactions of bipedal walking body, and method of estimating joint moments of bipedal walking body
KR1020037016830A KR100847319B1 (ko) 2001-06-27 2002-06-27 2족보행 이동체의 상반력 추정 방법 및 2족보행 이동체의관절 모멘트 추정 방법
DE60237288T DE60237288D1 (de) 2001-06-27 2002-06-27 Verfahren zur abschätzung von bodenreaktionen eines zweipedalgehkörpers und verfahren zur abschätzung von gelenkmomenten eines zweipedalgehkörpers
PCT/JP2002/006467 WO2003002309A1 (fr) 2001-06-27 2002-06-27 Procede d'estimation des reactions au sol du corps d'un bipede pendant une marche, et procede d'estimation des moments sur les articulations du corps d'un bipede pendant une marche

Applications Claiming Priority (5)

Application Number Priority Date Filing Date Title
US30081501P 2001-06-27 2001-06-27
US60/300,815 2001-06-27
JP2001-214174 2001-07-13
JP2001214174 2001-07-13
JP2002039201A JP4188607B2 (ja) 2001-06-27 2002-02-15 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法

Publications (2)

Publication Number Publication Date
JP2003089083A true JP2003089083A (ja) 2003-03-25
JP4188607B2 JP4188607B2 (ja) 2008-11-26

Family

ID=27347157

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2002039201A Expired - Fee Related JP4188607B2 (ja) 2001-06-27 2002-02-15 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法

Country Status (8)

Country Link
US (1) US6915230B2 (ja)
EP (1) EP1415770B1 (ja)
JP (1) JP4188607B2 (ja)
KR (1) KR100847319B1 (ja)
CN (1) CN1290676C (ja)
CA (1) CA2451730C (ja)
DE (1) DE60237288D1 (ja)
WO (1) WO2003002309A1 (ja)

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2004091865A1 (ja) * 2003-04-17 2004-10-28 Honda Motor Co., Ltd. 二足歩行移動体の床反力作用点推定方法及び二足歩行移動体の関節モーメント推定方法
WO2004091866A1 (ja) * 2003-04-17 2004-10-28 Honda Motor Co., Ltd. 二足歩行移動体の床反力作用点推定方法及び二足歩行移動体の関節モーメント推定方法
WO2005079725A1 (ja) * 2004-02-25 2005-09-01 Honda Motor Co., Ltd. 脚体運動補助装具の発生トルク制御方法
JP2006014837A (ja) * 2004-06-30 2006-01-19 Honda Motor Co Ltd 運動測定方法、運動測定装置及び運動測定プログラム
US7017395B2 (en) 2002-01-28 2006-03-28 Honda Giken Kogyo Kabushiki Kaisha Method of estimating floor reaction of bipedal movable body
WO2006064657A1 (ja) * 2004-12-16 2006-06-22 Honda Motor Co., Ltd. 外力制御方法、外力制御システム及び外力制御プログラム
JP2008126382A (ja) * 2006-11-24 2008-06-05 Toyota Motor Corp 脚式移動ロボット、及びその制御方法
US7431707B2 (en) 2004-12-17 2008-10-07 Honda Motor Co., Ltd. Support moment control method for leg motion support orthosis
KR100894895B1 (ko) 2007-05-21 2009-04-30 연세대학교 산학협력단 운동, 균형 및 보행측정방법 및 치료시스템
US7698020B2 (en) 2003-07-11 2010-04-13 Honda Motor Co., Ltd. Method of estimating joint moment of two-legged walking mobile body
US7756607B2 (en) 2004-12-17 2010-07-13 Honda Motor Co., Ltd. Floor reaction force estimation method for two-legged walking mobile body
US7860607B2 (en) 2003-07-11 2010-12-28 Honda Motor Co., Ltd. Method of estimating joint moment of bipedal walking body
JP2012006087A (ja) * 2010-06-22 2012-01-12 Honda Motor Co Ltd ロボット及びロボットの外力検出機構
JP2012502341A (ja) * 2008-09-04 2012-01-26 コーニンクレッカ フィリップス エレクトロニクス エヌ ヴィ 転倒防止システム
WO2019235020A1 (ja) * 2018-06-05 2019-12-12 ソニー株式会社 情報処理装置、情報処理方法及びプログラム

Families Citing this family (111)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB0106037D0 (en) * 2001-03-12 2001-05-02 Univ Strathclyde Activity monitor
US6963185B2 (en) * 2002-04-26 2005-11-08 Honda Giken Kogyo Kabushiki Kaisha System for estimating attitude of leg type moving robot itself
US7490012B2 (en) * 2002-05-29 2009-02-10 Japan Science And Technology Agency Body dynamics calculation method, body dynamics model and model data thereof, and body-model generation method
JP4410051B2 (ja) * 2004-07-22 2010-02-03 本田技研工業株式会社 角速度計測装置および脚式移動ロボット
EP1850803B1 (en) * 2005-02-18 2014-03-26 Zimmer, Inc. Smart joint implant sensors
ATE426379T1 (de) * 2005-04-12 2009-04-15 Honda Motor Co Ltd Aktive steuerung einer fussgelenkorthese
EP1897523B1 (en) * 2005-05-31 2012-09-19 Honda Motor Co., Ltd. Walking assisting device
US20070112287A1 (en) * 2005-09-13 2007-05-17 Fancourt Craig L System and method for detecting deviations in nominal gait patterns
US7353135B2 (en) * 2006-03-07 2008-04-01 Robert Malm Positioning and aligning the parts of an assembly
US8849457B2 (en) 2006-07-17 2014-09-30 Raytheon Company Contact displacement actuator system
US7949430B2 (en) * 2006-11-29 2011-05-24 Honda Motor Co., Ltd. Determination of foot placement for humanoid push recovery
WO2008091227A1 (en) * 2007-01-22 2008-07-31 National University Of Singapore Method and system for fall-onset detection
WO2008106618A1 (en) * 2007-02-28 2008-09-04 Raytheon Sarcos, Llc Fluid control system having selective recruitable actuators
US8061261B2 (en) * 2007-02-28 2011-11-22 Raytheon Company Antagonistic fluid control system for active and passive actuator operation
JP4840239B2 (ja) * 2007-04-20 2011-12-21 トヨタ自動車株式会社 脚式移動ロボットの制御方法及び脚式移動ロボット
JP4271713B2 (ja) * 2007-10-19 2009-06-03 本田技研工業株式会社 運動補助装置
DE102008027639A1 (de) * 2008-06-06 2009-12-24 Fior & Gentz Gmbh Orthesengelenk zum Unterstützen eines anatomischen Kniegelenks
US20110082566A1 (en) * 2008-09-04 2011-04-07 Herr Hugh M Implementing a stand-up sequence using a lower-extremity prosthesis or orthosis
EP2341821A1 (en) * 2008-09-23 2011-07-13 Koninklijke Philips Electronics N.V. Power measurement method and apparatus
US8352077B2 (en) * 2008-12-19 2013-01-08 Honda Motor Co., Ltd. Inertia shaping for humanoid fall direction change
US8369991B2 (en) * 2008-12-19 2013-02-05 Honda Motor Co., Ltd. Humanoid fall direction change among multiple objects
KR20110082394A (ko) * 2010-01-11 2011-07-19 삼성전자주식회사 보행 로봇 및 그 제어 방법
KR101687630B1 (ko) * 2010-01-11 2016-12-20 삼성전자주식회사 보행 로봇 및 그 균형 제어 방법
KR101633362B1 (ko) * 2010-01-18 2016-06-28 삼성전자 주식회사 인간형 로봇 및 그 보행 제어방법
CH703381B1 (fr) 2010-06-16 2018-12-14 Myotest Sa Dispositif portable intégré et procédé pour calculer des paramètres biomécaniques de la foulée.
EP2583657B1 (en) 2010-06-21 2015-02-18 Toyota Jidosha Kabushiki Kaisha Leg support device
JP5685842B2 (ja) 2010-07-12 2015-03-18 セイコーエプソン株式会社 ロボット装置およびロボット装置の制御方法
KR101200191B1 (ko) * 2010-07-14 2012-11-13 서울대학교산학협력단 데이터 기반 바이페드 제어 장치 및 방법
JP2012081568A (ja) * 2010-10-14 2012-04-26 Sony Corp ロボットの制御装置及び制御方法、並びにコンピューター・プログラム
US20120101415A1 (en) 2010-10-21 2012-04-26 Amit Goffer Locomotion assisting apparatus with integrated tilt sensor
CN102290178B (zh) * 2011-04-18 2013-04-03 上海理工大学 一种多功能电阻成型机
US9789603B2 (en) 2011-04-29 2017-10-17 Sarcos Lc Teleoperated robotic system
US9566710B2 (en) 2011-06-02 2017-02-14 Brain Corporation Apparatus and methods for operating robotic devices using selective state space training
JP5907678B2 (ja) * 2011-07-20 2016-04-26 オリンパス株式会社 医療用動作機構およびマニピュレータ
JP5982767B2 (ja) * 2011-09-26 2016-08-31 ソニー株式会社 運動補助装置及び運動補助方法、コンピューター・プログラム、並びにプログラム記録媒体
JP5399593B2 (ja) * 2011-11-10 2014-01-29 パナソニック株式会社 ロボット、ロボットの制御装置、制御方法、及び制御プログラム
US9616580B2 (en) 2012-05-14 2017-04-11 Sarcos Lc End effector for a robotic arm
AU2013302207B2 (en) * 2012-08-07 2018-03-08 Dorsavi Pty Ltd Method and apparatus for measuring reaction forces
US9764468B2 (en) 2013-03-15 2017-09-19 Brain Corporation Adaptive predictor apparatus and methods
US9242372B2 (en) 2013-05-31 2016-01-26 Brain Corporation Adaptive robotic interface apparatus and methods
US9384443B2 (en) 2013-06-14 2016-07-05 Brain Corporation Robotic training apparatus and methods
US9792546B2 (en) 2013-06-14 2017-10-17 Brain Corporation Hierarchical robotic controller apparatus and methods
US9314924B1 (en) 2013-06-14 2016-04-19 Brain Corporation Predictive robotic controller apparatus and methods
CN103340603A (zh) * 2013-07-02 2013-10-09 北京邮电大学 一种人体惯性参数识别方法
US9579789B2 (en) 2013-09-27 2017-02-28 Brain Corporation Apparatus and methods for training of robotic control arbitration
KR102146363B1 (ko) * 2013-10-31 2020-08-20 삼성전자주식회사 착용형 로봇 및 그 제어 방법
US9463571B2 (en) 2013-11-01 2016-10-11 Brian Corporation Apparatus and methods for online training of robots
US9597797B2 (en) 2013-11-01 2017-03-21 Brain Corporation Apparatus and methods for haptic training of robots
KR20150055958A (ko) * 2013-11-14 2015-05-22 삼성전자주식회사 착용형 로봇 및 그 제어 방법
KR102073001B1 (ko) * 2013-11-29 2020-02-04 삼성전자주식회사 착용형 로봇 및 그 제어 방법
US9358685B2 (en) * 2014-02-03 2016-06-07 Brain Corporation Apparatus and methods for control of robot actions based on corrective user inputs
CN103802909A (zh) * 2014-02-25 2014-05-21 中国人民解放军军事交通学院 四足机器人腿部联动机构
US9346167B2 (en) 2014-04-29 2016-05-24 Brain Corporation Trainable convolutional network apparatus and methods for operating a robotic vehicle
US10766133B2 (en) 2014-05-06 2020-09-08 Sarcos Lc Legged robotic device utilizing modifiable linkage mechanism
US9387588B1 (en) * 2014-08-25 2016-07-12 Google Inc. Handling gait disturbances with asynchronous timing
US10081098B1 (en) 2014-08-25 2018-09-25 Boston Dynamics, Inc. Generalized coordinate surrogates for integrated estimation and control
US9618937B1 (en) 2014-08-25 2017-04-11 Google Inc. Slip detection using robotic limbs
JP5876550B1 (ja) * 2014-08-28 2016-03-02 国立大学法人九州大学 関節運動補助装置
US9381961B1 (en) * 2014-09-04 2016-07-05 Google Inc. Robotic systems having protrusions for use in starting positions and in use positions
US9630318B2 (en) 2014-10-02 2017-04-25 Brain Corporation Feature detection apparatus and methods for training of robotic navigation
JP6228097B2 (ja) * 2014-10-06 2017-11-08 本田技研工業株式会社 移動ロボット
US9446518B1 (en) * 2014-11-11 2016-09-20 Google Inc. Leg collision avoidance in a robotic device
US9499218B1 (en) 2014-12-30 2016-11-22 Google Inc. Mechanically-timed footsteps for a robotic device
US9717387B1 (en) 2015-02-26 2017-08-01 Brain Corporation Apparatus and methods for programming and training of robotic household appliances
US9594377B1 (en) * 2015-05-12 2017-03-14 Google Inc. Auto-height swing adjustment
US9586316B1 (en) 2015-09-15 2017-03-07 Google Inc. Determination of robotic step path
US10471594B2 (en) * 2015-12-01 2019-11-12 Kindred Systems Inc. Systems, devices, and methods for the distribution and collection of multimodal data associated with robots
DE102017000063B4 (de) * 2016-01-14 2019-10-31 Fanuc Corporation Robotereinrichtung mit Lernfunktion
CN105938032A (zh) * 2016-03-18 2016-09-14 温州大学 人体地面反力间接测试系统以及进行人体地面反力间接测试的方法
US9789919B1 (en) 2016-03-22 2017-10-17 Google Inc. Mitigating sensor noise in legged robots
CN105640742B (zh) * 2016-04-01 2018-10-19 中山长曜医疗器材有限公司 一种关节随动辅助装置
CA3022383A1 (en) * 2016-04-29 2017-11-02 Softbank Robotics Europe A mobile robot with enhanced balanced motion and behavior capabilities
JP6682341B2 (ja) * 2016-05-10 2020-04-15 パナソニック株式会社 歩行制御方法、歩行制御プログラム及び２足歩行ロボット
US10241514B2 (en) 2016-05-11 2019-03-26 Brain Corporation Systems and methods for initializing a robot to autonomously travel a trained route
US11142267B2 (en) * 2016-06-08 2021-10-12 Nintendo Co., Ltd. Passive walking apparatus and passive walking module
US9987752B2 (en) 2016-06-10 2018-06-05 Brain Corporation Systems and methods for automatic detection of spills
US10282849B2 (en) 2016-06-17 2019-05-07 Brain Corporation Systems and methods for predictive/reconstructive visual object tracker
US10016896B2 (en) 2016-06-30 2018-07-10 Brain Corporation Systems and methods for robotic behavior around moving bodies
KR102566102B1 (ko) * 2016-09-20 2023-08-11 삼성전자주식회사 보행 보조 장치 및 보행 보조 장치의 제어 방법
US10274325B2 (en) 2016-11-01 2019-04-30 Brain Corporation Systems and methods for robotic mapping
US10001780B2 (en) 2016-11-02 2018-06-19 Brain Corporation Systems and methods for dynamic route planning in autonomous navigation
JP6508167B2 (ja) * 2016-11-11 2019-05-08 トヨタ自動車株式会社 歩行訓練システム
US10821614B2 (en) 2016-11-11 2020-11-03 Sarcos Corp. Clutched joint modules having a quasi-passive elastic actuator for a robotic assembly
US10765537B2 (en) 2016-11-11 2020-09-08 Sarcos Corp. Tunable actuator joint modules having energy recovering quasi-passive elastic actuators for use within a robotic system
US10919161B2 (en) 2016-11-11 2021-02-16 Sarcos Corp. Clutched joint modules for a robotic system
US10828767B2 (en) 2016-11-11 2020-11-10 Sarcos Corp. Tunable actuator joint modules having energy recovering quasi-passive elastic actuators with internal valve arrangements
US10723018B2 (en) 2016-11-28 2020-07-28 Brain Corporation Systems and methods for remote operating and/or monitoring of a robot
US10377040B2 (en) 2017-02-02 2019-08-13 Brain Corporation Systems and methods for assisting a robotic apparatus
US10852730B2 (en) 2017-02-08 2020-12-01 Brain Corporation Systems and methods for robotic mobile platforms
US10293485B2 (en) 2017-03-30 2019-05-21 Brain Corporation Systems and methods for robotic path planning
CN109202863B (zh) * 2017-07-04 2023-06-23 现代自动车株式会社 可穿戴式肌肉力量辅助装置及其控制方法和系统
US10843330B2 (en) 2017-12-07 2020-11-24 Sarcos Corp. Resistance-based joint constraint for a master robotic system
US11331809B2 (en) 2017-12-18 2022-05-17 Sarcos Corp. Dynamically controlled robotic stiffening element
KR102546547B1 (ko) * 2018-01-11 2023-06-22 삼성전자주식회사 보행 보조 방법 및 장치
CN109079763B (zh) * 2018-10-29 2023-05-16 河北工业大学 一种可穿戴柔性步行助力机器人控制系统及控制方法
KR102626098B1 (ko) 2018-12-13 2024-01-18 삼성전자주식회사 보행 보조 장치를 제어하는 방법 및 그 방법을 수행하는 전자 장치
CN109634100B (zh) * 2018-12-30 2021-11-02 深圳市优必选科技有限公司 仿人机器人行走加速度补偿方法、装置及仿人机器人
US11351675B2 (en) 2018-12-31 2022-06-07 Sarcos Corp. Robotic end-effector having dynamic stiffening elements for conforming object interaction
US10906191B2 (en) 2018-12-31 2021-02-02 Sarcos Corp. Hybrid robotic end effector
US11241801B2 (en) 2018-12-31 2022-02-08 Sarcos Corp. Robotic end effector with dorsally supported actuation mechanism
CN111588382B (zh) * 2020-06-11 2023-03-31 深圳市丞辉威世智能科技有限公司 重心转移训练的指导方法、装置及存储介质
US11833676B2 (en) 2020-12-07 2023-12-05 Sarcos Corp. Combining sensor output data to prevent unsafe operation of an exoskeleton
CN113317776B (zh) * 2020-12-29 2023-04-07 武汉理工大学 一种无足底压力外骨骼多种运动模式下的步态相位检测方法
CN112790951B (zh) * 2020-12-30 2023-03-10 上海傅利叶智能科技有限公司 识别重心的方法、辅助训练的方法及其系统、智能拐杖
US11794345B2 (en) 2020-12-31 2023-10-24 Sarcos Corp. Unified robotic vehicle systems and methods of control
CN113080946A (zh) * 2021-04-29 2021-07-09 合肥工业大学 一种人体坐站转移能力测量装置、测量方法及电子设备
CN113244090B (zh) * 2021-07-16 2021-09-14 中国科学院自动化研究所 髋关节下肢外骨骼控制方法、装置、电子设备和存储介质
US11826907B1 (en) 2022-08-17 2023-11-28 Sarcos Corp. Robotic joint system with length adapter
US11717956B1 (en) 2022-08-29 2023-08-08 Sarcos Corp. Robotic joint system with integrated safety
US11924023B1 (en) 2022-11-17 2024-03-05 Sarcos Corp. Systems and methods for redundant network communication in a robot
US11897132B1 (en) 2022-11-17 2024-02-13 Sarcos Corp. Systems and methods for redundant network communication in a robot

Family Cites Families (37)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2520019B2 (ja) * 1989-06-29 1996-07-31 本田技研工業株式会社 脚式移動ロボットの駆動制御装置
JP2819353B2 (ja) * 1990-09-28 1998-10-30 本田技研工業株式会社 脚式移動ロボットの歩行制御装置
US5221883A (en) * 1990-11-30 1993-06-22 Honda Giken Kogyo Kabushiki Kaisha System for controlling locomotion of legged walking robot
JP3035051B2 (ja) * 1991-12-20 2000-04-17 本田技研工業株式会社 脚式移動ロボットの歩行制御装置
JP3167404B2 (ja) * 1992-02-26 2001-05-21 本田技研工業株式会社 ロボットの関節駆動制御装置
US5355064A (en) * 1992-03-04 1994-10-11 Honda Giken Kogyo Kabushiki Kaisha Control system for legged mobile robot
US5349277A (en) * 1992-03-12 1994-09-20 Honda Giken Kogyo Kabushiki Kaisha Control system for legged mobile robot
US5455497A (en) * 1992-04-20 1995-10-03 Honda Giken Kogyo Kabushiki Kaisha Legged mobile robot and a system for controlling the same
US5432417A (en) * 1992-04-30 1995-07-11 Honda Giken Kogyo Kabushiki Kaisha Locomotion control system for legged mobile robot
US5416393A (en) * 1992-05-20 1995-05-16 Honda Giken Kogyo Kabushiki Kaisha Legged mobile robot foot structure
JP3132156B2 (ja) * 1992-05-22 2001-02-05 本田技研工業株式会社 脚式移動ロボットの歩容生成装置
DE69307023T2 (de) * 1992-05-26 1997-04-17 Honda Motor Co Ltd Beweglicher Roboter mit Beinen
JP3269852B2 (ja) * 1992-05-29 2002-04-02 本田技研工業株式会社 脚式移動ロボットの姿勢安定化制御装置
US5404086A (en) 1992-07-20 1995-04-04 Honda Giken Kogyo Kabushiki Kaisha System for controlling locomotion of legged mobile robot and correcting inclinometer's output thereof
JP3278467B2 (ja) * 1992-08-18 2002-04-30 本田技研工業株式会社 移動ロボットの制御装置
JP3330710B2 (ja) * 1993-12-30 2002-09-30 本田技研工業株式会社 移動ロボットの位置検知および制御装置
JP3277076B2 (ja) * 1994-09-09 2002-04-22 株式会社小松製作所 歩行ロボットの歩行制御装置および歩行制御方法
US5808433A (en) * 1995-09-29 1998-09-15 Honda Giken Kogyo Kabushiki Kaisha Method of generating gait of legged walking robot and system for controlling its locomotion
JP3662996B2 (ja) * 1996-01-25 2005-06-22 本田技研工業株式会社 脚式移動ロボットの歩行制御装置
WO1998004388A1 (fr) * 1996-07-25 1998-02-05 Honda Giken Kogyo Kabushiki Kaisha Dispositif de reproduction de la demarche pour robot articule muni de jambes
US5872893A (en) * 1996-07-25 1999-02-16 Honda Giken Kogyo Kabushiki Kaisha Gait generation system of legged mobile robot
JP3626303B2 (ja) * 1996-12-18 2005-03-09 本田技研工業株式会社 脚式移動ロボットの足底接地位置検出装置
JP3672406B2 (ja) * 1997-01-31 2005-07-20 本田技研工業株式会社 脚式移動ロボットの歩容生成装置
EP1053835B1 (en) * 1997-01-31 2006-12-27 Honda Giken Kogyo Kabushiki Kaisha Leg type mobile robot control apparatus
WO1999054095A1 (fr) * 1998-04-20 1999-10-28 Honda Giken Kogyo Kabushiki Kaisha Controleur pour robot mobile muni de jambes
CA2271498C (en) * 1998-05-11 2007-01-09 Honda Giken Kogyo Kabushiki Kaisha Legged mobile robot
JP2000066706A (ja) * 1998-08-21 2000-03-03 Matsushita Electric Ind Co Ltd ロボット制御装置とその制御方法
JP3497402B2 (ja) 1999-02-25 2004-02-16 日本電信電話株式会社 運動状態生成装置及び運動状態生成プログラムを記録した記録媒体
JP4213310B2 (ja) * 1999-08-30 2009-01-21 本田技研工業株式会社 ２足歩行脚式移動ロボット
JP3555107B2 (ja) * 1999-11-24 2004-08-18 ソニー株式会社 脚式移動ロボット及び脚式移動ロボットの動作制御方法
JP3615702B2 (ja) * 1999-11-25 2005-02-02 ソニー株式会社 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット
JP4491912B2 (ja) * 2000-05-22 2010-06-30 ソニー株式会社 バッテリ駆動の脚式移動ロボット及びその制御方法
JP2002018680A (ja) * 2000-07-10 2002-01-22 Mitsubishi Electric Corp 工作機械
JP4252721B2 (ja) * 2000-11-17 2009-04-08 本田技研工業株式会社 二足歩行ロボット
JP4184679B2 (ja) * 2001-08-01 2008-11-19 本田技研工業株式会社 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法
US6999851B2 (en) * 2002-08-30 2006-02-14 Sony Corporation Robot apparatus and motion controlling method therefor
US7343223B2 (en) * 2003-03-13 2008-03-11 Alps Electric Co., Ltd. Robot apparatus and load sensor

Cited By (30)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7017395B2 (en) 2002-01-28 2006-03-28 Honda Giken Kogyo Kabushiki Kaisha Method of estimating floor reaction of bipedal movable body
WO2004091866A1 (ja) * 2003-04-17 2004-10-28 Honda Motor Co., Ltd. 二足歩行移動体の床反力作用点推定方法及び二足歩行移動体の関節モーメント推定方法
US7643903B2 (en) 2003-04-17 2010-01-05 Honda Motor Co., Ltd. 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
WO2004091865A1 (ja) * 2003-04-17 2004-10-28 Honda Motor Co., Ltd. 二足歩行移動体の床反力作用点推定方法及び二足歩行移動体の関節モーメント推定方法
US7119510B2 (en) 2003-04-17 2006-10-10 Honda Motor Co., Ltd. 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
US7860607B2 (en) 2003-07-11 2010-12-28 Honda Motor Co., Ltd. Method of estimating joint moment of bipedal walking body
US7698020B2 (en) 2003-07-11 2010-04-13 Honda Motor Co., Ltd. Method of estimating joint moment of two-legged walking mobile body
EP1721593A4 (en) * 2004-02-25 2012-11-07 Honda Motor Co Ltd METHOD FOR CHECKING A GENERATED TORQUE FOR A LEG AND BODY EXERCISE DEVICE
JP4503311B2 (ja) * 2004-02-25 2010-07-14 本田技研工業株式会社 脚体運動補助装具の発生トルク制御方法
EP1721593A1 (en) * 2004-02-25 2006-11-15 HONDA MOTOR CO., Ltd. Generated torque control method for leg body exercise assistive apparatus
US7278954B2 (en) 2004-02-25 2007-10-09 Honda Motor Co., Ltd. Generated torque control method for leg body exercise assistive apparatus
JP2005237504A (ja) * 2004-02-25 2005-09-08 Honda Motor Co Ltd 脚体運動補助装具の発生トルク制御方法
WO2005079725A1 (ja) * 2004-02-25 2005-09-01 Honda Motor Co., Ltd. 脚体運動補助装具の発生トルク制御方法
JP2006014837A (ja) * 2004-06-30 2006-01-19 Honda Motor Co Ltd 運動測定方法、運動測定装置及び運動測定プログラム
JP4549758B2 (ja) * 2004-06-30 2010-09-22 本田技研工業株式会社 運動測定方法、運動測定装置及び運動測定プログラム
US7433733B2 (en) 2004-06-30 2008-10-07 Honda Motor Co., Ltd. Motion measurement method, motion measurement system, and motion measurement program
US7860562B2 (en) 2004-12-16 2010-12-28 Honda Motor Co., Ltd. External force control method, external force control system and external force control program
WO2006064657A1 (ja) * 2004-12-16 2006-06-22 Honda Motor Co., Ltd. 外力制御方法、外力制御システム及び外力制御プログラム
JP4541867B2 (ja) * 2004-12-16 2010-09-08 本田技研工業株式会社 外力制御方法、外力制御システム及び外力制御プログラム
JP2006167223A (ja) * 2004-12-16 2006-06-29 Honda Motor Co Ltd 外力制御方法、外力制御システム及び外力制御プログラム
US7431707B2 (en) 2004-12-17 2008-10-07 Honda Motor Co., Ltd. Support moment control method for leg motion support orthosis
US7756607B2 (en) 2004-12-17 2010-07-13 Honda Motor Co., Ltd. Floor reaction force estimation method for two-legged walking mobile body
JP2008126382A (ja) * 2006-11-24 2008-06-05 Toyota Motor Corp 脚式移動ロボット、及びその制御方法
KR100894895B1 (ko) 2007-05-21 2009-04-30 연세대학교 산학협력단 운동, 균형 및 보행측정방법 및 치료시스템
JP2012502341A (ja) * 2008-09-04 2012-01-26 コーニンクレッカ フィリップス エレクトロニクス エヌ ヴィ 転倒防止システム
JP2012006087A (ja) * 2010-06-22 2012-01-12 Honda Motor Co Ltd ロボット及びロボットの外力検出機構
WO2019235020A1 (ja) * 2018-06-05 2019-12-12 ソニー株式会社 情報処理装置、情報処理方法及びプログラム
JPWO2019235020A1 (ja) * 2018-06-05 2021-06-24 ソニーグループ株式会社 情報処理装置、情報処理方法及びプログラム
JP7200990B2 (ja) 2018-06-05 2023-01-10 ソニーグループ株式会社 情報処理装置、情報処理方法及びプログラム
US11577390B2 (en) 2018-06-05 2023-02-14 Sony Corporation Information processing device and information processing method

Also Published As

Publication number Publication date
EP1415770B1 (en) 2010-08-11
WO2003002309A1 (fr) 2003-01-09
EP1415770A1 (en) 2004-05-06
US6915230B2 (en) 2005-07-05
JP4188607B2 (ja) 2008-11-26
EP1415770A4 (en) 2008-08-27
US20040167641A1 (en) 2004-08-26
CA2451730A1 (en) 2003-01-09
CA2451730C (en) 2010-08-10
CN1520350A (zh) 2004-08-11
KR100847319B1 (ko) 2008-07-21
CN1290676C (zh) 2006-12-20
KR20040018390A (ko) 2004-03-03
DE60237288D1 (de) 2010-09-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
JP4246535B2 (ja) 二足歩行移動体の床反力作用点推定方法及び二足歩行移動体の関節モーメント推定方法
JP3844695B2 (ja) 二足歩行移動体の床反力作用点推定方法
JP4130739B2 (ja) 二足歩行移動体の床反力推定方法
JP2005081536A (ja) ２足歩行移動体の関節モーメント推定方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20041129

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20080617

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20080626

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

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

R150 Certificate of patent or registration of utility model

Ref document number: 4188607

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20110919

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20110919

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20120919

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20120919

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20130919

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20140919

Year of fee payment: 6

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees