JP4815611B2 - 受動歩行脚式ロボット - Google Patents
受動歩行脚式ロボット Download PDFInfo
- Publication number
- JP4815611B2 JP4815611B2 JP2007520167A JP2007520167A JP4815611B2 JP 4815611 B2 JP4815611 B2 JP 4815611B2 JP 2007520167 A JP2007520167 A JP 2007520167A JP 2007520167 A JP2007520167 A JP 2007520167A JP 4815611 B2 JP4815611 B2 JP 4815611B2
- Authority
- JP
- Japan
- Prior art keywords
- leg
- equilibrium point
- walking
- legged mobile
- passive walking
- 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.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
- B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Description
[技術分野]
[0001]
本出願は、2005年6月8日に出願された日本国特許出願第2005−168905号に基づく優先権を主張する。その出願の全ての内容はこの明細書中に参照により援用されている。
本発明は、受動歩行脚式ロボットに関するものである。
[背景技術]
[0002]
脚式移動ロボット、特にZMP(Zero moment point)規範の2足歩行の脚式移動ロボットの姿勢安定化制御としては、下記の特許文献1記載のものなどが知られている。また、脚式移動体、特に受動歩行機の平衡点の安定性については、下記の非特許文献1に詳しい。
[0003]
従来の脚式移動ロボットは、高精度なセンサ、高性能なアクチュエータおよび高度な制御からなる最先端テクノロジーの結晶である。その要になっているのがZMPである。ZMP規範の歩行制御方式では、ZMPを用いた軌道計画およびその制御(計測を含む)に集約される。
[0004]
その一方、無視できない存在となっているのが、受動歩行と呼ばれる歩容である。工学的に応用できるか常に高い関心が寄せられている。受動歩行の特徴は、制御を一切用いずに、脚式移動体のもつダイナミクスと環境(下り坂)との相互作用によって、自然な歩容が生成できることである。
[特許文献1]
日本国特許第3269852号公報
[非特許文献1]
T.McGeer,“Passive Dynamic Walking”,The Int.J.of Robotics Research,vol.9,no.2,pp.62−82,1990.
[発明の開示]
[0005]
ZMPは、歩行時に限らない姿勢安定性に関する力学的に重要な指標であり、転倒しないように歩かせるのに最も強力なツールである。しかし、ZMP規範の姿勢安定化制御では、エネルギー効率の高い歩容を実現することは原理的に困難である。さらに、受動歩行と比べるとその歩容は不自然さを感じさせる。
[0006]
受動歩行では、非線形な脚の振り運動の解が、脚の切換え現象によって不連続にジャンプする。この一種のハイブリッドシステムから周期的な軌道が生成される。軌道がリミットサイクルになると、着地直後の状態が平衡点として固定される。しかし、従来の受動歩行は、平地および上り坂において、安定な平衡点が存在せず定常歩行を行うことができない。また、受動歩行の頑健さは低く、安定した連続歩行は難しい。さらに、平衡点への収束性も悪い。
そこで、本発明は、平衡点を安定化させることのできる受動歩行脚式ロボットを提供することを目的とする。
[0007]
本発明における受動歩行脚式ロボットは、2本の外側脚と、1本の中央脚と、ストッパーを備えている。2本の外側脚は、腰に同軸に回転可能に連結されている。中央脚は、2本の外側脚の間で外側脚と同軸に回転可能に連結されている。ストッパーは、2本の外側脚を連結しており、中央脚を囲むループ状に形成されている。
本明細書において、ストッパーは、平衡点安定化装置又は安定化手段と称される場合がある。また、受動歩行脚式ロボットは、脚式移動体と称される場合がある。
[0008]
平衡点安定化装置(ストッパー)は、受動歩行脚式ロボットにおけるエネルギーバランス、脚の切換えおよび脚の振り運動から前記平衡点を生成するのが好ましい。
[0009]
[0010]
また、安定化手段(ストッパー)は、受動歩行脚式ロボットの脚の着地位置を一定あるいはほぼ一定にすることによって、前記平衡点を大域的に安定化する。
[0011]
さらに、前記安定化手段は、前記平衡点と現在の状態量の偏差に応じて、受動歩行脚式ロボットの脚の着地位置を変化させることによって、該平衡点を局所的に安定化するのが好ましい。
[0012]
本発明によれば、エネルギーバランス、脚の切換えおよび脚の振り運動からなる平衡点の力学的構造から、平地あるいは上り坂において、1歩区間ごとに一定トルクを入力するだけで平衡点が生成できる。結果的に、自然でエネルギー効率の高い歩容が実現できる。
【0013】
脚の着地位置を一定あるいはほぼ一定にすることによって、平衡点を大域的に安定化することができ、極めて安定した連続歩行が可能となる。また、頑健さも格段に増す。
【0014】
平衡点の局所安定化によって有限整定を行い、数ステップでほぼ定常状態に収束する。
【図面の簡単な説明】
【0015】
【図1】膝関節のある脚式移動体を模式的に示す図である。
【図2】歩行シミュレーションの結果を示す図である。
【図3】本発明を使用した脚式移動体の全体を示す概略図である。
【発明を実施するための最良の形態】
【0016】
以下に、本発明の脚式移動体の平衡点安定化装置を実施するための最良の形態を説明する。
【0017】
本発明の脚式移動体の平衡点安定化装置が備える平衡点を生成する生成機構は、平衡点を数値的に探索せずとも、脚式移動体におけるエネルギーバランス、脚の切換えおよび脚の振り運動から、平衡点を直接的に算出することができる。したがって、エネルギーバランス、脚の切換えおよび脚の振り運動を変えることで、生成したい平衡点を作り出すことができる。たとえば、エネルギーバランス式、脚の切換え式および脚の振り運動の式から平衡点を算出し、この平衡点を生成させるために必要な一定トルクを脚式移動体の関節に発生させるのが好ましい。
【0018】
本発明の脚式移動体の平衡点安定化装置において、安定化手段は、平衡点を大域的に安定化するため、脚式移動体の脚の着地位置を一定あるいはほぼ一定にすることを最も主要な特徴とする。脚の着地位置を一定あるいはほぼ一定にするには、好ましくはアクチュエータを使ったサーボ機構により能動的に実現する、より好ましくは受動要素を使って受動的に実現する。たとえば、ストッパーを脚式移動体に装着すると簡単でしかも確実でよい。
【0019】
さらに、平衡点と現在の状態量の偏差に応じて、脚式移動体の脚の着地位置を変化させることによって、平衡点を局所的に安定化することを特徴とする。状態量は、着地直前あるいは直後の状態をとることが好ましく、平衡点からの偏差に応じて、好ましくは離散時間システムの局所(平衡点近傍の)安定性が最も高くなるように、脚の着地位置を変化させ着地させる。
【実施例】
【0020】
(実施例1)
図1は、膝関節のある脚式移動体を模式的に示す。まず、平地(γ=0[rad])における平衡点生成および局所安定化について説明する。図1において、l=0.7[m]、l1=l2=0.35[m]、a1=b1=a2=b2=0.35[m]、p=m2/m1=0.4とした。脚式移動体のエネルギーバランス式、脚の切換え式および脚の振り運動の式から、スロープ角度γ=0.073[rad]に相当する受動歩行クラスの平衡点が導かれる。その際の状態量は、着地直後における股角度αf=0.73750[rad]および支持脚の角速度(dθ/dt)|f +=1.35140[rad/s]となる。なお、本実施例では、支持脚の膝関節は真直ぐに伸ばし、遊脚が真直ぐになった時点で遊脚の膝関節を固定することから、着地直後における股角度は脚の着地位置と等価とみなせる。
【0021】
平衡点を生成させるのに必要な関節トルクベクトルτK、τCを数式1および数式2から計算すると、
τK =[0.50078,−0.275429,−0.125195] [Nm/kgm2]
τC =[0.50078,−0.275429] [Nm/kgm2]
となる。遊脚の膝関節を固定するまではτKを入力し、固定後はτCを入力する。
【0022】
平衡点の股角度αf、支持脚の角速度(dθ/dt)|f +と数式3、4、5から係数を計算すると、
af=0.002[1/s]、bf=−0.8156[1/s]、cf=0.5478
を得る。次に、数式6、7から有限整定となる着地時の股角度の変化率を計算すると、
(∂αk+1/∂αk)|f=0.54861、(∂αk+1/∂((dθ/dt)|+))|f=0.36845[s]
を得る。最終的に、数式8の係数を得られた(∂αk+1/∂αk)|f、(∂αk+1/∂((dθ/dt)|+))|f数値になるように設定すると、
Kα=1.7582、K(dθ/dt)=−1.4508
となる。平衡点近傍では、数式8を用いて脚の着地位置(着地時の股角度)を制御することにより、平衡点を局所安定化することができる。
【0023】
歩行シミュレーションの結果を図2に示す。横軸および縦軸は、それぞれステップ数および着地時の股角度を表す。図からわかるように、平地においても平衡点(歩容)が生成され、3ステップでほぼ定常状態に収束している。
【0024】
本実施例で使用した脚式移動体の概略図を図3に示す。脚式移動体の脚の着地位置(着地時の股角度)を一定とするために、図3に示すような簡単なストッパーを取り付けた。なお、ストッパーはこれに限定されるものではない。脚の着地位置を一定としない場合(ストッパーなし)は、下り坂において5歩以上の連続歩行は不可能であった。一方、着地位置を一定とした場合は、下り坂において9歩(歩行可能な最大歩数)での連続歩行が約70[%]の成功率で達成された。ただし、実験回数は350回である。
【0025】
数式1
【数1】
【0026】
数式2
【数2】
【0027】
数式3
【数3】
【0028】
ただし、
【0029】
数式4
【数4】
【0030】
数式5
【数5】
【0031】
数式6
【数6】
【0032】
数式7
【数7】
【0033】
数式8
【数8】
【0034】
上記式及び図面における記号の意味は次の通りである。
g:重力加速度
γ:スロープ角度
u1:足首トルク、u2:腰トルク、u3:膝トルク
τK:平衡点の関節トルクベクトル
τC:遊脚の膝が真直ぐな状態でロックさせたときの平衡点の関節トルクベクトル
τKとτCは次の通り表すことができる。
τK=[τ1f,τ2f,τ3f]=[u1/M,u2/m1,u3/m2]
τC=[τ1f,τ2f]=[u1/M,u2/m1]
αf:平衡点における着地時の股角度
ef=cosαf:着地時の損失係数
但し、ef 2は床面と脚式移動体の衝突におけるエネルギー残存率を表す。
γ’:平衡点生成における制御係数
Kα:平衡点安定化のための制御係数
K(dθ/dt):平衡点安定化のための制御係数
d/dt:時間微分(記号「θ」にドットを付した記号も同じ時間微分を表す)
∂:偏微分
上付きの添え字「+」:着地直後における、その添え字「+」が付された変数の値を表す。
上付きの添え字「−」:着地直前における、その添え字「−」が付された変数の値を表す。
下付きの添え字「f」:平衡点における、その添え字「f」が付された変数の値を表す。
下付きの添え字「k」:歩行の第「k」番目のステップにおける、その添え字「k」が付された変数の値を表す。下付きの添え字「k+1」は第「k+1」番目のステップにおける値を表す。
【0035】
また、図2における横軸の「k」は歩行の第「k」番目のステップを表し、縦軸のαkは、第「k」番目のステップにおける着地時の股角度を表す。
【0036】
本明細書にいう「平衡点(fixed point)」とは次の通り定義される。ある空間(物理空間に限らず数学的なn次元空間)を仮定する。その空間内に定義された任意の平面(数学的に厳密には(n−1)次元空間)とその空間内で表現された軌跡が交点を有する場合を仮定する。平面と閉じた周期的な軌跡が交点を有する場合、その交点を「平衡点」と称する。平衡点から離れた状態が平衡点に収束するとき、その平衡点は「安定」であり、平衡点が安定ならば、その軌跡は「安定」であることが数学的に証明されている。また、安定な平衡点を有する軌跡は安定なリミットサイクルと称される。上記に挙げた「軌跡」、「平衡点」、「安定」という表現は数学的に一般に用いられる表現であり、本明細書で用いるそれらの表現の基本的な概念は、数学的に用いられる場合の概念と同一である。
【0037】
本明細書では、特に脚式移動体の脚上に固定された任意の点(以下、基準点と称する)が歩行中に描く軌跡に対して「平衡点」を定義する。そしてその平衡点を安定化するのが請求項にいう平衡点安定化装置である。基準点を定義する空間はいわゆる一般化座標系の空間でよい。一般化座標は例えば、基準点の3次元物理空間における脚式移動体の腰部に対する相対位置でよい。或いは、脚部の膝関節の関節角や関節角速度などでもよい。軌跡上の点における座標値は換言すれば脚部の基準点の状態量を表す。実施例の脚式移動体の特徴は次の通り表現することに等しい。即ち、脚式移動ロボットであり、脚部上に固定された基準点の閉じた周期的な軌跡に対して定義される平衡点を生成する平衡点生成部と、その平衡点を安定化させる平衡点安定化部を備えており、平衡点安定化部は、脚式移動体の着地位置によって平衡点を安定化させることを特徴とする。
【0038】
以上、本発明の具体例を詳細に説明したが、これらは例示にすぎず、特許請求の範囲を限定するものではない。特許請求の範囲に記載の技術には、以上に例示した具体例を様々に変形、変更したものが含まれる。
本明細書または図面に説明した技術要素は、単独であるいは各種の組み合わせによって技術的有用性を発揮するものであり、出願時請求項記載の組み合わせに限定されるものではない。また、本明細書または図面に例示した技術は複数目的を同時に達成するものであり、そのうちの一つの目的を達成すること自体で技術的有用性を持つものである。
【0039】
(本発明の産業上の利用可能性)
製造現場、医療・介護施設あるいは一般家庭などで、脚式移動ロボットの利用が考えられている。しかし、本発明を使用しない従来の制御方法では、エネルギー効率が低く長時間での利用に大きな制約がある。本発明を用いれば、格段に利用時間が伸びる。
【0040】
人との共生が産業化のカギとなる今後のロボットにおいて、本発明は、自然な歩容を極めて安定して生成し、高い頑健さで維持することができることから、利用可能性は極めて高い。
[0001]
本出願は、2005年6月8日に出願された日本国特許出願第2005−168905号に基づく優先権を主張する。その出願の全ての内容はこの明細書中に参照により援用されている。
本発明は、受動歩行脚式ロボットに関するものである。
[背景技術]
[0002]
脚式移動ロボット、特にZMP(Zero moment point)規範の2足歩行の脚式移動ロボットの姿勢安定化制御としては、下記の特許文献1記載のものなどが知られている。また、脚式移動体、特に受動歩行機の平衡点の安定性については、下記の非特許文献1に詳しい。
[0003]
従来の脚式移動ロボットは、高精度なセンサ、高性能なアクチュエータおよび高度な制御からなる最先端テクノロジーの結晶である。その要になっているのがZMPである。ZMP規範の歩行制御方式では、ZMPを用いた軌道計画およびその制御(計測を含む)に集約される。
[0004]
その一方、無視できない存在となっているのが、受動歩行と呼ばれる歩容である。工学的に応用できるか常に高い関心が寄せられている。受動歩行の特徴は、制御を一切用いずに、脚式移動体のもつダイナミクスと環境(下り坂)との相互作用によって、自然な歩容が生成できることである。
[特許文献1]
日本国特許第3269852号公報
[非特許文献1]
T.McGeer,“Passive Dynamic Walking”,The Int.J.of Robotics Research,vol.9,no.2,pp.62−82,1990.
[発明の開示]
[0005]
ZMPは、歩行時に限らない姿勢安定性に関する力学的に重要な指標であり、転倒しないように歩かせるのに最も強力なツールである。しかし、ZMP規範の姿勢安定化制御では、エネルギー効率の高い歩容を実現することは原理的に困難である。さらに、受動歩行と比べるとその歩容は不自然さを感じさせる。
[0006]
受動歩行では、非線形な脚の振り運動の解が、脚の切換え現象によって不連続にジャンプする。この一種のハイブリッドシステムから周期的な軌道が生成される。軌道がリミットサイクルになると、着地直後の状態が平衡点として固定される。しかし、従来の受動歩行は、平地および上り坂において、安定な平衡点が存在せず定常歩行を行うことができない。また、受動歩行の頑健さは低く、安定した連続歩行は難しい。さらに、平衡点への収束性も悪い。
そこで、本発明は、平衡点を安定化させることのできる受動歩行脚式ロボットを提供することを目的とする。
[0007]
本発明における受動歩行脚式ロボットは、2本の外側脚と、1本の中央脚と、ストッパーを備えている。2本の外側脚は、腰に同軸に回転可能に連結されている。中央脚は、2本の外側脚の間で外側脚と同軸に回転可能に連結されている。ストッパーは、2本の外側脚を連結しており、中央脚を囲むループ状に形成されている。
本明細書において、ストッパーは、平衡点安定化装置又は安定化手段と称される場合がある。また、受動歩行脚式ロボットは、脚式移動体と称される場合がある。
[0008]
平衡点安定化装置(ストッパー)は、受動歩行脚式ロボットにおけるエネルギーバランス、脚の切換えおよび脚の振り運動から前記平衡点を生成するのが好ましい。
[0009]
[0010]
また、安定化手段(ストッパー)は、受動歩行脚式ロボットの脚の着地位置を一定あるいはほぼ一定にすることによって、前記平衡点を大域的に安定化する。
[0011]
さらに、前記安定化手段は、前記平衡点と現在の状態量の偏差に応じて、受動歩行脚式ロボットの脚の着地位置を変化させることによって、該平衡点を局所的に安定化するのが好ましい。
[0012]
本発明によれば、エネルギーバランス、脚の切換えおよび脚の振り運動からなる平衡点の力学的構造から、平地あるいは上り坂において、1歩区間ごとに一定トルクを入力するだけで平衡点が生成できる。結果的に、自然でエネルギー効率の高い歩容が実現できる。
【0013】
脚の着地位置を一定あるいはほぼ一定にすることによって、平衡点を大域的に安定化することができ、極めて安定した連続歩行が可能となる。また、頑健さも格段に増す。
【0014】
平衡点の局所安定化によって有限整定を行い、数ステップでほぼ定常状態に収束する。
【図面の簡単な説明】
【0015】
【図1】膝関節のある脚式移動体を模式的に示す図である。
【図2】歩行シミュレーションの結果を示す図である。
【図3】本発明を使用した脚式移動体の全体を示す概略図である。
【発明を実施するための最良の形態】
【0016】
以下に、本発明の脚式移動体の平衡点安定化装置を実施するための最良の形態を説明する。
【0017】
本発明の脚式移動体の平衡点安定化装置が備える平衡点を生成する生成機構は、平衡点を数値的に探索せずとも、脚式移動体におけるエネルギーバランス、脚の切換えおよび脚の振り運動から、平衡点を直接的に算出することができる。したがって、エネルギーバランス、脚の切換えおよび脚の振り運動を変えることで、生成したい平衡点を作り出すことができる。たとえば、エネルギーバランス式、脚の切換え式および脚の振り運動の式から平衡点を算出し、この平衡点を生成させるために必要な一定トルクを脚式移動体の関節に発生させるのが好ましい。
【0018】
本発明の脚式移動体の平衡点安定化装置において、安定化手段は、平衡点を大域的に安定化するため、脚式移動体の脚の着地位置を一定あるいはほぼ一定にすることを最も主要な特徴とする。脚の着地位置を一定あるいはほぼ一定にするには、好ましくはアクチュエータを使ったサーボ機構により能動的に実現する、より好ましくは受動要素を使って受動的に実現する。たとえば、ストッパーを脚式移動体に装着すると簡単でしかも確実でよい。
【0019】
さらに、平衡点と現在の状態量の偏差に応じて、脚式移動体の脚の着地位置を変化させることによって、平衡点を局所的に安定化することを特徴とする。状態量は、着地直前あるいは直後の状態をとることが好ましく、平衡点からの偏差に応じて、好ましくは離散時間システムの局所(平衡点近傍の)安定性が最も高くなるように、脚の着地位置を変化させ着地させる。
【実施例】
【0020】
(実施例1)
図1は、膝関節のある脚式移動体を模式的に示す。まず、平地(γ=0[rad])における平衡点生成および局所安定化について説明する。図1において、l=0.7[m]、l1=l2=0.35[m]、a1=b1=a2=b2=0.35[m]、p=m2/m1=0.4とした。脚式移動体のエネルギーバランス式、脚の切換え式および脚の振り運動の式から、スロープ角度γ=0.073[rad]に相当する受動歩行クラスの平衡点が導かれる。その際の状態量は、着地直後における股角度αf=0.73750[rad]および支持脚の角速度(dθ/dt)|f +=1.35140[rad/s]となる。なお、本実施例では、支持脚の膝関節は真直ぐに伸ばし、遊脚が真直ぐになった時点で遊脚の膝関節を固定することから、着地直後における股角度は脚の着地位置と等価とみなせる。
【0021】
平衡点を生成させるのに必要な関節トルクベクトルτK、τCを数式1および数式2から計算すると、
τK =[0.50078,−0.275429,−0.125195] [Nm/kgm2]
τC =[0.50078,−0.275429] [Nm/kgm2]
となる。遊脚の膝関節を固定するまではτKを入力し、固定後はτCを入力する。
【0022】
平衡点の股角度αf、支持脚の角速度(dθ/dt)|f +と数式3、4、5から係数を計算すると、
af=0.002[1/s]、bf=−0.8156[1/s]、cf=0.5478
を得る。次に、数式6、7から有限整定となる着地時の股角度の変化率を計算すると、
(∂αk+1/∂αk)|f=0.54861、(∂αk+1/∂((dθ/dt)|+))|f=0.36845[s]
を得る。最終的に、数式8の係数を得られた(∂αk+1/∂αk)|f、(∂αk+1/∂((dθ/dt)|+))|f数値になるように設定すると、
Kα=1.7582、K(dθ/dt)=−1.4508
となる。平衡点近傍では、数式8を用いて脚の着地位置(着地時の股角度)を制御することにより、平衡点を局所安定化することができる。
【0023】
歩行シミュレーションの結果を図2に示す。横軸および縦軸は、それぞれステップ数および着地時の股角度を表す。図からわかるように、平地においても平衡点(歩容)が生成され、3ステップでほぼ定常状態に収束している。
【0024】
本実施例で使用した脚式移動体の概略図を図3に示す。脚式移動体の脚の着地位置(着地時の股角度)を一定とするために、図3に示すような簡単なストッパーを取り付けた。なお、ストッパーはこれに限定されるものではない。脚の着地位置を一定としない場合(ストッパーなし)は、下り坂において5歩以上の連続歩行は不可能であった。一方、着地位置を一定とした場合は、下り坂において9歩(歩行可能な最大歩数)での連続歩行が約70[%]の成功率で達成された。ただし、実験回数は350回である。
【0025】
数式1
【数1】
【0026】
数式2
【数2】
【0027】
数式3
【数3】
【0028】
ただし、
【0029】
数式4
【数4】
【0030】
数式5
【数5】
【0031】
数式6
【数6】
【0032】
数式7
【数7】
【0033】
数式8
【数8】
【0034】
上記式及び図面における記号の意味は次の通りである。
g:重力加速度
γ:スロープ角度
u1:足首トルク、u2:腰トルク、u3:膝トルク
τK:平衡点の関節トルクベクトル
τC:遊脚の膝が真直ぐな状態でロックさせたときの平衡点の関節トルクベクトル
τKとτCは次の通り表すことができる。
τK=[τ1f,τ2f,τ3f]=[u1/M,u2/m1,u3/m2]
τC=[τ1f,τ2f]=[u1/M,u2/m1]
αf:平衡点における着地時の股角度
ef=cosαf:着地時の損失係数
但し、ef 2は床面と脚式移動体の衝突におけるエネルギー残存率を表す。
γ’:平衡点生成における制御係数
Kα:平衡点安定化のための制御係数
K(dθ/dt):平衡点安定化のための制御係数
d/dt:時間微分(記号「θ」にドットを付した記号も同じ時間微分を表す)
∂:偏微分
上付きの添え字「+」:着地直後における、その添え字「+」が付された変数の値を表す。
上付きの添え字「−」:着地直前における、その添え字「−」が付された変数の値を表す。
下付きの添え字「f」:平衡点における、その添え字「f」が付された変数の値を表す。
下付きの添え字「k」:歩行の第「k」番目のステップにおける、その添え字「k」が付された変数の値を表す。下付きの添え字「k+1」は第「k+1」番目のステップにおける値を表す。
【0035】
また、図2における横軸の「k」は歩行の第「k」番目のステップを表し、縦軸のαkは、第「k」番目のステップにおける着地時の股角度を表す。
【0036】
本明細書にいう「平衡点(fixed point)」とは次の通り定義される。ある空間(物理空間に限らず数学的なn次元空間)を仮定する。その空間内に定義された任意の平面(数学的に厳密には(n−1)次元空間)とその空間内で表現された軌跡が交点を有する場合を仮定する。平面と閉じた周期的な軌跡が交点を有する場合、その交点を「平衡点」と称する。平衡点から離れた状態が平衡点に収束するとき、その平衡点は「安定」であり、平衡点が安定ならば、その軌跡は「安定」であることが数学的に証明されている。また、安定な平衡点を有する軌跡は安定なリミットサイクルと称される。上記に挙げた「軌跡」、「平衡点」、「安定」という表現は数学的に一般に用いられる表現であり、本明細書で用いるそれらの表現の基本的な概念は、数学的に用いられる場合の概念と同一である。
【0037】
本明細書では、特に脚式移動体の脚上に固定された任意の点(以下、基準点と称する)が歩行中に描く軌跡に対して「平衡点」を定義する。そしてその平衡点を安定化するのが請求項にいう平衡点安定化装置である。基準点を定義する空間はいわゆる一般化座標系の空間でよい。一般化座標は例えば、基準点の3次元物理空間における脚式移動体の腰部に対する相対位置でよい。或いは、脚部の膝関節の関節角や関節角速度などでもよい。軌跡上の点における座標値は換言すれば脚部の基準点の状態量を表す。実施例の脚式移動体の特徴は次の通り表現することに等しい。即ち、脚式移動ロボットであり、脚部上に固定された基準点の閉じた周期的な軌跡に対して定義される平衡点を生成する平衡点生成部と、その平衡点を安定化させる平衡点安定化部を備えており、平衡点安定化部は、脚式移動体の着地位置によって平衡点を安定化させることを特徴とする。
【0038】
以上、本発明の具体例を詳細に説明したが、これらは例示にすぎず、特許請求の範囲を限定するものではない。特許請求の範囲に記載の技術には、以上に例示した具体例を様々に変形、変更したものが含まれる。
本明細書または図面に説明した技術要素は、単独であるいは各種の組み合わせによって技術的有用性を発揮するものであり、出願時請求項記載の組み合わせに限定されるものではない。また、本明細書または図面に例示した技術は複数目的を同時に達成するものであり、そのうちの一つの目的を達成すること自体で技術的有用性を持つものである。
【0039】
(本発明の産業上の利用可能性)
製造現場、医療・介護施設あるいは一般家庭などで、脚式移動ロボットの利用が考えられている。しかし、本発明を使用しない従来の制御方法では、エネルギー効率が低く長時間での利用に大きな制約がある。本発明を用いれば、格段に利用時間が伸びる。
【0040】
人との共生が産業化のカギとなる今後のロボットにおいて、本発明は、自然な歩容を極めて安定して生成し、高い頑健さで維持することができることから、利用可能性は極めて高い。
Claims (2)
- 腰に同軸に回転可能に連結されている2本の外側脚と、
2本の外側脚の間で外側脚と同軸に回転可能に連結されている中央脚と、
2本の外側脚を連結しており、中央脚を囲むループ状のストッパーを備えており、
前記ストッパーが、外側脚と中央脚の相対的なスイング範囲を制限することによって、中央脚と外側脚の相対的な着地位置を略一定にすることを特徴とする受動歩行脚式ロボット。 - 夫々の脚は、膝関節を介して相対的に回転する上腿部と下腿部を備えており、ストッパーは、2本の外側脚の下腿部を連結しており、脚がスイングすると中央脚の下腿部に接触して外側脚と中央脚の相対的なスイング範囲を制限することを特徴とする請求項1の受動歩行脚式ロボット。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007520167A JP4815611B2 (ja) | 2005-06-08 | 2006-06-08 | 受動歩行脚式ロボット |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005168905 | 2005-06-08 | ||
JP2005168905 | 2005-06-08 | ||
JP2007520167A JP4815611B2 (ja) | 2005-06-08 | 2006-06-08 | 受動歩行脚式ロボット |
PCT/JP2006/311552 WO2006132330A1 (ja) | 2005-06-08 | 2006-06-08 | 脚式移動体の平衡点安定化装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2006132330A1 JPWO2006132330A1 (ja) | 2009-01-08 |
JP4815611B2 true JP4815611B2 (ja) | 2011-11-16 |
Family
ID=37498526
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007520167A Active JP4815611B2 (ja) | 2005-06-08 | 2006-06-08 | 受動歩行脚式ロボット |
Country Status (3)
Country | Link |
---|---|
US (1) | US8024070B2 (ja) |
JP (1) | JP4815611B2 (ja) |
WO (1) | WO2006132330A1 (ja) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006132330A1 (ja) | 2005-06-08 | 2006-12-14 | Nagoya Institute Of Technology | 脚式移動体の平衡点安定化装置 |
KR101487782B1 (ko) * | 2008-12-22 | 2015-01-29 | 삼성전자 주식회사 | 로봇 및 그 균형 제어방법 |
KR101493384B1 (ko) * | 2008-12-22 | 2015-02-13 | 삼성전자 주식회사 | 로봇 및 그 균형 제어방법 |
KR101487783B1 (ko) * | 2008-12-22 | 2015-01-29 | 삼성전자 주식회사 | 로봇 및 그 제어방법 |
WO2011055738A1 (ja) * | 2009-11-06 | 2011-05-12 | Ishino Yojiro | 二脚式歩行装置 |
JP5590622B6 (ja) * | 2009-12-22 | 2018-06-27 | 国立大学法人 名古屋工業大学 | 2脚受動歩行機 |
US8914151B2 (en) * | 2011-07-05 | 2014-12-16 | The State Of Oregon Acting By And Through The State Board Of Higher Education On Behalf Of Oregon State University | Apparatus and method for legged locomotion integrating passive dynamics with active force control |
US9296102B2 (en) * | 2012-01-11 | 2016-03-29 | Technion Research And Development Foundation Ltd. | Robot, device and a method for central pattern generator(CPG) based control of a movement of the robot |
KR101428327B1 (ko) | 2012-12-27 | 2014-08-07 | 현대자동차주식회사 | 로봇용 발의 가변 지지장치 |
US9292786B2 (en) * | 2014-02-03 | 2016-03-22 | Disney Enterprises, Inc. | Universal balancing controller for lateral stabilization of bipedal robots in dynamic unstable environments |
CN105015642B (zh) * | 2015-07-21 | 2017-03-08 | 重庆邮电大学 | 由单电机驱动的半被动行走器及其转向控制方法 |
CN105015643A (zh) * | 2015-07-21 | 2015-11-04 | 重庆邮电大学 | 由单电机驱动的半被动行走器及其行走控制方法 |
US11142267B2 (en) * | 2016-06-08 | 2021-10-12 | Nintendo Co., Ltd. | Passive walking apparatus and passive walking module |
CN109625116B (zh) * | 2018-12-18 | 2020-12-15 | 江汉大学 | 可屈膝运动的半被动行走机器人及控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05337849A (ja) * | 1992-05-29 | 1993-12-21 | Honda Motor Co Ltd | 脚式移動ロボットの姿勢安定化制御装置 |
JP2003080478A (ja) * | 2001-09-07 | 2003-03-18 | Gifu Univ | 脚を有する機械の姿勢制御装置及び制御方法 |
WO2003090982A1 (fr) * | 2002-04-26 | 2003-11-06 | Honda Giken Kogyo Kabushiki Kaisha | Dispositif de commande et dispositif de determination de pas pour robot mobile sur jambes |
JP2005096068A (ja) * | 2003-08-25 | 2005-04-14 | Sony Corp | ロボット装置及びロボットの姿勢制御方法 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6243623B1 (en) * | 1997-01-31 | 2001-06-05 | Honda Giken Kogyo Kabushiki Kaisha | Leg type mobile robot control apparatus |
EP1120203B1 (en) * | 1998-04-20 | 2011-01-19 | Honda Giken Kogyo Kabushiki Kaisha | Controller for legged mobile robot |
JP3634238B2 (ja) * | 2000-05-19 | 2005-03-30 | 本田技研工業株式会社 | 脚式移動ロボットの床形状推定装置 |
JP3726009B2 (ja) * | 2000-05-19 | 2005-12-14 | 本田技研工業株式会社 | 脚式移動ロボットの床形状推定装置 |
KR20030051823A (ko) * | 2000-11-17 | 2003-06-25 | 혼다 기켄 고교 가부시키가이샤 | 레그식 이동 로봇의 보용 생성장치 |
JP3726032B2 (ja) * | 2001-04-27 | 2005-12-14 | 本田技研工業株式会社 | 脚式移動ロボットの目標運動生成装置 |
ITBO20020793A1 (it) * | 2002-12-17 | 2004-06-18 | Marchesini Group Spa | Dispositivo per la singolarizzazione di articoli provenienti |
JP4332393B2 (ja) * | 2003-09-16 | 2009-09-16 | 株式会社国際電気通信基礎技術研究所 | 2足歩行移動体および2足歩行制御方法 |
US20090200090A1 (en) * | 2004-07-30 | 2009-08-13 | Tmsuk Co., Ltd. | Multiple-point grounding type foot portion supporting mechanism, biped walking robot equipped with the same, and control structrure therefor |
JP2006116672A (ja) * | 2004-10-22 | 2006-05-11 | Tohoku Univ | 2脚ロボットの歩行制御装置および歩行制御方式 |
JP4707372B2 (ja) * | 2004-11-25 | 2011-06-22 | 独立行政法人理化学研究所 | 二足歩行ロボットとその歩行制御方法 |
WO2006103775A1 (ja) * | 2005-03-30 | 2006-10-05 | Tmsuk Co., Ltd. | 4足歩行ロボット |
WO2006132330A1 (ja) | 2005-06-08 | 2006-12-14 | Nagoya Institute Of Technology | 脚式移動体の平衡点安定化装置 |
-
2006
- 2006-06-08 WO PCT/JP2006/311552 patent/WO2006132330A1/ja active Application Filing
- 2006-06-08 US US11/921,789 patent/US8024070B2/en not_active Expired - Fee Related
- 2006-06-08 JP JP2007520167A patent/JP4815611B2/ja active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05337849A (ja) * | 1992-05-29 | 1993-12-21 | Honda Motor Co Ltd | 脚式移動ロボットの姿勢安定化制御装置 |
JP2003080478A (ja) * | 2001-09-07 | 2003-03-18 | Gifu Univ | 脚を有する機械の姿勢制御装置及び制御方法 |
WO2003090982A1 (fr) * | 2002-04-26 | 2003-11-06 | Honda Giken Kogyo Kabushiki Kaisha | Dispositif de commande et dispositif de determination de pas pour robot mobile sur jambes |
JP2005096068A (ja) * | 2003-08-25 | 2005-04-14 | Sony Corp | ロボット装置及びロボットの姿勢制御方法 |
Also Published As
Publication number | Publication date |
---|---|
US20090055021A1 (en) | 2009-02-26 |
JPWO2006132330A1 (ja) | 2009-01-08 |
US8024070B2 (en) | 2011-09-20 |
WO2006132330A1 (ja) | 2006-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4815611B2 (ja) | 受動歩行脚式ロボット | |
Agrawal et al. | First steps towards translating HZD control of bipedal robots to decentralized control of exoskeletons | |
Chevallereau et al. | Asymptotically stable walking of a five-link underactuated 3-D bipedal robot | |
US7190141B1 (en) | Exoskeletal device for rehabilitation | |
Chevallereau et al. | Tracking a joint path for the walk of an underactuated biped | |
Al-Shuka et al. | Modeling, stability and walking pattern generators of biped robots: a review | |
Sabelhaus et al. | Model-predictive control of a flexible spine robot | |
Yamamoto et al. | Survey on model-based biped motion control for humanoid robots | |
Dehghani et al. | Cyclic gait planning and control of a five-link biped robot with four actuators during single support and double support phases | |
Zhang et al. | Dynamic wheeled motion control of wheel-biped transformable robots | |
Oh et al. | Real-time humanoid whole-body remote control framework for imitating human motion based on kinematic mapping and motion constraints | |
Bharadwaj et al. | Kinematics and dynamics of lower body of autonomous humanoid biped robot | |
Grizzle et al. | HZD-based control of a five-link underactuated 3d bipedal robot | |
Zhu et al. | Design and control of BRAVER: a bipedal robot actuated via proprioceptive electric motors | |
Shahrokhshahi et al. | Sample-efficient policy adaptation for exoskeletons under variations in the users and the environment | |
Park et al. | Whole-body walking pattern using pelvis-rotation for long stride and arm swing for yaw angular momentum compensation | |
He et al. | Modeling, motion planning, and control of one-legged hopping robot actuated by two arms | |
Soliman et al. | 3-d dynamic walking trajectory generation for a bipedal exoskeleton with underactuated legs: A proof of concept | |
CN116985114A (zh) | 机器人控制方法和机器人 | |
Torres-Martínez et al. | Four Wheeled Humanoid Second-Order Cascade Control of Holonomic Trajectories | |
Ganesan et al. | Fall protection framework of lower extremity exoskeleton walking system based on differential motion planning | |
Ramezani | Feedback Control Design for MARLO, a 3D-Bipedal Robot. | |
Yu et al. | Hierarchical jumping optimization for hydraulic biped wheel-legged robots | |
Chumacero-Polanco et al. | A review on human motion prediction in sit to stand and lifting tasks | |
Vu et al. | Walking control algorithm of the 5-link robot based on operational space control |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20081202 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20090408 |
|
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: 20110802 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |