JP3615702B2 - 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット - Google Patents
脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット Download PDFInfo
- Publication number
- JP3615702B2 JP3615702B2 JP2000314565A JP2000314565A JP3615702B2 JP 3615702 B2 JP3615702 B2 JP 3615702B2 JP 2000314565 A JP2000314565 A JP 2000314565A JP 2000314565 A JP2000314565 A JP 2000314565A JP 3615702 B2 JP3615702 B2 JP 3615702B2
- Authority
- JP
- Japan
- Prior art keywords
- motion
- mobile robot
- legged mobile
- waist
- movement
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Lifetime
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
【発明の属する技術分野】
本発明は、生体のメカニズムや動作をモデル化して構成されるリアリスティックなロボットの制御メカニズムに係り、特に、ヒトやサルなどの脚式移動型動物の身体メカニズムをモデル化した脚式移動型ロボットの制御メカニズムに関する。
【0002】
更に詳しくは、本発明は、人間の住空間・住環境において広く適用することができる脚式移動型ロボットの制御メカニズムに係り、特に、様々な外力に対して適応的に姿勢制御して、転倒することなく作業を継続することができる脚式移動型ロボットの制御方法メカニズムに関する。
【0003】
【従来の技術】
電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置のことを「ロボット」という。ロボットの語源は、スラブ語のROBOTA(奴隷機械)に由来すると言われている。わが国では、ロボットが普及し始めたのは1960年代末からであるが、その多くは、工場における生産作業の自動化・無人化などを目的としたマニピュレータや搬送ロボットなどの産業用ロボット(industrial robot)であった。
【0004】
最近では、ヒトやサルなどの2足直立歩行を行う動物の身体メカニズムや動作を模した脚式移動ロボットに関する研究開発が進展し、実用化への期待も高まってきている。2足直立による脚式移動は、クローラ式や、4足又は6足式などに比し不安定で姿勢制御や歩行制御が難しくなるが、不整地や障害物など作業経路上に凹凸のある歩行面や、階段や梯子の昇降など不連続な歩行面に対応することができるなど、柔軟な移動作業を実現できるという点で優れている。
【0005】
ヒトの生体メカニズムや動作をエミュレートした脚式移動ロボットのことを、特に、「人間形」、若しくは「人間型」のロボット(humanoid robot)と呼ぶ。人間型ロボットは、例えば、生活支援、すなわち住環境その他の日常生活上の様々な場面における人的活動の支援などを行うことができる。
【0006】
人間形若しくは人間型と呼ばれるロボットを研究・開発する意義を、例えば以下の2つの視点から把握することができよう。
【0007】
1つは、人間科学的な視点である。すなわち、人間の下肢及び/又は上肢に似た構造のロボットを作り、その制御方法を考案して、人間の歩行動作をシミュレートするというプロセスを通じて、歩行を始めとする人間の自然な動作のメカニズムを工学的に解明することができる。このような研究成果は、人間工学、リハビリテーション工学、あるいはスポーツ科学など、人間の運動メカニズムを扱う他のさまざまな研究分野の進展に大いに還元することができるであろう。
【0008】
もう1つは、人間のパートナーとして生活を支援する、すなわち住環境その他の日常生活上の様々な場面における人的活動の支援を行うロボットの開発である。この種のロボットは、人間の生活環境のさまざまな局面において、人間から動作や作法を教わりながら個々に個性の相違する人間又は環境への適応方法を学習し、機能面でさらに成長していく必要がある。このとき、ロボットが「人間形」すなわち人間と同じ形又は同じ構造をしている方が、人間とロボットとのスムースなコミュニケーションを行う上で有効に機能するものと考えられる。
【0009】
例えば、踏んではならない障害物を避けながら部屋を通り抜ける方法を実地においてロボットに教示するような場合、クローラ式や4足式ロボットのように教える相手が自分と全く違う構造をしているよりも、同じような格好をしている2足歩行ロボットの方がユーザ(作業員)ははるかに教え易く、またロボットにとっても教わり易い筈である(例えば、高西著「2足歩行ロボットのコントロール」(自動車技術会関東支部<高塑>No.25,1996APRIL)を参照のこと)。
【0010】
人間の作業空間や居住空間のほとんどは、2足による直立歩行という人間が持つ身体メカニズムや行動様式に合わせて形成されている。言い換えれば、人間の住空間は、車輪その他の駆動装置を移動手段とした現状の機械システムが移動するのには多くの障壁が存在する。したがって、機械システムすなわちロボットが様々な人的作業を代行し、さらに人間の住空間に深く浸透していくためには、ロボットの移動可能範囲が人間のそれとほぼ同じであることが好ましい。これが、脚式移動ロボットの実用化が大いに期待されている所以でもある。人間型の形態を有していることは、ロボットが人間の住環境との親和性を高める上で必須であると言える。
【0011】
人間型ロボットの用途の1つとして、産業活動・生産活動等における各種の難作業の代行が挙げられる。例えば、原子力発電プラントや火力発電プラント、石油化学プラントにおけるメンテナンス作業、製造工場における部品の搬送・組立作業、高層ビルにおける清掃、火災現場その他における救助といったような危険作業・難作業の代行である。
【0012】
また、人間型ロボットの他の用途として、難作業の代行などの生活支援というよりも、生活密着型、すなわち人間との「共生」という用途が挙げられる。この種のロボットは、ヒトやサルなどの2足の直立歩行を行う動物が本来持つ、全身協調型の動作メカニズムを忠実に再現し、その自然に円滑な動作を実現することを至上の目的とする。また、ヒトやサルなどの知性の高い直立動物をエミュレートする以上、四肢を用いた動作が生体として自然であり、且つ、動作が持つ表現力が豊かであることが望ましい。さらに、予め入力された動作パターンを単に忠実に実行するだけではなく、相手の言葉や態度(「褒める」とか「叱る」、「叩く」など)に呼応した、生き生きとした動作表現を実現することも要求される。この意味において、ヒトを模したエンターティンメント指向の人間型ロボットは、まさに「人間型」のロボットと呼ぶに相応しい。
【0013】
既に周知のように、人体は数百の関節すなわち数百に上る自由度を備えている。限りなくヒトに近い動作を脚式移動ロボットに付与するためには、ほぼ同じ自由度を与えることが好ましいが、これは技術的には極めて困難である。何故ならば、1つの自由度に対して少なくとも各1つのアクチュエータを配設する必要があるが、数百のアクチュエータをロボットという機械装置上に実装することは、製造コストの点からも、重量やサイズなど設計の観点からも不可能に等しい。また、自由度が多いと、その分だけロボットの位置・動作パターン制御や姿勢安定制御等のための計算量が指数関数的に増大してしまう。
【0014】
このため、人体よりもはるかに少ない数十程度の関節自由度で人間型ロボットを構成するのが一般的である。したがって、少ない自由度を用いてより自然な動作を如何にして実現するかが、人間型ロボットの設計・制御において重要な課題の1つといえる。
【0015】
また、2足直立歩行を行う脚式移動ロボットは、柔軟な歩行・走行動作(例えば階段の昇降や障害物の乗り越え等)を実現できる点で優れている反面、脚の本数が少なくなるとともに、重心位置が高くなるため、その分だけ姿勢制御や安定歩行制御が難しくなる。特に、生活密着型のロボットの場合、ヒトやサルなどの知性動物における自然な動作や感情を豊かに表現しながら全身の姿勢や安定歩行を制御しなければならない。
【0016】
2足歩行による脚式移動型ロボットに関する姿勢制御や安定歩行に関する技術は既に数多提案されている。ここで言う安定な「歩行」とは、「転倒することなく、脚を使って移動すること」と定義することができよう。
【0017】
脚式移動ロボットの姿勢安定制御は、ロボットの転倒を回避する上で非常に重要である。何故ならば、転倒は、ロボットが実行中の作業を中断することを意味し、且つ、転倒状態から起き上がって作業を再開するために相当の労力や時間が払われるからである。また、何よりも、転倒によって、ロボット本体そのものだけでなく、転倒するロボットと衝突する相手側の物体にも、致命的な損傷を与えてしまう危険があるからである。したがって、脚式移動ロボットの設計・開発において、姿勢安定制御や歩行時の転倒防止は最も重要な課題の1つであると言えよう。
【0018】
歩行時には、重力と歩行運動に伴なって生じる加速度によって、歩行系から路面には重力と慣性力、並びにこれらのモーメントが作用する。いわゆる「ダランベールの原理」によると、それらは路面から歩行系への反作用としての床反力、床反力モーメントとバランスする。力学的推論の帰結として、足底接地点と路面の形成する支持多角形の辺上あるいはその内側にピッチ及びロール軸モーメントがゼロとなる点、すなわち「ZMP(Zero Moment Point)」が存在する。
【0019】
脚式移動ロボットの姿勢安定制御や歩行時の転倒防止に関する提案の多くは、このZMPを歩行の安定度判別の規範として用いている。ZMP規範に基づく2足歩行パターン生成は、足底着地点を予め設定でき、路面形状に応じた足先の運動学的拘束条件を考慮し易いなどの利点がある。
【0020】
例えば、特開平5−305579号公報には、脚式移動ロボットの歩行制御装置について開示している。同公報に記載の歩行制御装置は、ZMP(Zero Moment Point)、すなわち歩行するときの床反力によるモーメントがゼロとなる床面上の点を目標値に一致させるように制御するものである。
【0021】
また、特開平5−305581号公報に記載の脚式移動ロボットは、ZMPが支持多面体(多角形)内部、又は、着地、離床時にZMPが支持多面体(多角形)の端部から少なくとも所定の余裕を有する位置にあるように構成した。この結果、外乱などを受けても所定距離だけZMPの余裕があり、歩行の安定性の向上を図ることができる。
【0022】
また、特開平5−305583号公報には、脚式移動ロボットの歩き速度をZMP目標位置によって制御する点について開示している。すなわち、同公報に記載の脚式移動ロボットは、予め設定された歩行パターン・データを用い、ZMPを目標位置に一致させるように脚部関節を駆動するとともに、上体の傾斜を検出して、その検出値に応じて設定された歩行パターン・データの吐き出し速度を変更するようにしている。この結果、予期しない凹凸を踏んでロボットが例えば前傾するときは吐き出し速度を速めることで姿勢を回復できる。またZMPが目標位置に制御できるので、両脚支持期において吐き出し速度を変更しても支障がない。
【0023】
また、特開平5−305585号公報には、脚式移動ロボットの着地位置をZMP目標位置によって制御する点について開示している。すなわち、同公報に記載の脚式移動ロボットは、ZMP目標位置と実測位置とのずれを検出して、それを解消する様に脚部の一方または双方を駆動するか、又は、ZMP目標位置まわりにモーメントを検出してそれが零になる様に脚部を駆動することで安定歩行を行うようになっている。
【0024】
また、特開平5−305586号公報には、脚式移動ロボットの傾斜姿勢をZMP目標位置によって制御する点について開示している。すなわち、同公報に記載の脚式移動ロボットは、ZMP目標位置まわりのモーメントを検出し、モーメントが生じているときは、それが零になるように脚部を駆動することで安定歩行を行うようになっている。
【0025】
【発明が解決しようとする課題】
脚式移動ロボットが歩行動作時に受ける外力は、路面から歩行系への反作用としての床反力である。したがって、足底接地点と路面の形成する支持多角形の辺上あるいはその内側にピッチ及びロール軸モーメントがゼロとなるZMPを探索することで、安定歩行動作を実現することができる。上述した各従来技術は、床反力に対して適応的に制御を行うものである。
【0026】
しかしながら、脚式移動ロボットが、人間と同じ住空間・住環境において、様々な人的な作業の支援や代行をし、さらには人間との共存を究極目的として標榜する以上、脚式移動ロボットが現実に行う作業は単なる歩行動作だけには限定されない。
【0027】
この当然の帰結として、脚式移動ロボットが人間の住空間・住環境において受ける外力は床反力には限定されない。
【0028】
例えば、エンターティンメント指向の人間型ロボットにおいては、サッカー・ゲームのような球技に、プレーヤとして参加することもある。このような場合、サッカー・ボールのキック時、あるいはヘディング時において、脚部や頭部に外力を受けることが想定される。また、空手のような競技においては、技を決めるとき、あるいは相手の技をかわすときには、腕部や脚部に相当程度の外力が印加されるであろう。
【0029】
例えば、より強い速度でサッカー・ボールのような対象物を蹴ろうとするとき、ボールから強烈な反力を受ける結果として、姿勢が不安定になり、さらには転倒してしまう可能性さえある。ロボットが転倒すると、作業が中断するばかりでなく、転倒時の衝撃によりロボットが致命的な損傷を受けることがある。さらに、転倒時に衝突する相手も破損することさえある。
【0030】
したがって、脚式移動ロボットを、人間の住空間・住環境において広く適用するためには、様々な外力を想定して適応的に制御する必要がある。
【0031】
本発明の目的は、人間の住空間・住環境において広く適用することができる、脚式移動型ロボットの制御メカニズムを提供することにある。
【0032】
本発明の更なる目的は、様々な外力に対して適応的に姿勢制御して、転倒することなく作業を継続することができる脚式移動型ロボットの制御方法メカニズムを提供することにある。
【0033】
【課題を解決するための手段】
本発明は、上記課題を参酌してなされたものであり、その第1の側面は、少なくとも下肢と体幹部と腰部で構成される脚式移動ロボットを外力に対して適応的に制御するための動作制御装置又は動作制御方法であって、
(a)要求された動作を実現するための足部運動、体幹運動、上肢運動、腰部の姿勢及び高さを設定する手段又はステップと、
(b)前記手段又はステップ(a)により設定された足部運動に基づいてZMP軌道を設定する手段又はステップと、
(c)前記脚式移動ロボットが受ける外力パターンを設定する手段又はステップと、
(d)設定された足部運動、体幹運動、上肢運動、腰部の姿勢及び高さ、及び外力パターンに基づいて、前記手段又はステップ(b)により設定されたZMP上で生じるモーメントを算出する手段又はステップと、
(e)前記手段又はステップ(d)において算出されたモーメントが釣り合う腰部運動の解を求める手段又はステップと、
(f)腰部運動の解に基づいて前記脚式移動ロボットの全身運動を実行する手段又はステップと、
を具備することを特徴とする脚式移動ロボットの動作制御装置又は動作制御方法である。
【0034】
また、本発明の第2の側面は、少なくとも下肢と体幹部と腰部で構成される脚式移動ロボットを外力に対して適応的に制御するための動作制御装置又は動作制御方法であって、
(A)要求された動作を実現するための足部運動、体幹運動、上肢運動、腰部の姿勢及び高さを設定する手段又はステップと、
(B)前記手段又はステップ(A)により設定された足部運動に基づいてZMP軌道を設定する手段又はステップと、
(C)前記脚式移動ロボットが受ける外力パターンを設定する手段又はステップと、
(D)設定された足部運動、体幹運動、上肢運動、腰部の姿勢及び高さ、及び外力パターンの各々によって、前記手段又はステップ(B)により設定されたZMP上で生じるモーメントを算出する手段又はステップと、
(E)前記ロボットの非厳密モデルを用いて前記手段又はステップ(D)により算出されたモーメントが釣り合う腰部運動の近似解を求める手段又はステップと、
(F)前記ロボットの厳密モデルを用いて、前記手段又はステップ(D)により算出されたモーメントが釣り合う腰部運動の近似解を求める手段又はステップと、
(G)前記手段又はステップ(E)及び手段又はステップ(F)の各近似解の差が所定の許容値未満であれば腰部運動の解とする手段又はステップと、
(H)前記手段又はステップ(E)及び手段又はステップ(F)の各近似解の差が所定の許容値以上であれば、設定ZMP上における非厳密モデルのモーメントを修正して、前記手段又はステップ(E)に再投入する手段又はステップと、
(I)腰部運動の解に基づいて前記脚式移動ロボットの全身運動を実行する手段又はステップと、
を具備することを特徴とする脚式移動ロボットの動作制御装置又は動作制御方法である。
【0035】
本発明の第2の側面に係る動作制御装置又は動作制御方法において、前記非厳密モデルは前記ロボットに関する線形及び/又は非干渉の多質点近似モデルであり、また、前記厳密モデルは前記ロボットに関する剛体モデル、又は、非線形及び/又は干渉の多質点近似モデルであってもよい。
【0036】
また、本発明の第2の側面に係る動作制御装置又は動作制御方法は、さらに、(E’)前記の非厳密モデルを用いて腰部運動の近似解を求める手段又はステップ(E)において求めた近似解では予め設定した体幹・上肢運動が実現できない場合に、体幹・上肢運動パターンの再設定・修正を行う手段又はステップを備えてもよい。
【0037】
また、前記の非厳密モデルを用いて腰部運動の近似解を求める手段又はステップ(E)は、足部運動、体幹運動、上肢運動、及び外力パターンによって生じる設定ZMP上のモーメントと、腰部の水平面内運動によって生じる設定ZMP上のモーメントとの釣合方程式を解くことによって腰部運動の近似解を求めるようにしてもよい。
【0038】
また、前記の非厳密モデルを用いて腰部運動の近似解を求める手段又はステップ(E)は、時間の関数を周波数の関数に置き換えて計算するようにしてもよい。
【0039】
また、前記の非厳密モデルを用いて腰部運動の近似解を求める手段又はステップ(E)は、足部運動、体幹運動、上肢運動、及び外力パターンによって生じる設定ZMP上のモーメントにフーリエ級数展開を適用するとともに、腰部の水平面内運動にフーリエ級数展開を適用して、腰部水平面内軌道のフーリエ係数を算出して、さらに逆フーリエ級数展開を適用することによって腰部運動の近似解を求めるようにしてもよい。
【0040】
また、前記外力パターンを設定する手段又はステップ(C)は、対象物に対して所定速度で衝撃を加えたときに受ける外力パターンを、該所定速度よりも低い速度で該対象物に衝撃を加えたときに受けた外力の時間的経過及び力作用点を基にして予測するようにしてもよい。
【0041】
また、本発明の第3の側面は、
2以上の可動脚と、
前記可動脚に連結された上体部と、
外部対象物から前記可動脚に印加される外力を検出する外力検出手段と、
前記外力検出手段による検出結果に従い前記可動脚及び/又は上体部の動作を適応的に制御する制御手段と、
を具備することを特徴とする脚式移動ロボットである。
【0042】
本発明の第3の側面に係る脚式移動ロボットは、例えば可動脚の1つを用いてボールなどの外部対象物を蹴ることができる。前記外力検出手段は前記可動脚の1つが外部対象物を蹴ったときに受ける反力を検出し、また、前記制御手段は該検出された反力に従い前記可動脚及び/又は上体部の動作を適応的に制御することができる。
【0043】
また、脚式移動ロボットが、質量及び/又は反発係数などが不明な外部対象物を前記可動脚の1つを用いて所定速度で蹴る場合には、該可動脚は前記所定速度よりも低い速度で該外部対象物を試しに蹴ってみればよい。このような場合、前記制御手段は、このときの外力検出手段の出力に基づいて前記所定速度で該外部対象物を蹴ったときの質量及び/又は反発係数を予測し、学習することができる。次いで、実際に前記所定速度で該外部対象物を蹴るときには、このような予測・学習結果に従って前記可動脚及び/又は上体部の動作を適応的に制御することが可能となる。
【0044】
【作用】
本発明に係る脚式移動ロボットによれば、ある所定の質量を持つ対象物を蹴る動作を実行するような場合、蹴ったボールから受ける反力などの外力によってロボットが転倒するという事態を好適に回避することができる。
【0045】
さらに、「蹴る」という単一の動作に限定されず、手や頭、胴体など全身の一部を利用して対象物に所定の運動を生じさせるような作業全般においても、脚式移動ロボットの姿勢安定性を維持しながら動作を継続することが可能となる。
【0046】
また、蹴るという動作を行う場合などで、サッカー・ボールなど蹴る対象物の質量や反発係数が不明であっても、姿勢安定性に問題のない低速度で何度か試しに蹴ってみるという作業を事前に行い、実際に高速で蹴るときに受ける反力を予測することができる。この結果、任意の速度で外部対象物を蹴っても、姿勢安定性を維持することが可能である。
【0047】
本発明を実装した脚式移動ロボットは、例えば、サッカーを始めとする球技や、外力を受けながらルールに従い所定の役目を果たすその他の競技種目に対して、プレイヤとして参加することができる。
【0048】
本発明のさらに他の目的、特徴や利点は、後述する本発明の実施例や添付する図面に基づくより詳細な説明によって明らかになるであろう。
【0049】
【発明の実施の形態】
以下、図面を参照しながら本発明の実施例を詳解する。
【0050】
図1及び図2には本発明の実施に供される「人間形」又は「人間型」の脚式移動ロボット100が直立している様子を前方及び後方の各々から眺望した様子を示している。図示の通り、脚式移動ロボット100は、脚式移動を行う左右2足の下肢と、体幹部と、左右の上肢と、頭部と、制御部とで構成される。
【0051】
左右各々の下肢は、大腿部と、膝関節と、脛部と、足首と、足平とで構成され、股関節によって体幹部の略最下端にて連結されている。また、左右各々の上肢は、上腕と、肘関節と、前腕とで構成され、肩関節によって体幹部の上方の左右各側縁にて連結されている。また、頭部は、首関節によって体幹部の略最上端中央に連結されている。
【0052】
制御部は、この脚式移動ロボット100を構成する各関節アクチュエータの駆動制御や各センサ(後述)などからの外部入力を処理するコントローラ(主制御部)や、電源回路その他の周辺機器類を搭載した筐体である。制御部は、その他、遠隔操作用の通信インターフェースや通信装置を含んでいてもよい。また、図1及び図2に示す例では、脚式移動ロボット100が制御部を背中に背負うような格好となっているが、制御部の設置場所は特に限定されない。
【0053】
本実施例に係る脚式移動ロボット100は、外力に対して適応的な制御を行う前提として、外力が印加されると想定される部位には外力を検出する機構が設けられているものとする。例えば、脚式移動ロボット100がサッカー・ゲームの選手として参加するような場合、ボールのような外部対象物を蹴ることによって外力を受ける足部には力センサが配設されている。
【0054】
図3には、力センサを装着した足平を図解している。同図に示す例では、足平前面に力センサが貼設されており、足平に対して任意の方向から印可された外力を検出することができる。力センサとしては、例えば印加される力に応じた電気抵抗値を示すFSR(Force Sensitive Resister)などのデバイスを採用することかできる。
【0055】
さらに、図4には、本実施例に係る脚式移動ロボット100が具備する関節自由度構成を模式的に示している。図示の通り、脚式移動ロボット100は、2本の腕部と頭部1を含む上体と、移動動作を実現する2本の脚部からなる下肢と、上肢と下肢とを連結する体幹部とで構成される。
【0056】
頭部1を支持する首関節は、首関節ヨー軸2と、首関節ピッチ軸3と、首関節ロール軸4という3自由度を有している。
【0057】
また、各腕部は、肩関節ピッチ軸8と、肩関節ロール軸9と、上腕ヨー軸10と、肘関節ピッチ軸11と、前腕ヨー軸12と、手首関節ピッチ軸13と、手首関節ロール軸14と、手部15とで構成される。手部15は、実際には、複数本の指を含む多関節・多自由度構造体である。但し、手部15の動作自体は、ロボット100の姿勢安定制御や歩行動作制御に対する寄与や影響が少ないので、本明細書ではゼロ自由度と仮定する。したがって、左右の各腕部は7自由度を有するとする。
【0058】
また、体幹部は、体幹ピッチ軸5と、体幹ロール軸6と、体幹ヨー軸7という3自由度を有する。
【0059】
また、下肢を構成する左右各々の脚部は、股関節ヨー軸16と、股関節ピッチ軸17と、股関節ロール軸18と、膝関節ピッチ軸19と、足首関節ピッチ軸20と、関節ロール軸21と、足部(足底)22とで構成される。股関節ピッチ軸17と股関節ロール軸18の交点は、本実施例に係るロボット100の股関節位置を定義するものとする。人体の足部(足底)22は、実際には多関節・多自由度の足底を含んだ構造体であるが、本実施例に係る脚式移動ロボット100の足底はゼロ自由度とする。したがって、左右の各脚部は6自由度で構成される。
【0060】
以上を総括すれば、本実施例に係る脚式移動ロボット100全体としては、合計で3+7×2+3+6×2=32自由度を有することになる。但し、脚式移動ロボット100が必ずしも32個の関節自由度に限定される訳ではない。設計・製作上の制約条件や要求仕様等に応じて、関節自由度の個数を適宜増減することができることは言うまでもない。
【0061】
脚式移動ロボット100が持つ上述の各自由度は、実際にはアクチュエータを用いて実装される。外観上で余分な膨らみを排してヒトの自然体形状に近似させること、2足歩行という不安定構造体に対して姿勢制御を行うことなどの要請から、アクチュエータは小型且つ軽量であることが好ましい。本実施例では、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニットに内蔵したタイプの小型ACサーボ・アクチュエータを搭載することとした。なお、この種のACサーボ・アクチュエータに関しては、例えば本出願人に既に譲渡されている特願平11−33386号明細書に開示されている。
【0062】
図5には、本実施例に係る脚式移動ロボット100の制御システム構成を模式的に示している。同図に示すように、脚式移動ロボット100は、ヒトの四肢を表現した各機構ユニット30,40,50R/L,60R/Lと、各機構ユニット間の協調動作を実現するための適応制御を行う制御ユニット80とで構成される(但し、R及びLの各々は、右及び左の各々を示す接尾辞である。以下同様)。
【0063】
脚式移動ロボット100全体の動作は、制御ユニット80によって統括的に制御される。制御ユニット80は、CPU(Central Processing Unit)チップやメモリ・チップ等の主要回路コンポーネント(図示しない)で構成される主制御部81と、電源装置やロボット100の各構成要素とのデータやコマンドの授受を行うインターフェース(いずれも図示しない)などを含んだ周辺回路82とで構成される。
【0064】
本実施例では、電源装置は、ロボット100を自立的に駆動するためのバッテリを含んだ構成(図5には図示しない)となっている。自立駆動型であれば、人間型ロボット100の行動半径は、電源ケーブル長や商用電源コンセントの場所などによる物理的な制限を受けることなく、自由に歩行することができる。また、歩行やその他の上肢を含めた各種の運動時に、電源ケーブルと四肢との干渉を考慮する必要がなくなり、広範囲の作業空間における移動作業(例えば、サッカー・フィールド内における疾走)を含む自律的な動作が容易になる。
【0065】
図4に示したロボット100内の各関節自由度は、それぞれに対応するアクチュエータによって実現される。すなわち、頭部ユニット30には、首関節ヨー軸2、首関節ピッチ軸3、首関節ロール軸4の各々を表現する首関節ヨー軸アクチュエータA2、首関節ピッチ軸アクチュエータA3、首関節ロール軸アクチュエータA4がそれぞれ配設されている。
【0066】
また、体幹部ユニット40には、体幹ピッチ軸5、体幹ロール軸6、体幹ヨー軸7の各々を表現する体幹ピッチ軸アクチュエータA5、体幹ロール軸アクチュエータA6、体幹ヨー軸アクチュエータA7がそれぞれ配備されている。
【0067】
また、腕部ユニット50R/Lは、上腕ユニット51R/Lと、肘関節ユニット52R/Lと、前腕ユニット53R/Lに細分化されるが、肩関節ピッチ軸8、肩関節ロール軸9、上腕ヨー軸10、肘関節ピッチ軸11、肘関節ロール軸12、手首関節ピッチ軸13、手首関節ロール軸14の各々を表現する肩関節ピッチ軸アクチュエータA8、肩関節ロール軸アクチュエータA9、上腕ヨー軸アクチュエータA10、肘関節ピッチ軸アクチュエータA11、肘関節ロール軸アクチュエータA12、手首関節ピッチ軸アクチュエータA13、手首関節ロール軸アクチュエータA14がそれぞれ配備されている。
【0068】
また、脚部ユニット60R/Lは、大腿部ユニット61R/Lと、膝ユニット62R/Lと、脛部ユニット63R/Lに細分化されるが、股関節ヨー軸16、股関節ピッチ軸17、股関節ロール軸18、膝関節ピッチ軸19、足首関節ピッチ軸20、足首関節ロール軸21の各々を表現する股関節ヨー軸アクチュエータA16、股関節ピッチ軸アクチュエータA17、股関節ロール軸アクチュエータA18、膝関節ピッチ軸アクチュエータA19、足首関節ピッチ軸アクチュエータA20、足首関節ロール軸アクチュエータA21がそれぞれ配備されている。
【0069】
上述した各関節アクチュエータA2,A3…は、より好ましくは、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニット内に搭載したタイプの小型ACサーボ・アクチュエータ(前述)である。
【0070】
頭部ユニット30、体幹部ユニット40、腕部ユニット50、各脚部ユニット60などの各機構ユニット毎に、アクチュエータ駆動制御用の副制御部35,45,55,65がそれぞれ配備されている。さらに、各脚部60R,Lの足底が着床したか否かを検出する接地確認センサ91及び92、及び、外力検出センサ94及び95を装着するとともに、体幹部ユニット40内には、姿勢を計測する姿勢センサ93を装備している。
【0071】
接地確認センサ91及び92は、例えば足底に設置された近接センサ又はマイクロ・スイッチなどで構成される。姿勢センサ93として例えば加速度センサを使用することができる。また、外力検出センサ94及び95の実体は、左右の各足平の表面などに貼設された多数の力センサ(図3を参照のこと)の集合体で構成される。
【0072】
接地確認センサ91及び92の出力によって、歩行・走行などの動作期間中において、左右の各脚部が現在立脚又は遊脚いずれの状態であるかを判別することができる。また、外力検出センサ94及び95によって、左右の各足平に印可された外力の大きさ及びその方向を検出することができる。また、また、姿勢センサ93の出力により、体幹部分の傾きや姿勢を検出することができる。
【0073】
主制御部80は、各センサ91〜95の出力に応答して制御目標をダイナミックに補正することができる。より具体的には、副制御部35,45,55,65の各々に対して適応的な制御を行い、人間型ロボット100の上肢、体幹、及び下肢の協調した動作を実現することができる。主制御部81は、ユーザ・コマンド等に従って、足部運動、ZMP(Zero Moment Point)軌道、体幹運動、上肢運動、腰部高さなどを設定するとともに、これらの設定内容に従った動作を指示するコマンドを各副制御部35,45,55,65に転送する。ここで言う「ZMP」とは、歩行中の床反力によるモーメントがゼロとなる床面上の点のことであり、また、「ZMP軌道」とは、例えばロボット100の歩行動作期間中などにZMPが動く軌跡を意味する。
【0074】
そして、各々の副制御部35,45…では、主制御部81から転送されてくる制御指令値を解釈して、各関節アクチュエータA2,A3…に対して駆動制御信号を出力する。
【0075】
本実施例では、物理的には図4に示す多関節自由度構成を具備する人間型ロボット100を、さらに多質点近似モデルに置き換えて全身運動パターン算出のための演算処理を行うようになっている。現実の人間型ロボット100は、無限のすなわち連続的な質点の集合体であるが、有限数で離散的な質点からなる近似モデルに置き換えることによって、その計算量を削減することができる。
【0076】
図6には、本実施例に係る全身運動パターンの計算のために導入される、脚式移動ロボット100の線形且つ非干渉の多質点近似モデルを図解している。
【0077】
図6において、O−XYZ座標系は絶対座標系におけるロール、ピッチ、ヨー各軸を表し、また、O’−X’Y’Z’座標系は脚式移動ロボット100とともに動く運動座標系におけるロール、ピッチ、ヨー各軸を表している。同図に示す多質点モデルでは、iはi番目に与えられた質点を表す添え字であり、miはi番目の質点の質量、r’iはi番目の質点の位置ベクトル(但し運動座標系)を表すものとする。また、後述する全身協調運動パターン生成処理において特に重要な腰部質点の質量はmh、その位置ベクトルはr’h(r’hx,r’hy,r’hz)とし、また、ZMPの位置ベクトルをr’zmpとする。
【0078】
また、図6において、Fjは脚式移動ロボット100に対して印加されるj番目の外力である。本実施例では、外力Fjは既知であることを前提として、姿勢安定制御の計算(後述)がなされる。また、j番目の外力Fjのx,y,z方向の各成分をそれぞれFjx,Fjy,Fjzとし、外力Fjが作用する点の位置ベクトルをr’Fj(r’Fjx,r’Fjy,r’Fjz)とおく。図6で示す例では、j番目の外力は、ボールを左脚で蹴るときに左足平22Lがボールから受ける既知の反力である。
【0079】
図6に示す非厳密の多質点近似モデルにおいては、モーメント式は線形方程式の形式で記述され、該モーメント式はピッチ軸及びロール軸に関して干渉しない、という点を充分理解されたい。
【0080】
このような多質点近似モデルは、概ね以下の処理手順により生成することができる。
【0081】
(1)ロボット100全体の質量分布を求める。
(2)それぞれ質点を設定する。質点の設定方法は、設計者のマニュアル入力であっても、所定の規則に従った自動生成のいずれでも構わない。
(3)ロボット100の全身を所定個数の領域に分割する。さらに、各領域i毎に、重心を求め、その重心位置と質量miを該当する質点に付与する。領域分割は、設計者によるマニュアル処理又は自動処理のいずれであっても構わない。
(4)各質点miを、質点位置riを中心とし、その質量に比例した半径に持つ球体として表示する。
(5)現実に連結関係のある質点すなわち球体同士を連結する。
【0082】
多質点近似モデルは、言わば、ワイヤフレーム・モデルの形態でロボット100を表現したものである。本実施例では、図6を見ても判るように、この多質点近似モデルは、両肩、両肘、両手首、体幹、腰部、及び、両足首の各々を質点として設定したものである。
【0083】
なお、図6に示す多質点モデルの腰部における各回転角(θhx,θhy,θhz)は、脚式移動ロボット100における腰部の姿勢すなわちロール、ピッチ、ヨー軸の回転を規定するものである(図7には、脚式移動ロボット100の多質点近似モデルにおける腰部周辺の拡大図を示しているので、確認されたい)。
【0084】
次いで、本実施例に係る脚式移動ロボット100が既知の外力パターンを受けたときに適応的に姿勢安定制御を行うための全身運動パターンの算出処理手順について説明する。
【0085】
多軸ロボットは、通常、動作する前に予め生成された運動パターンに従って各関節すなわちアクチュエータを同期的に駆動制御することによって、所定の動作を実現するようになっている。本実施例に係る脚式移動ロボット100の場合、任意の足部運動パターン、ZMP軌道、体幹運動パターン、上肢運動パターン、腰部姿勢(θhx,θhy,θhz)等の設定、及び、既知(若しくは予測可能な)外力パターンが加わるような作業環境下において、立位及び歩行などの下肢運動を伴なう安定した全身協調運動を可能とする腰部運動パターンを生成するようになっている。
【0086】
ここで言うZMP(Zero Moment Point)軌道とは、脚式移動ロボット100において足底(若しくは足裏)をある一点で床面に固定したとき、歩行やボールを蹴るなどの既知の外力を受けながら所定の動作パターンを実行する期間中において、モーメントが発生しないような点のことを言う(前述)。
【0087】
図8には、本実施例に係る脚式移動ロボット100が既知の外力を受けながら安定した動作を実現するための全身協調運動パターン生成の処理手順をフローチャートの形式で示している。但し、以下では、図6に示すような線形・非干渉多質点近似モデルを用いて脚式移動ロボット100の各関節位置や動作を記述するものとし、且つ、計算に際し以下の[数1]に示すようなパラメータを用いることとする。また、ダッシュ(´)付きの記号は運動座標系のパラメータ等を記述するものと理解されたい。
【0088】
【数1】
【0089】
また、脚式移動ロボット100の腰部高さが一定(r’hz+rqz=const)で、且つ、膝部質点がゼロであり、さらに、腰部運動を等速直線運動に限定することを前提とする。
【0090】
図8に示した処理手順は、脚式移動ロボット100の歩行やボールのキックなどの動作パターンを指示する旨のユーザ・コマンド等の入力に応答して開始する。
【0091】
かかるユーザ・コマンドは、主制御部81において解釈され、足部(より具体的には足底)運動、足部運動から導出されるZMP軌道、体幹運動、上肢運動、腰部の姿勢や高さなど、各部の駆動・動作を実際に決定するためのパターンが設定される(ステップS11A)。より具体的には、まず足部運動パターン、次いでZMP軌道、体幹運動パターン、そして上肢運動パターンを設定する。また、腰部の運動に関しては、Z’方向のみ設定し、X’及びY’の各方向については未知とする。
【0092】
さらに、ステップS11Bでは、既知の外力パターン群F1,F2,…,Fj,…を設定する。
【0093】
例えば、脚部によってボールを蹴るというj番目の外力Fjが未知であれば、事前にボールを蹴ってみることによって現実に印加される外力Fjを予測するようにしてもよい。但し、外力の予測処理手順については後に詳解する。
【0094】
また、外力パターンの中で、膝などのように前もって作用点を厳密に設定することができない場合には、近似的な作用点を設定してもよい。
【0095】
次に、線形・非干渉多質点近似モデルを用いて、足部、体幹、上肢運動、そして既知の外力パターンにより発生する設定ZMP上でのピッチ軸、ロール軸まわりの各モーメント(Mx,My)を算出する(ステップS12)。
【0096】
次いで、線形・非干渉多質点近似モデルを用いて、腰部水平面内運動(r’hx,r’hy)によって発生する設定ZMP上でのモーメントを算出する(ステップS13)。
【0097】
次いで、設定ZMP上におけるモーメントに関する釣り合い式を、脚式移動ロボット100とともに動く運動座標系O’−X’Y’Z’上において導出する(ステップS14)。より具体的には、足部、体幹、そして上肢運動により発生するモーメント(Mx,My)を既知変数の項として右辺に、腰部質点の水平運動に関する項(rhx,rhy)を未知変数の項として左辺にまとめることで、線形且つ非干渉なZMP方程式を導出する。
【0098】
図6に示す多質点近似モデルにおいて、下式の前提条件が与えられている。
【0099】
【数2】
【0100】
したがって、この場合における未知変数の項、すなわちZMP方程式の左辺は、以下の通りとなる。
【0101】
【数3】
【0102】
他方、既知変数の項(Mx,My)は、脚式移動ロボット100自身の脚部、体幹部、上肢運動によって生じるピッチ及びロール各軸まわりのモーメント(MIy,MIx)と、ステップS11Bにおいて与えられた外力パターン群によって生じるピッチ及びロール各軸まわりのモーメント(MEy,MEx)の和で構成される。したがって、既知変数の項すなわちZMP方程式の右辺は下式の通りとなる。
【0103】
【数4】
【0104】
したがって、ステップS14において導出されるZMP方程式は、下式の通りとなる。
【0105】
【数5】
【0106】
なお、外力パターン群により生じるピッチ及びロール各軸まわりのモーメント(MEy,MEx)を、外力Fjを用いて表記すると、下式の通りとなる。
【0107】
【数6】
【0108】
上述のようにして導出したZMP方程式を解いて、腰部水平面内軌道を算出する(ステップS15)。例えば、オイラー法やルンゲ・クッタ法などの数値的解法(周知)を用いてZMP方程式を解くことで、未知変数としての腰部の水平絶対位置(rhx,rhy)の数値解を求めることができる(ステップS16)。
【0109】
ここで求められる数値解は、安定した歩行やキック動作が可能な腰部運動パターンの近似解であり、より具体的にはZMPが目標位置に入るような腰部水平絶対位置である。ZMP目標位置は、通常、着床した足底に設定される。
【0110】
算出された近似解上では予め設定した体幹・上肢運動が実現できない場合には、体幹・上肢運動パターンの再設定・修正を行う(ステップS17)。この際、膝部の軌道を算出してもよい。
【0111】
次いで、上述のようにして得られた全身運動パターンを代入して、厳密モデル(すなわち、剛体、若しくは非常に多くの質点からなるロボット100の精密なモデル)における設定ZMP上のモーメント(eMx,eMy)を算出する(ステップS18)。非厳密モデルでは上記の[数2]が成立することを前提としたが、厳密ではかかる前提を要しない(すなわち時間の変化に対して一定である必要はない)。
【0112】
厳密モデルにおけるモーメント(eMx,eMy)は、腰部運動の発生するモーメント誤差である。続くステップS19では、このモーメント(eMx,eMy)が非厳密モデルにおける近似モーメントの許容値(εMx,εMy)未満か否かを判定する。許容値ε未満であれば、腰部安定運動パターンの厳密解及び安定したスケーティング動作を実現できる全身運動パターンを得ることができたので(ステップS20)、本処理ルーチン全体を終了する。
【0113】
他方、厳密モデルにおけるモーメント(eMx,eMy)が近似モデルにおけるモーメントの許容値(εMx,εMy)以上であった場合には、厳密モデルにおけるモーメント(eMx,eMy)を用いて近似モデルにおける既知発生モーメント(Mx,My)を修正して(ステップS21)、再びZMP方程式の導出を行い、許容値ε未満に収束するまで、腰部運動パターンの近似解の算出と修正を繰り返し実行する。
【0114】
図8に示す処理手順によれば、既知の外力パターンを受けながら、足部運動、体幹運動や上肢運動の設定に基づいて姿勢を安定させる全身協調運動パターンを算出することができる。勿論、ここで言う外力パターンは、ボールを蹴ったときにボールから受ける反力には限定されず、その他の任意の既知外力パターンを含むものとする。算出された全身協調運動パターンを脚式移動ロボット100に適用することによって、既知の外力を受けても、姿勢安定性を失ったり転倒したりすることなく、動作を継続することができる。
【0115】
また、図9には、本実施例に係る脚式移動ロボット100が既知の外力を受けながら安定した動作を実現するための全身協調運動パターンの生成処理手順に関する他の例をフローチャートの形式で示している。但し、該処理手順では、図8に示した場合と同様に、線形・非干渉多質点近似モデルを用いて脚式移動ロボット100の各関節位置や動作を記述するものとする。
【0116】
該処理手順は、ロボット100の歩行や身振り・手振りなどの動作を指示する旨のユーザ・コマンド等の入力に応答して開始する。
【0117】
かかるユーザ・コマンドは、主制御部81において解釈され、足部(より具体的には足底)運動、足部運動から導出されるZMP軌道、体幹運動、上肢運動、腰部の姿勢や高さなど、各部の駆動・動作を実際に決定するためのパターンが設定される(ステップS31A)。より具体的には、まず足部運動パターン、次いでZMP軌道、体幹運動パターン、そして上肢運動パターンを設定する。また、腰部の運動に関しては、Z’方向のみ設定し、X’及びY’の各方向については未知とする。
【0118】
さらに、ステップS31Bでは、既知の外力パターン群F1,F2,…,Fj,…を設定する。
【0119】
例えば、脚部によってボールを蹴るというj番目の外力Fjが未知であれば、事前にボールを蹴ってみることによって現実に印加される外力Fjを予測するようにしてもよい。但し、外力の予測処理手順については後に詳解する。
【0120】
また、外力パターンの中で、膝などのように前もって作用点を厳密に設定することができない場合には、近似的な作用点を設定してもよい。
【0121】
次に、線形・非干渉多質点近似モデルを用いて、足部、体幹、上肢運動、そして既知の外力パターンにより発生する設定ZMP上でのピッチ軸、ロール軸まわりの各モーメント(Mx,My)を算出する(ステップS32)。
【0122】
次いで、腰部水平面内運動(r’hx,r’hy)をフーリエ級数展開する(ステップS33)。当業界において既に周知のように、フーリエ級数展開することにより、時間軸成分を周波数成分に置き換えて演算することができる。すなわち、この場合には腰部の動きを周期的な動きとして捉えることができる。また、FFT(拘束フーリエ変換)を適用することができるので、計算速度を大幅に向上させることができる。
【0123】
次いで、設定ZMP上でのピッチ軸、ロール軸まわりの各モーメント(Mx,My)についてもフーリエ級数展開する(ステップS34)。
【0124】
次いで、腰部水平面内軌道のフーリエ係数を算出し、さらに逆フーリエ級数展開することで(ステップS35)、腰部運動の近似解が求まる(ステップS36)。ここで求められる近似解は、安定歩行可能な腰部運動パターンを規定する腰部の水平絶対位置の近似解(rhx,rhy)であり、より具体的にはZMPが目標位置に入るような腰部水平絶対位置である。ZMP目標位置は、通常、着床した足底に設定される。
【0125】
算出された近似解上では予め設定した体幹・上肢運動が実現できない場合には、体幹・上肢運動パターンの再設定・修正を行う(ステップS37)。この際、膝部の軌道を算出してもよい。
【0126】
次いで、上述のようにして得られた全身運動パターンを代入して、厳密モデル(すなわち、剛体、若しくは非常に多くの質点からなるロボット100の精密なモデル)における設定ZMP上のモーメント(eMx,eMy)を算出する(ステップS38)。非厳密モデルでは上記の[数2]が成立することを前提としたが、厳密ではかかる前提を要しない(すなわち時間の変化に対して一定である必要はない)。
【0127】
厳密モデルにおけるモーメント(eMx,eMy)は、腰部運動の発生するモーメント誤差である。続くステップS39では、このモーメント(eMx,eMy)が近似モデルにおけるモーメントの許容値(εMx,εMy)未満か否かを判定する。許容値ε未満であれば、腰部安定運動パタンーの厳密解及び安定スケーティング動作を実現できる全身運動パターンを得ることができたので(ステップS40)、本ルーチン全体を終了する。
【0128】
他方、厳密モデルにおけるモーメント(eMx,eMy)が近似モデルにおけるモーメントの許容値(εMx,εMy)以上であった場合には、厳密モデルにおけるモーメント(eMx,eMy)を用いて非厳密モデルにおける既知発生モーメント(Mx,My)を修正して(ステップS41)、再びフーリエ級数展開して、許容値ε未満に収束するまで、腰部運動パターンの近似解の算出と修正を繰り返し実行する。
【0129】
当業者であれば、図9に示す処理手順によっても、図8で示した処理手順と同様、体幹運動や上肢運動の設定に基づいて、既知の外力パターンに抗して適応的な全身協調運動パターンを実現することができる、ということを理解できるであろう。特に、ZMP方程式の数値的解法に頼らず、フーリエ級数展開を用いることで、周期運動を高速に求めると同時に、FFT(高速フーリエ変換)を適用することでモーメント計算そのものを高速化することができる。
【0130】
図10には、事前にボールを蹴ってみることによって現実に印加される外力Fjを予測するための処理手順をフローチャートの形式で示している。該処理手順は、脚部によってボールを蹴るというj番目の外力Fjが未知である場合において適宜実行される。以下、このフローチャートの各ステップについて説明する。
【0131】
まず、対象物すなわちボールを試し蹴りするときの速度Vtを設定する(ステップS51)。この速度Vtは、ボールを蹴る実際の速度Vrよりも充分低い値に設定することが好ましい。
【0132】
次いで、この設定された低い速度を用いて、ボールを蹴ってみる(ステップS52)。そして、蹴った瞬間における力センサ94又は95から出力の時間的経過値や、その力作用点をデータとして入力し且つ一時記憶しておく。
【0133】
ステップS53では、蓄積されたデータに基づいて、ボールを実際の速度Vrで蹴ったときの外力Fjの時間的経過値を予測できるか否かを判断する。
【0134】
ステップS53の判断結果が肯定的であれば該処理ルーチン全体を終了する。そして、得られた外力Fjの時間的経過値は、脚式移動ロボット100に印加される外力パターンとして、全身運動パターン生成処理に投じられる。
【0135】
他方、判断結果が否定的であれば、ステップS51に戻り、別の速度Vtを新たに設定して、試行を繰り返し実行する。
【0136】
[追補]
以上、特定の実施例を参照しながら、本発明について詳解してきた。しかしながら、本発明の要旨を逸脱しない範囲で当業者が該実施例の修正や代用を成し得ることは自明である。
【0137】
本明細書中では、脚式移動ロボット100の体幹ピッチ軸5と、体幹ロール軸6と、体幹ヨー軸7という3自由度をロボットの腰部の姿勢(θhx,θhy,θhz)として扱ったが、腰部の位置は人間型ロボット100と現実のヒトやサルなどの2足直立歩行動物の身体メカニズムとの対比により柔軟に解釈されたい。
【0138】
また、本発明の要旨は、必ずしも「ロボット」と称される製品には限定されない。すなわち、電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置であるならば、例えば玩具等のような他の産業分野に属する製品であっても、同様に本発明を適用することができる。
【0139】
すなわち、例示という形態で本発明を開示してきたのであり、限定的に解釈されるべきではない。本発明の要旨を判断するためには、冒頭に記載した特許請求の範囲の欄を参酌すべきである。
【0140】
参考のため、「人間形」若しくは「人間型」と呼ばれる一般的な脚式移動ロボットにおける関節モデル構成の一例を図11に図解しておく。同図に示す例では、肩関節5から上腕、肘関節6、前腕、手首7及び手部8からなる部分を「上肢」と呼ぶ。また、肩関節5から股関節11までの範囲を「体幹部」と呼び、ヒトの胴体に相当する。また、体幹部のうち特に股関節11から体幹関節10までの範囲を「腰部」と呼ぶ。体幹関節10は、ヒトの背骨が持つ自由度を表現する作用を有する。また、股関節11より下の大腿部12、膝関節14、下腿部13、足首15及び足部16からなる部分を「下肢」と呼ぶ。一般には、股関節より上方を「上体」と呼び、それより下方を「下体」と呼ぶ
【0141】
また、図12には、脚式移動ロボットの他の関節モデル構成を図解している。同図に示す例は、体幹関節10を有しない点で図11に示した例とは相違する。各部の名称については図を参照されたい。脊椎に相当する体幹関節が省略される結果として脚式移動ロボットの上体における動きの滑らかさや表現力を失う。但し、危険作業や難作業の代行など、産業目的に適用される脚式移動ロボットの場合、上体の動きを要しない場合がある。なお、図11及び図12で用いた参照番号は、それ以外の図面とは一致しない点を理解されたい。
【0142】
【発明の効果】
以上詳記したように、本発明によれば、人間の住空間・住環境において広く適用することができる、脚式移動型ロボットの制御メカニズムを提供することができる。
【0143】
また、本発明によれば、様々な外力に対して適応的に姿勢制御して、転倒することなく作業を継続することができる脚式移動型ロボットの制御方法メカニズムを提供することができる。
【0144】
本発明に係る脚式移動ロボットによれば、ある所定の質量を持つ対象物を蹴る動作を実行するような場合、蹴ったボールから受ける反力などの外力によってロボットが転倒することを好適に回避することができる。
【0145】
さらに、「蹴る」という単一の動作に限定されず、手や頭、胴体など全身の一部を利用して対象物に所定の運動を生じさせるような作業全般においても、脚式移動ロボットの姿勢安定性を維持しながら動作を継続することが可能となる。
【0146】
また、蹴るという動作を行う場合などで、蹴る対象物の質量や反発係数が不明であっても、姿勢安定性に問題のない低速度で何度か蹴るという作業を事前に行い、実際に蹴るときの反力を予測することができる。この結果、任意の速度で蹴っても、姿勢安定性を維持することが可能である。
【0147】
本発明を実装した脚式移動ロボットは、例えば、サッカーを始めとする球技や、外力パターンを受けながらルールに従い所定の役目を果たすその他の競技種目に対して、プレイヤとして参加することができる。
【図面の簡単な説明】
【図1】本発明の実施に供される脚式移動ロボット100を前方から眺望した様子を示た図である。
【図2】本発明の実施に供される脚式移動ロボット100を後方から眺望した様子を示た図である。
【図3】ボールを蹴る動作を適応制御するために、脚式移動ロボット100の足平に力センサを装着した様子を示した図である。
【図4】本実施例に係る脚式移動ロボット100が具備する自由度構成モデルを模式的に示した図である。
【図5】本実施例に係る脚式移動ロボット100の制御システム構成を模式的に示した図である。
【図6】本実施例に係る歩行制御の計算のために導入される、脚式移動ロボット100の線形且つ非干渉の多質点近似モデルを示した図である。
【図7】図6に示したロボット100の多質点近似モデルにおける腰部周辺の拡大図である。
【図8】本実施例に係る脚式移動ロボット100が既知の外力を受けながら安定した動作を行うことができる全身協調運動パターンの生成処理手順の一例を示したフローチャートである。
【図9】本実施例に係る脚式移動ロボット100が既知の外力を受けながら安定した動作を行うことができる全身協調運動パターンの生成処理手順に関する他の例を示したフローチャートである。
【図10】事前にボールを蹴ってみることによって現実に印加される外力Fjを予測するための処理手順を示したフローチャートである。
【図11】脚式移動ロボットの関節モデル構成の一例を模式的に示した図である。
【図12】脚式移動ロボットの関節モデル構成に関する他の例を模式的に示した図である。
【符号の説明】
1…頭部,2…首関節ヨー軸
3…首関節ピッチ軸,4…首関節ロール軸
5…体幹ピッチ軸,6…体幹ロール軸
7…体幹ヨー軸,8…肩関節ピッチ軸
9…肩関節ロール軸,10…上腕ヨー軸
11…肘関節ピッチ軸,12…前腕ヨー軸
13…手首関節ピッチ軸,14…手首関節ロール軸
15…手部,16…股関節ヨー軸
17…股関節ピッチ軸,18…股関節ロール軸
19…膝関節ピッチ軸,20…足首関節ピッチ軸
21…足首関節ロール軸,22…足部(足底)
30…頭部ユニット,40…体幹部ユニット
50…腕部ユニット,51…上腕ユニット
52…肘関節ユニット,53…前腕ユニット
60…脚部ユニット,61…大腿部ユニット
62…膝関節ユニット,63…脛部ユニット
80…制御ユニット,81…主制御部
82…周辺回路
91,92…接地確認センサ
93…姿勢センサ
94,95…力センサ
100…脚式移動ロボット
Claims (16)
- 少なくとも上肢、下肢、足部、体幹部及び腰部で構成され、ZMPが目標位置に入るように前記下肢による脚式移動を行うタイプのロボットの動作制御装置であって、
(a)所望の動作を実現するための足部運動、体幹運動、上肢運動、腰部の姿勢及び高さを設定する手段と、
(b)前記手段(a)により設定された足部運動に基づいてZMP軌道を設定する手段と、
(c)前記脚式移動ロボットが受ける外力パターンを設定する手段と、
(d)設定された足部運動、体幹運動、上肢運動、腰部の姿勢及び高さ、及び外力パターンに基づいて、前記手段(b)により設定されたZMP上で生じるモーメントを算出する手段と、
(e)前記手段(d)において算出されたZMP上でモーメントが釣り合う腰部運動の解を求める手段と、
(f)腰部運動の解に基づいて前記脚式移動ロボットの全身運動を実行する手段と、
を具備することを特徴とする脚式移動ロボットの動作制御装置。 - 少なくとも上肢、下肢、足部、体幹部及び腰部で構成され、ZMPが目標位置に入るように前記下肢による脚式移動を行うタイプのロボットの動作制御装置であって、
(A)所望の動作を実現するための足部運動、体幹運動、上肢運動、腰部の姿勢及び高さを設定する手段と、
(B)前記手段(A)により設定された足部運動に基づいてZMP軌道を設定する手段と、
(C)前記脚式移動ロボットが受ける外力パターンを設定する手段と、
(D)設定された足部運動、体幹運動、上肢運動、腰部の姿勢及び高さ、及び外力パターンの各々によって、前記手段(B)により設定されたZMP上で生じるモーメントを算出する手段と、
(E)前記ロボットの非厳密モデルを用いて、前記手段(D)により算出されたZMP上のモーメントが釣り合う腰部運動の近似解を求める手段と、
(F)前記ロボットの厳密モデルを用いて、前記手段(D)により算出されたZMP上のモーメントが釣り合う腰部運動の近似解を求める手段と、
(G)前記手段(F)により求められた前記モーメントが所定の許容値未満であれば腰部運動の解とする手段と、
(H)前記手段(F)により求められた前記モーメントが所定の許容値以上であれば、設定ZMP上における非厳密モデルのモーメントを修正して、前記手段(E)に再投入する手段と、
(I)腰部運動の解に基づいて前記脚式移動ロボットの全身運動を実行する手段と、
を具備することを特徴とする脚式移動ロボットの動作制御装置。 - 前記非厳密モデルは前記ロボットに関する線形及び/又は非干渉の多質点近似モデルであり、
前記厳密モデルは前記ロボットに関する剛体モデル、又は、非線形及び/又は干渉の多質点近似モデルである、
ことを特徴とする請求項2に記載の脚式移動ロボットの動作制御装置。 - さらに、
(E')前記の非厳密モデルを用いて腰部運動の近似解を求める手段(E)において求めた近似解では予め設定した体幹・上肢運動が実現できない場合に、体幹・上肢運動パターンの再設定・修正を行う手段、
を具備することを特徴とする請求項2に記載の脚式移動ロボットの動作制御装置。 - 前記の非厳密モデルを用いて腰部運動の近似解を求める手段(E)は、足部運動、体幹運動、上肢運動、及び外力パターンによって生じる設定ZMP上のモーメントと、腰部の水平面内運動によって生じる設定ZMP上のモーメントとの釣合方程式を解くことによって腰部運動の近似解を求める、
ことを特徴とする請求項2に記載の脚式移動ロボットの動作制御装置。 - 前記の非厳密モデルを用いて腰部運動の近似解を求める手段(E)は、時間の関数を周波数の関数に置き換えて計算することを特徴とする請求項2に記載の脚式移動ロボットの動作制御装置。
- 前記の非厳密モデルを用いて腰部運動の近似解を求める手段(E)は、足部運動、体幹運動、上肢運動、及び外力パターンによって生じる設定ZMP上のモーメントにフーリエ級数展開を適用するとともに、腰部の水平面内運動にフーリエ級数展開を適用して、腰部水平面内軌道のフーリエ係数を算出して、さらに逆フーリエ級数展開を適用することによって腰部運動の近似解を求める、
ことを特徴とする請求項2に記載の脚式移動ロボットの動作制御装置。 - 前記外力パターンを設定する手段(C)は、対象物に対して所定速度で衝撃を加えたときに受ける外力パターンを、該所定速度よりも低い速度で該対象物に衝撃を加えたときに受けた外力の時間的経過及び力作用点を基にして予測する、
ことを特徴とする請求項2に記載の脚式移動ロボットの動作制御装置。 - 少なくとも上肢、下肢、足部、体幹部及び腰部で構成される脚式移動ロボットを外力に対して適応的に制御するための動作制御方法であって、
(a)所望の動作を実現するための足部運動、体幹運動、上肢運動、腰部の姿勢及び高さを設定するステップと、
(b)前記ステップ(a)により設定された足部運動に基づいてZMP軌道を設定するステップと、
(c)前記脚式移動ロボットが受ける外力パターンを設定するステップと、
(d)設定された足部運動、体幹運動、上肢運動、腰部の姿勢及び高さ、及び外力パターンに基づいて、前記ステップ(b)により設定されたZMP上で生じるモーメントを算出するステップと、
(e)前記ステップ(d)において算出されたZMP上でモーメントが釣り合う腰部運動の解を求めるステップと、
(f)腰部運動の解に基づいて前記脚式移動ロボットの全身運動を実行するステップと、
を具備することを特徴とする脚式移動ロボットの動作制御方法。 - 少なくとも上肢、下肢、足部、体幹部及び腰部で構成される脚式移動ロボットを外力に対して適応的に制御するための動作制御方法であって、
(A)所望の動作を実現するための足部運動、体幹運動、上肢運動、腰部の姿勢及び高さを設定するステップと、
(B)前記ステップ(A)により設定された足部運動に基づいてZMP軌道を設定するステップと、
(C)前記脚式移動ロボットが受ける外力パターンを設定するステップと、
(D)設定された足部運動、体幹運動、上肢運動、腰部の姿勢及び高さ、及び外力パターンの各々によって、前記ステップ(B)により設定されたZMP上で生じるモーメントを算出するステップと、
(E)前記ロボットの非厳密モデルを用いて前記ステップ(D)により算出されたZMP上のモーメントが釣り合う腰部運動の近似解を求めるステップと、
(F)前記ロボットの厳密モデルを用いて、前記ステップ(D)により算出されたZMP上のモーメントが釣り合う腰部運動の近似解を求めるステップと、
(G)前記ステップ(F)により求められた前記モーメントが所定の許容値未満であれば腰部運動の解とするステップと、
(H)前記ステップ(F)により求められた前記モーメントが所定の許容値以上であれば、設定ZMP上における非厳密モデルのモーメントを修正して、前記ステップ(E)に再投入するステップと、
(I)腰部運動の解に基づいて前記脚式移動ロボットの全身運動を実行するステップと、
を具備することを特徴とする脚式移動ロボットの動作制御方法。 - 前記非厳密モデルは前記ロボットに関する線形及び/又は非干渉の多質点近似モデルであり、
前記厳密モデルは前記ロボットに関する剛体モデル、又は、非線形及び/又は干渉の多質点近似モデルである、
ことを特徴とする請求項10に記載の脚式移動ロボットの動作制御方法。 - さらに、
(E')前記の非厳密モデルを用いて腰部運動の近似解を求めるステップ(E)において求めた近似解では予め設定した体幹・上肢運動が実現できない場合に、体幹・上肢運動パターンの再設定・修正を行うステップ、
を具備することを特徴とする請求項10に記載の脚式移動ロボットの動作制御方法。 - 前記の非厳密モデルを用いて腰部運動の近似解を求めるステップ(E)では、足部運動、体幹運動、上肢運動、及び外力パターンによって生じる設定ZMP上のモーメントと、腰部の水平面内運動によって生じる設定ZMP上のモーメントとの釣合方程式を解くことによって腰部運動の近似解を求める、
ことを特徴とする請求項10に記載の脚式移動ロボットの動作制御方法。 - 前記の非厳密モデルを用いて腰部運動の近似解を求めるステップ(E)では、時間の関数を周波数の関数に置き換えて計算する、
ことを特徴とする請求項10に記載の脚式移動ロボットの動作制御方法。 - 前記の非厳密モデルを用いて腰部運動の近似解を求めるステップ(E)では、足部運動、体幹運動、上肢運動、及び外力パターンによって生じる設定ZMP上のモーメントにフーリエ級数展開を適用するとともに、腰部の水平面内運動にフーリエ級数展開を適用して、腰部水平面内軌道のフーリエ係数を算出して、さらに逆フーリエ級数展開を適用することによって腰部運動の近似解を求める、
ことを特徴とする請求項10に記載の脚式移動ロボットの動作制御方法。 - 前記外力パターンを設定するステップ(C)では、対象物に対して所定速度で衝撃を加えたときに受ける外力パターンを、該所定速度よりも低い速度で該対象物に衝撃を加えたときに受けた外力の時間的経過及び力作用点を基にして予測する、
ことを特徴とする請求項10に記載の脚式移動ロボットの動作制御方法。
Priority Applications (7)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000314565A JP3615702B2 (ja) | 1999-11-25 | 2000-10-16 | 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット |
EP00310449A EP1103451B1 (en) | 1999-11-25 | 2000-11-24 | Legged mobile robot and method and apparatus for controlling the operation of a robot |
DE60045063T DE60045063D1 (de) | 1999-11-25 | 2000-11-24 | Beweglicher Roboter mit Beinen - Methode und Vorrichtung zum Steuern des Roboters |
DE60045593T DE60045593D1 (de) | 1999-11-25 | 2000-11-24 | Beweglicher Roboter mit Beinen und Methode zum Steuern des Roboters |
EP09010539A EP2112057B1 (en) | 1999-11-25 | 2000-11-24 | Legged mobile robot and method for controlling the operation of a robot |
US09/722,125 US6580969B1 (en) | 1999-11-25 | 2000-11-24 | Legged mobile robot and method and apparatus for controlling the operation thereof |
US10/327,266 US6832132B2 (en) | 1999-11-25 | 2002-12-20 | Legged mobile robot and method and apparatus for controlling the operation thereof |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP11-334805 | 1999-11-25 | ||
JP33480599 | 1999-11-25 | ||
JP2000314565A JP3615702B2 (ja) | 1999-11-25 | 2000-10-16 | 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004290710A Division JP4481132B2 (ja) | 1999-11-25 | 2004-10-01 | ロボット装置及びその制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2001212775A JP2001212775A (ja) | 2001-08-07 |
JP3615702B2 true JP3615702B2 (ja) | 2005-02-02 |
Family
ID=26574944
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000314565A Expired - Lifetime JP3615702B2 (ja) | 1999-11-25 | 2000-10-16 | 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット |
Country Status (4)
Country | Link |
---|---|
US (2) | US6580969B1 (ja) |
EP (2) | EP1103451B1 (ja) |
JP (1) | JP3615702B2 (ja) |
DE (2) | DE60045593D1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111739099A (zh) * | 2020-07-20 | 2020-10-02 | 北京云迹科技有限公司 | 预防跌落方法、装置及电子设备 |
Families Citing this family (104)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3443077B2 (ja) * | 1999-09-20 | 2003-09-02 | ソニー株式会社 | ロボットの運動パターン生成装置及び運動パターン生成方法、並びにロボット |
JP3555107B2 (ja) | 1999-11-24 | 2004-08-18 | ソニー株式会社 | 脚式移動ロボット及び脚式移動ロボットの動作制御方法 |
JP2001150374A (ja) * | 1999-11-25 | 2001-06-05 | Sony Corp | ロボットの故障診断システム |
JP3615702B2 (ja) * | 1999-11-25 | 2005-02-02 | ソニー株式会社 | 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット |
JP2001260063A (ja) * | 2000-03-21 | 2001-09-25 | Sony Corp | 多関節型ロボット及びその動作制御方法 |
JP4491912B2 (ja) * | 2000-05-22 | 2010-06-30 | ソニー株式会社 | バッテリ駆動の脚式移動ロボット及びその制御方法 |
CN1234507C (zh) * | 2000-09-29 | 2006-01-04 | 本田技研工业株式会社 | 双脚行走机器人 |
AU2001294213A1 (en) * | 2000-10-12 | 2002-04-22 | Honda Giken Kogyo Kabushiki Kaisha | Bipedal robot with storage battery |
US6961640B2 (en) * | 2000-11-17 | 2005-11-01 | Sony Corporation | Motion control for a legged robot |
KR100497836B1 (ko) * | 2000-11-17 | 2005-06-29 | 혼다 기켄 고교 가부시키가이샤 | 2족 보행 로봇 |
US6898485B2 (en) * | 2000-11-20 | 2005-05-24 | Sony Corporation | Device and method for controlling operation of legged robot, and robot device |
JP2002301674A (ja) * | 2001-04-03 | 2002-10-15 | Sony Corp | 脚式移動ロボット及びその運動教示方法、並びに記憶媒体 |
JP4188607B2 (ja) * | 2001-06-27 | 2008-11-26 | 本田技研工業株式会社 | 二足歩行移動体の床反力推定方法及び二足歩行移動体の関節モーメント推定方法 |
US7623944B2 (en) * | 2001-06-29 | 2009-11-24 | Honda Motor Co., Ltd. | System and method of estimating joint loads in a three-dimensional system |
US7251593B2 (en) * | 2001-10-29 | 2007-07-31 | Honda Giken Kogyo Kabushiki Kaisha | Simulation system, method and computer-readable medium for human augmentation devices |
US7469166B2 (en) * | 2001-06-29 | 2008-12-23 | Honda Motor Co., Ltd. | System and method of predicting novel motion in a serial chain system |
US7390309B2 (en) * | 2002-09-23 | 2008-06-24 | Honda Motor Co., Ltd. | Human assist system using gravity compensation control system and method using multiple feasibility parameters |
US7135003B2 (en) * | 2001-06-29 | 2006-11-14 | Honda Giken Kogyo Kabushiki Kaisha | Feedback estimation of joint forces and joint moments |
US7774177B2 (en) * | 2001-06-29 | 2010-08-10 | Honda Motor Co., Ltd. | Exoskeleton controller for a human-exoskeleton system |
US7650204B2 (en) * | 2001-06-29 | 2010-01-19 | Honda Motor Co., Ltd. | Active control of an ankle-foot orthosis |
US7217247B2 (en) * | 2002-09-23 | 2007-05-15 | Honda Giken Kogyo Kabushiki Kaisha | Gravity compensation method in a human assist system and a human assist system with gravity compensation control |
US7684896B2 (en) * | 2001-06-29 | 2010-03-23 | Honda Motor Co., Ltd. | System and method of estimating joint loads using an approach of closed form dynamics |
JP4733317B2 (ja) * | 2001-08-28 | 2011-07-27 | 本田技研工業株式会社 | 脚式歩行ロボットの床反力検出器 |
JP3603279B2 (ja) * | 2001-09-26 | 2004-12-22 | 独立行政法人科学技術振興機構 | 二脚歩行式人型ロボット |
JP2003103038A (ja) * | 2001-09-28 | 2003-04-08 | Ishikawajima Harima Heavy Ind Co Ltd | ロボット競技システム |
US6980919B2 (en) * | 2001-10-16 | 2005-12-27 | Honda Giken Kogyo Kabushiki Kaisha | Walking condition determining device and method |
JP3627057B2 (ja) * | 2001-11-19 | 2005-03-09 | 独立行政法人科学技術振興機構 | 二脚歩行式人型ロボット |
US6839612B2 (en) * | 2001-12-07 | 2005-01-04 | Institute Surgical, Inc. | Microwrist system for surgical procedures |
DE60237041D1 (de) * | 2001-12-28 | 2010-08-26 | Honda Motor Co Ltd | Gangerzeugungsvorrichtung und steuervorrichtung für beweglichen roboter mit beinen |
JP3731118B2 (ja) * | 2002-02-18 | 2006-01-05 | 独立行政法人科学技術振興機構 | 二脚歩行式人型ロボット |
WO2003078109A1 (fr) | 2002-03-15 | 2003-09-25 | Sony Corporation | Dispositif de commande operationnelle pour robot mobile du type a jambes, procede de commande operationnelle, et robot |
EP2305436B1 (en) * | 2002-03-18 | 2015-10-28 | Sony Corporation | Robot device and movement controlling method for a robot device |
JP3598507B2 (ja) * | 2002-06-12 | 2004-12-08 | 独立行政法人 科学技術振興機構 | 歩行式移動装置及びその歩行制御装置及び歩行制御方法 |
JP2004074370A (ja) * | 2002-08-21 | 2004-03-11 | Ntt Docomo Inc | 二足歩行ロボットの遠隔操作システム及び遠隔操作装置 |
US7402142B2 (en) * | 2002-09-23 | 2008-07-22 | Honda Giken Kogyo Kabushiki Kaisha | Method and processor for obtaining moments and torques in a biped walking system |
JP3834629B2 (ja) * | 2002-09-26 | 2006-10-18 | 独立行政法人産業技術総合研究所 | 歩行ロボットの歩行歩容生成装置 |
WO2004030870A1 (ja) * | 2002-10-01 | 2004-04-15 | Sony Corporation | ロボット装置及びロボット装置の制御方法 |
AU2003272981A1 (en) * | 2002-10-10 | 2004-05-04 | Sony Corporation | Robot device operation control device and operation control method |
US7054718B2 (en) * | 2002-10-11 | 2006-05-30 | Sony Corporation | Motion editing apparatus and method for legged mobile robot and computer program |
US7236852B2 (en) * | 2002-10-11 | 2007-06-26 | Sony Corporation | Motion controlling apparatus and method and remote controlling apparatus and method for legged mobile robot |
JP3599244B2 (ja) * | 2002-11-06 | 2004-12-08 | ソニー株式会社 | ロボット装置、ロボット装置の運動制御装置並びに運動制御方法 |
US7343223B2 (en) * | 2003-03-13 | 2008-03-11 | Alps Electric Co., Ltd. | Robot apparatus and load sensor |
EP1607191A1 (en) * | 2003-03-23 | 2005-12-21 | Sony Corporation | Robot device and method of controlling the same |
KR20050005995A (ko) * | 2003-07-08 | 2005-01-15 | 삼성전자주식회사 | 2족 보행 이동 장치의 보행 제어 방법 |
JP4291093B2 (ja) * | 2003-09-11 | 2009-07-08 | 本田技研工業株式会社 | 2足歩行移動体の関節モーメント推定方法 |
WO2005005108A1 (ja) | 2003-07-11 | 2005-01-20 | Honda Motor Co., Ltd. | 2足歩行移動体の関節モーメント推定方法 |
KR100835361B1 (ko) * | 2003-08-29 | 2008-06-04 | 삼성전자주식회사 | 간이 지면반력 센서를 이용한 보행 로봇 및 그 제어 방법 |
JP2005115654A (ja) * | 2003-10-08 | 2005-04-28 | Sony Corp | 情報処理装置および方法、プログラム格納媒体、並びにプログラム |
JP4592276B2 (ja) * | 2003-10-24 | 2010-12-01 | ソニー株式会社 | ロボット装置のためのモーション編集装置及びモーション編集方法、並びにコンピュータ・プログラム |
US9841809B2 (en) * | 2003-12-12 | 2017-12-12 | Kurzweil Technologies, Inc. | Virtual encounters |
US9948885B2 (en) * | 2003-12-12 | 2018-04-17 | Kurzweil Technologies, Inc. | Virtual encounters |
US8600550B2 (en) * | 2003-12-12 | 2013-12-03 | Kurzweil Technologies, Inc. | Virtual encounters |
US9971398B2 (en) * | 2003-12-12 | 2018-05-15 | Beyond Imagination Inc. | Virtual encounters |
US20050130108A1 (en) * | 2003-12-12 | 2005-06-16 | Kurzweil Raymond C. | Virtual encounters |
JP4513320B2 (ja) * | 2003-12-17 | 2010-07-28 | ソニー株式会社 | ロボット装置、並びにロボット装置の運動制御方法 |
KR100571829B1 (ko) * | 2004-02-06 | 2006-04-17 | 삼성전자주식회사 | 구조체, 발 구조 및 이를 채용한 로봇 |
EP1738879B1 (en) * | 2004-02-27 | 2011-12-21 | Honda Motor Co., Ltd. | Gait generating device for moving robot |
DE102004035097A1 (de) * | 2004-07-20 | 2006-02-09 | Endress + Hauser Gmbh + Co. Kg | Elektronisches Gerät und Verfahren zur Durchführung mehrerer Prozesse mit dem elektronischen Gerät |
JP4501601B2 (ja) * | 2004-09-03 | 2010-07-14 | トヨタ自動車株式会社 | 脚式ロボットとその制御方法ならびに歩容データの作成装置と作成方法 |
EP1825967B1 (en) * | 2004-10-15 | 2010-06-02 | HONDA MOTOR CO., Ltd. | Gait generator of legged mobile robot |
JP4531520B2 (ja) * | 2004-10-15 | 2010-08-25 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
JP4440761B2 (ja) * | 2004-12-24 | 2010-03-24 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
US7347511B1 (en) | 2005-02-17 | 2008-03-25 | Frank Ronald Naypaver | Rotary walker robotic platform |
WO2006110895A2 (en) * | 2005-04-12 | 2006-10-19 | Honda Motor Co., Ltd. | Active control of an ankle-foot orthosis |
US8082062B2 (en) * | 2005-06-10 | 2011-12-20 | Honda Motor Co., Ltd. | Regenerative actuation in motion control |
JP4595727B2 (ja) * | 2005-07-22 | 2010-12-08 | ソニー株式会社 | 外力推定システム及び外力推定方法、並びにコンピュータ・プログラム |
JP4458049B2 (ja) * | 2006-03-01 | 2010-04-28 | トヨタ自動車株式会社 | 脚式ロボット |
JP4712620B2 (ja) | 2006-06-12 | 2011-06-29 | 本田技研工業株式会社 | 歩行補助装具の制御装置 |
JP4539618B2 (ja) * | 2006-07-31 | 2010-09-08 | トヨタ自動車株式会社 | 脚式ロボット |
WO2008106611A1 (en) * | 2007-02-28 | 2008-09-04 | Raytheon Sarcos, Llc | Antagonistic fluid control system for active and passive actuator operation |
JP5460335B2 (ja) * | 2007-02-28 | 2014-04-02 | レイセオン カンパニー | 選択的に起動可能な作動装置を有する流体制御システム |
JP4392037B2 (ja) * | 2007-09-12 | 2009-12-24 | トヨタ自動車株式会社 | 脚式ロボット、及びその制御方法 |
JP4440956B2 (ja) * | 2007-09-12 | 2010-03-24 | トヨタ自動車株式会社 | 脚式ロボット、及びその制御方法 |
JP5109573B2 (ja) * | 2007-10-19 | 2012-12-26 | ソニー株式会社 | 制御システム及び制御方法、並びにロボット装置 |
JP5104355B2 (ja) * | 2008-02-01 | 2012-12-19 | 富士通株式会社 | ロボット制御装置、ロボット制御方法およびロボット制御プログラム |
KR100985713B1 (ko) * | 2008-04-29 | 2010-10-06 | 한국과학기술연구원 | 휴머노이드 로봇의 보행패턴 생성방법 |
US7942221B1 (en) * | 2008-06-20 | 2011-05-17 | Wowwee Group Limited | Method and system for enabling bi-pedal locomotion |
US20100181943A1 (en) * | 2009-01-22 | 2010-07-22 | Phan Charlie D | Sensor-model synchronized action system |
EP2243602B1 (de) * | 2009-04-22 | 2013-05-15 | KUKA Roboter GmbH | Verfahren und Vorrichtung zur Regelung eines Manipulators |
US8924015B2 (en) * | 2009-09-14 | 2014-12-30 | Honda Motor Co., Ltd. | Whole-body humanoid control from upper-body task specifications |
DE102009029531A1 (de) | 2009-09-17 | 2011-03-24 | Robert Bosch Gmbh | Einschätzung der Straßenverkehrsdichte bei Kraftfahrzeugen |
KR20110080919A (ko) * | 2010-01-07 | 2011-07-13 | 삼성전자주식회사 | 로봇 |
FR2962048A1 (fr) | 2010-07-02 | 2012-01-06 | Aldebaran Robotics S A | Robot humanoide joueur, methode et systeme d'utilisation dudit robot |
US8777818B1 (en) * | 2010-12-22 | 2014-07-15 | Larry E. Tate, Jr. | Training device |
KR101262978B1 (ko) * | 2011-12-05 | 2013-05-08 | 현대자동차주식회사 | 보행로봇의 반발력 측정 모듈 및 방법 |
JP2015175664A (ja) * | 2014-03-13 | 2015-10-05 | 三菱重工業株式会社 | 地形判断装置、及び脚式移動ロボット |
EP2933067B1 (en) * | 2014-04-17 | 2019-09-18 | Softbank Robotics Europe | Method of performing multi-modal dialogue between a humanoid robot and user, computer program product and humanoid robot for implementing said method |
CN104345735A (zh) * | 2014-09-30 | 2015-02-11 | 同济大学 | 一种基于落脚点补偿器的机器人行走控制方法 |
JP6228097B2 (ja) * | 2014-10-06 | 2017-11-08 | 本田技研工業株式会社 | 移動ロボット |
CN104932254B (zh) * | 2015-05-12 | 2017-07-21 | 北京理工大学 | 一种仿人机器人的前摔保护控制策略 |
US9594377B1 (en) * | 2015-05-12 | 2017-03-14 | Google Inc. | Auto-height swing adjustment |
CN105511465B (zh) * | 2015-12-02 | 2017-08-04 | 歌尔股份有限公司 | 一种双足机器人的步态控制方法和装置 |
CN105999692B (zh) * | 2016-05-17 | 2018-04-24 | 洪炳镕 | 仿人型机器人足球游戏机 |
CN108237532B (zh) * | 2016-12-23 | 2020-11-27 | 深圳光启合众科技有限公司 | 多足机器人的步态控制方法、装置和机器人 |
CN106737585B (zh) * | 2016-12-29 | 2023-07-14 | 深圳市优必选科技有限公司 | 腰部结构及人形机器人 |
US10223821B2 (en) | 2017-04-25 | 2019-03-05 | Beyond Imagination Inc. | Multi-user and multi-surrogate virtual encounters |
JP6267822B1 (ja) * | 2017-07-07 | 2018-01-24 | 株式会社タカラトミー | ボール射出装置 |
CN107617220B (zh) * | 2017-09-06 | 2023-12-01 | 滨州学院 | 一种智能足球机器人控制***及控制方法 |
US10821602B2 (en) * | 2017-12-28 | 2020-11-03 | Aeolus Robotics Corporation Limited | Carrier for robot and robot having the same |
KR102228866B1 (ko) * | 2018-10-18 | 2021-03-17 | 엘지전자 주식회사 | 로봇 및 그의 제어 방법 |
CN113524205B (zh) * | 2021-09-15 | 2021-12-31 | 深圳市优必选科技股份有限公司 | 仿人机器人的冗余手臂的抛投轨迹规划方法、装置及介质 |
CN114474066B (zh) * | 2022-03-04 | 2024-02-20 | 全爱科技(上海)有限公司 | 一种智能人形机器人控制***和方法 |
CN115488908A (zh) * | 2022-11-17 | 2022-12-20 | 之江实验室 | 机器人下肢和机器人 |
CN117944055B (zh) * | 2024-03-26 | 2024-06-11 | 中科璀璨机器人(成都)有限公司 | 一种人形机器人四肢协同平衡控制方法及装置 |
Family Cites Families (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3035051B2 (ja) * | 1991-12-20 | 2000-04-17 | 本田技研工業株式会社 | 脚式移動ロボットの歩行制御装置 |
JP3176701B2 (ja) * | 1992-04-15 | 2001-06-18 | 本田技研工業株式会社 | 移動体の現在位置認識処理装置 |
US5455497A (en) * | 1992-04-20 | 1995-10-03 | Honda Giken Kogyo Kabushiki Kaisha | Legged mobile robot and a system for controlling the same |
JPH05305581A (ja) | 1992-04-28 | 1993-11-19 | Honda Motor Co Ltd | リンク式移動ロボットの制御装置 |
JP3148830B2 (ja) | 1992-04-30 | 2001-03-26 | 本田技研工業株式会社 | 脚式移動ロボットの歩行制御装置 |
JP3148828B2 (ja) | 1992-04-30 | 2001-03-26 | 本田技研工業株式会社 | 脚式移動ロボットの歩行制御装置 |
JP3148829B2 (ja) | 1992-04-30 | 2001-03-26 | 本田技研工業株式会社 | 脚式移動ロボットの歩行制御装置 |
JP3167420B2 (ja) * | 1992-04-30 | 2001-05-21 | 本田技研工業株式会社 | 脚式移動ロボットの歩行制御装置 |
US5416393A (en) * | 1992-05-20 | 1995-05-16 | Honda Giken Kogyo Kabushiki Kaisha | Legged mobile robot foot structure |
JP3026276B2 (ja) * | 1992-05-22 | 2000-03-27 | 本田技研工業株式会社 | 脚式移動ロボットの非常停止制御装置 |
JP3132156B2 (ja) * | 1992-05-22 | 2001-02-05 | 本田技研工業株式会社 | 脚式移動ロボットの歩容生成装置 |
JP3273443B2 (ja) * | 1992-05-22 | 2002-04-08 | 本田技研工業株式会社 | ロボットのリンクなどの軌道生成方法及び装置 |
JP3278467B2 (ja) * | 1992-08-18 | 2002-04-30 | 本田技研工業株式会社 | 移動ロボットの制御装置 |
JP3330710B2 (ja) * | 1993-12-30 | 2002-09-30 | 本田技研工業株式会社 | 移動ロボットの位置検知および制御装置 |
JP3429048B2 (ja) * | 1993-12-30 | 2003-07-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 |
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 | 本田技研工業株式会社 | 脚式移動ロボットの足底接地位置検出装置 |
DE69734835T2 (de) * | 1996-12-19 | 2006-07-20 | Honda Giken Kogyo K.K. | Haltungskontrolleur einen sich auf beinen bewegenden robotern |
US6149506A (en) * | 1998-10-07 | 2000-11-21 | Keltech Engineering | Lapping apparatus and method for high speed lapping with a rotatable abrasive platen |
JPH1133386A (ja) | 1997-07-22 | 1999-02-09 | Kawasaki Heavy Ind Ltd | 回分造粒・コーティング方法及びその装置 |
JP2000153476A (ja) * | 1998-09-14 | 2000-06-06 | Honda Motor Co Ltd | 脚式移動ロボット |
US6505097B1 (en) * | 1999-01-13 | 2003-01-07 | Sony Corporation | Arithmetic processing device, inter-object communication method, and robot |
JP3443077B2 (ja) * | 1999-09-20 | 2003-09-02 | ソニー株式会社 | ロボットの運動パターン生成装置及び運動パターン生成方法、並びにロボット |
JP3555107B2 (ja) * | 1999-11-24 | 2004-08-18 | ソニー株式会社 | 脚式移動ロボット及び脚式移動ロボットの動作制御方法 |
JP3615702B2 (ja) * | 1999-11-25 | 2005-02-02 | ソニー株式会社 | 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット |
JP2001150374A (ja) * | 1999-11-25 | 2001-06-05 | Sony Corp | ロボットの故障診断システム |
US6532400B1 (en) * | 2000-03-24 | 2003-03-11 | Intelligent Inference Systems Corporation | Biologically-inspired multi-segmented robot |
JP2002113675A (ja) * | 2000-10-11 | 2002-04-16 | Sony Corp | ロボット制御システム並びにロボット制御用ソフトウェアの導入方法 |
-
2000
- 2000-10-16 JP JP2000314565A patent/JP3615702B2/ja not_active Expired - Lifetime
- 2000-11-24 EP EP00310449A patent/EP1103451B1/en not_active Expired - Lifetime
- 2000-11-24 DE DE60045593T patent/DE60045593D1/de not_active Expired - Lifetime
- 2000-11-24 EP EP09010539A patent/EP2112057B1/en not_active Expired - Lifetime
- 2000-11-24 DE DE60045063T patent/DE60045063D1/de not_active Expired - Lifetime
- 2000-11-24 US US09/722,125 patent/US6580969B1/en not_active Expired - Lifetime
-
2002
- 2002-12-20 US US10/327,266 patent/US6832132B2/en not_active Expired - Lifetime
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111739099A (zh) * | 2020-07-20 | 2020-10-02 | 北京云迹科技有限公司 | 预防跌落方法、装置及电子设备 |
Also Published As
Publication number | Publication date |
---|---|
JP2001212775A (ja) | 2001-08-07 |
DE60045063D1 (de) | 2010-11-18 |
DE60045593D1 (de) | 2011-03-10 |
EP1103451B1 (en) | 2010-10-06 |
US6832132B2 (en) | 2004-12-14 |
EP1103451A3 (en) | 2008-08-27 |
EP2112057B1 (en) | 2011-01-26 |
EP1103451A2 (en) | 2001-05-30 |
US6580969B1 (en) | 2003-06-17 |
EP2112057A1 (en) | 2009-10-28 |
US20030229419A1 (en) | 2003-12-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3615702B2 (ja) | 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット | |
JP3443077B2 (ja) | ロボットの運動パターン生成装置及び運動パターン生成方法、並びにロボット | |
EP1344611B1 (en) | Device and method for controlling operation of legged robot, and robot device | |
KR100937268B1 (ko) | 다리식 이동 로봇 및 그 동작 제어 방법 | |
KR101004820B1 (ko) | 이동체 장치, 이동체 장치의 제어 방법, 로봇 장치, 로봇 장치의 동작 제어 방법 | |
US6961640B2 (en) | Motion control for a legged robot | |
JP3528171B2 (ja) | 移動ロボット装置及び移動ロボット装置の転倒制御方法 | |
JP4475708B2 (ja) | 脚式移動ロボット及びその動作制御方法 | |
Hyon et al. | Back handspring of a multi-link gymnastic robot—Reference model approach | |
JP4660870B2 (ja) | 脚式移動ロボット及びその制御方法 | |
JP3674779B2 (ja) | 脚式移動ロボットのための動作制御装置及び動作制御方法、並びにロボット装置 | |
JP2003117858A (ja) | ロボットの歩行制御装置及び歩行制御方法 | |
JP4540156B2 (ja) | ロボットの重心位置制御方法 | |
JP4770990B2 (ja) | 脚式移動ロボット及びその制御方法 | |
JP3522742B1 (ja) | ロボット装置、脚式移動ロボットの動作制御装置及び動作制御方法、脚式移動ロボットのためのセンサ・システム、並びに移動体装置 | |
JP4481132B2 (ja) | ロボット装置及びその制御方法 | |
JP3568527B2 (ja) | 移動体装置 | |
JP3555946B2 (ja) | 移動ロボット装置及び移動ロボット装置の制御方法 | |
JP4707290B2 (ja) | 脚式移動ロボットの動作制御装置及び動作制御方法 | |
JP3555947B2 (ja) | 移動ロボット装置、移動ロボット装置の制御方法、移動ロボット装置の運動パターン生成方法、並びに移動ロボット装置の運動制御プログラム | |
JP3555948B2 (ja) | 移動ロボット装置、移動ロボット装置の動作制御装置及び動作制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040521 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040803 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20041001 |
|
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: 20041101 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20041101 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 3615702 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091112 Year of fee payment: 5 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091112 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101112 Year of fee payment: 6 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111112 Year of fee payment: 7 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111112 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121112 Year of fee payment: 8 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131112 Year of fee payment: 9 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |