JP2004283954A - ロボット装置及びその動作制御方法 - Google Patents
ロボット装置及びその動作制御方法 Download PDFInfo
- Publication number
- JP2004283954A JP2004283954A JP2003078834A JP2003078834A JP2004283954A JP 2004283954 A JP2004283954 A JP 2004283954A JP 2003078834 A JP2003078834 A JP 2003078834A JP 2003078834 A JP2003078834 A JP 2003078834A JP 2004283954 A JP2004283954 A JP 2004283954A
- Authority
- JP
- Japan
- Prior art keywords
- interference
- joint
- robot device
- robot
- return
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Toys (AREA)
- Manipulator (AREA)
Abstract
【解決手段】自己干渉が生じた場合に、自己干渉が生じた部位における自由度を構成する関節アクチュエータで発生させるトルク又は力を一時的に制限する、あるいは干渉が生じる場合に備えてあらかじめ制限する。可動部同士が自己干渉を生じたときであっても、関節アクチュエータのトルク又は力が制限されているので、互いの表面に接触しながら、復帰動作を継続し、無事に完了させることができる。
【選択図】 図6
Description
【発明の属する技術分野】
本発明は、基体と前記基体に接続される複数の可動部を備えたロボット装置及びその動作制御方法に係り、特に、可動部が少なくとも上肢、下肢および体幹部を含む脚式移動ロボット及びその動作制御方法に関する。
【0002】
さらに詳しくは、本発明は、転倒や異常に伴い動作を緊急停止させた後に自立的に復帰する脚式移動ロボット及びその動作制御方法に係り、特に、可動部同士の自己干渉や周囲の物体との外部干渉に拘わらず緊急停止した状態から自立的に復帰する脚式移動ロボット及びその動作制御方法に関する。
【0003】
【従来の技術】
電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置のことを「ロボット」という。ロボットの語源は、スラブ語の”ROBOTA(奴隷機械)”に由来すると言われている。わが国では、ロボットが普及し始めたのは1960年代末からであるが、その多くは、工場における生産作業の自動化・無人化などを目的としたマニピュレータや搬送ロボットなどの産業用ロボット(industrial robot)であった。
【0004】
最近では、ヒトやサルなどの2足直立歩行を行なう動物の身体メカニズムや動作を模した脚式移動ロボットに関する研究開発が進展し、実用化への期待も高まってきている。2足直立による脚式移動は、クローラ式や、4足又は6足式などに比し不安定で姿勢制御や歩行制御が難しくなるが、不整地や障害物など作業経路上に凹凸のある歩行面や、階段や梯子の昇降など不連続な歩行面に対応することができるなど、柔軟な移動作業を実現できるという点で優れている。
【0005】
また、ヒトの生体メカニズムや動作を再現した脚式移動ロボットのことを、特に、「人間形」、若しくは「人間型」のロボット(humanoid robot)と呼ぶ。人間型ロボットは、例えば、生活支援、すなわち住環境その他の日常生活上のさまざまな場面における人的活動の支援などを行なうことができる。
【0006】
人間の作業空間や居住空間のほとんどは、2足直立歩行という人間が持つ身体メカニズムや行動様式に合わせて形成されおり、車輪その他の駆動装置を移動手段とした現状の機械システムが移動するのには多くの障壁が存在する。したがって、機械システムすなわちロボットがさまざまな人的作業を代行し、さらに人間の住空間に深く浸透していくためには、ロボットの移動可能範囲が人間のそれとほぼ同じであることが好ましい。これが、脚式移動ロボットの実用化が大いに期待されている所以でもある。
【0007】
脚式移動ロボットを始めとする多関節型ロボット、あるいはその他のロボット装置は、関節角度や関節ゲインなどの複数の制御対象を持つ。また、ロボットの装置動作は、一般に、ある動作期間の初期点と終端点における各制御対象の制御値のみを規定した動作パターンとして取り扱われ、動作期間中における各制御対象の動作はスプライン補間や線形補間などの補間処理が行なわれるというPTP(Point to Point)制御が採用されている。そして、あらかじめ多くの静的・動的な動作パターンを用意しておき、ロボット装置が、一方の終端点と他方の初期点との連続性が保証される動作パターン同士を連結して機体上で再生することにより、歩行やダンス、その他の複雑で長期的な行動を実現することができる。
【0008】
また、脚式移動ロボットは、一般に、マニピュレータや搬送ロボットなどの産業用ロボット(industrial robot)に比し、冗長な自由度を含む多リンク系により構成されているという特徴がある。このような特徴を生かし、複雑な動作、あるいは移動・バランス維持・アーム作業といった複数のタスクを同時実行することができる。この反面、動作中に、姿勢の安定性を失って転倒したり、ユーザの指やその他の異物を挟み込んだり、あるいは可動部同士が自己干渉したりするなどの事象により緊急停止する可能性がある。
【0009】
無人環境下でロボットが完全に自立して動作するためには、このような緊急停止状態から自動復帰できることが好ましい。
【0010】
しかしながら、上述したようにPTP制御が行なわれる場合、これらの動作は途中から再生しても安定性が満たされるとは限らない。そのため、ロボットの転倒や人間の体の挟み込み、モータの過電流などの障害が発生して緊急停止した場合、通常の動作を再開するためには、いずれかの動作パターンの初期状態まで一旦移行し、その初期姿勢から動作を開始する必要がある。
【0011】
実際に初期姿勢に遷移する際には、意図しないロボット自身の自己干渉や、周囲環境との間の外部干渉が生じる可能性があるが、これらの干渉の発生しない動作をすべて事前に用意することは、現実的に不可能である。
【0012】
【発明が解決しようとする課題】
本発明の目的は、転倒や異常に伴い動作を緊急停止させた後に自立的に復帰することができる、優れた脚式移動ロボット及びその動作制御方法を提供することにある。
【0013】
本発明のさらなる目的は、可動部同士の自己干渉や周囲の物体との外部干渉に拘わらず緊急停止した状態から自立的に復帰することができる、優れた脚式移動ロボット及びその動作制御方法を提供することにある。
【0014】
【課題を解決するための手段及び作用】
本発明は、上記課題を参酌してなされたものであり、基体と前記基体に接続される複数の可動部を備えたロボット装置であって、
所定の障害の発生に応じて装置動作を停止させる停止手段と、
前記ロボット装置自身の自己干渉及び/又は周囲環境との間の外部干渉の問題を厳密に解くことなく該停止された装置動作を復帰させる復帰手段と、
を具備することを特徴とするロボット装置である。
【0015】
ここで、ロボット装置は例えば2脚2腕の脚式移動ロボットであり、前記複数の可動部は、少なくとも上肢、下肢および体幹部を含んでもよい。
【0016】
前記復帰手段は、自己干渉が生じた場合に、自己干渉が生じた部位における自由度を構成する関節アクチュエータで発生させるトルク又は力を一時的に制限する、あるいは干渉が生じる場合に備えてあらかじめ制限するようにしてもよい。
【0017】
このような場合、可動部同士が自己干渉を生じたときであっても、関節アクチュエータのトルク又は力が制限されているので、互いの表面に接触しながら、復帰動作を継続し、無事に完了させることができる。
【0018】
また、前記復帰手段は、前記可動部の先端から順次動作させていくようにしてもよい。例えば、上肢を復帰させるときには手先、下肢を復帰させるときには足先に近い関節から順次動作させていく。先端から緊急停止状態を解いていくことにより、肢体同士が絡まり難くなる。または、例えば脚の場合、膝関節など特徴的な関節から順次動作させていく。あるいはスタート時刻をずらして動作を行なう。
【0019】
あるいは、前記復帰手段は、前記可動部を前記基体に近い関節から順に動作させるとともに、動作が始まっていない関節アクチュエータで発生させるトルク又は力を制限するようにしてもよい。
【0020】
このような場合、前記基体に近い関節を駆動しているときに、前記基体からより遠くにある部位で自己干渉や絡み合いが生じることがあるが、関節アクチュエータのトルクが制限されているので、互いの表面に接触しながら、復帰動作を継続し、無事に完了させることができる。
【0021】
また、前記復帰手段は、干渉の生じないような動作を自律的に生成するようにしてもよい。
【0022】
また、前記停止手段は、障害発生後も、前記可動部の関節アクチュエータを小さなトルク又は力によって制御し続けるようにしてもよい。
【0023】
例えば、転倒時において、関節アクチュエータを弱いトルクで制御すると、床上に着床した時点である程度の姿勢を保つことができる。すなわち、想定外の姿勢になることを防ぐことができるとともに、その後の復帰動作の生成が容易になる。
【0024】
また、前記復帰手段は、障害が発生した時点までの動作と逆の動作を行なうようにすることにより、自己干渉を起こすことなく、復帰動作を無事完了することができる。
【0025】
本発明のさらに他の目的、特徴や利点は、後述する本発明の実施形態や添付する図面に基づくより詳細な説明によって明らかになるであろう。
【0026】
【発明の実施の形態】
以下、図面を参照しながら本発明の実施形態について詳解する。
【0027】
図1及び図2には本発明の実施に供される「人間形」又は「人間型」の脚式移動ロボット100が直立している様子を前方及び後方の各々から眺望した様子を示している。図示の通り、脚式移動ロボット100は、胴体部と、頭部と、左右の上肢部と、脚式移動を行なう左右2足の下肢部とで構成され、例えば胴体に内蔵されている制御部(図示しない)により機体の動作を統括的にコントロールするようになっている。
【0028】
左右各々の下肢は、大腿部と、膝関節と、脛部と、足首と、足平とで構成され、股関節によって体幹部の略最下端にて連結されている。また、左右各々の上肢は、上腕と、肘関節と、前腕とで構成され、肩関節によって体幹部の上方の左右各側縁にて連結されている。また、頭部は、首関節によって体幹部の略最上端中央に連結されている。
【0029】
制御部は、この脚式移動ロボット100を構成する各関節アクチュエータの駆動制御や各センサ(後述)などからの外部入力を処理するコントローラ(主制御部)や、電源回路その他の周辺機器類を搭載した筐体である。制御部は、その他、遠隔操作用の通信インターフェースや通信装置を含んでいてもよい。
【0030】
このように構成された脚式移動ロボット100は、制御部による全身協調的な動作制御により、2足歩行を実現することができる。かかる2足歩行は、一般に、以下に示す各動作期間に分割される歩行周期を繰り返すことによって行なわれる。すなわち、
【0031】
(1)右脚を持ち上げた、左脚による単脚支持期
(2)右足が接地した両脚支持期
(3)左脚を持ち上げた、右脚による単脚支持期
(4)左足が接地した両脚支持期
【0032】
脚式移動ロボット100における歩行制御は、あらかじめ下肢の目標軌道を計画し、上記の各期間において計画軌道の修正を行なうことによって実現される。すなわち、両脚支持期では、下肢軌道の修正を停止して、計画軌道に対する総修正量を用いて腰の高さを一定値で修正する。また、単脚支持期では、修正を受けた脚の足首と腰との相対位置関係を計画軌道に復帰させるように修正軌道を生成する。
【0033】
歩行動作の軌道修正を始めとして、機体の姿勢安定制御には、一般に、ZMPに対する偏差を小さくするための位置、速度、及び加速度が連続となるように、5次多項式を用いた補間計算により行なう。ZMP(Zero Moment Point)を歩行の安定度判別の規範として用いている。ZMPによる安定度判別規範は、歩行系から路面には重力と慣性力、並びにこれらのモーメントが路面から歩行系への反作用としての床反力並びに床反力モーメントとバランスするという「ダランベールの原理」に基づく。力学的推論の帰結として、足底接地点と路面の形成する支持多角形(すなわちZMP安定領域)の辺上あるいはその内側にピッチ軸及びロール軸モーメントがゼロとなる点、すなわち「ZMP(Zero Moment Point)」が存在する。
【0034】
図3には、この脚式移動ロボット100が具備する関節自由度構成を模式的に示している。同図に示すように、脚式移動ロボット100は、2本の腕部と頭部1を含む上肢と、移動動作を実現する2本の脚部からなる下肢と、上肢と下肢とを連結する体幹部とで構成された、複数の肢を備えた構造体である。
【0035】
頭部を支持する首関節(Neck)は、首関節ヨー軸1と、第1及び第2の首関節ピッチ軸2a,2bと、首関節ロール軸3という3自由度を有している。
【0036】
また、各腕部は、その自由度として、肩(Shoulder)における肩関節ピッチ軸4と、肩関節ロール軸5と、上腕ヨー軸6、肘(Elbow)における肘関節ピッチ軸7と、手首(Wrist)における手首関節ヨー軸8と、手部とで構成される。手部は、実際には、複数本の指を含む多関節・多自由度構造体である。
【0037】
また、体幹部(Trunk)は、体幹ピッチ軸9と、体幹ロール軸10という2自由度を有する。
【0038】
また、下肢を構成する各々の脚部は、股関節(Hip)における股関節ヨー軸11と、股関節ピッチ軸12と、股関節ロール軸13と、膝(Knee)における膝関節ピッチ軸14と、足首(Ankle)における足首関節ピッチ軸15と、足首関節ロール軸16と、足部とで構成される。
【0039】
但し、エンターティンメント向けの脚式移動ロボット100が上述したすべての自由度を装備しなければならない訳でも、あるいはこれに限定される訳でもない。設計・製作上の制約条件や要求仕様などに応じて、自由度すなわち関節数を適宜増減することができることは言うまでもない。
【0040】
上述したような脚式移動ロボット100が持つ各自由度は、実際にはアクチュエータを用いて実装される。外観上で余分な膨らみを排してヒトの自然体形状に近似させること、2足歩行という不安定構造体に対して姿勢制御を行なうことなどの要請から、アクチュエータは小型且つ軽量であることが好ましい。本実施形態では、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニットに内蔵したタイプの小型ACサーボ・アクチュエータを搭載することとした(この種のACサーボ・アクチュエータに関しては、例えば本出願人に既に譲渡されている特開2000−299970号公報に開示されている)。本実施形態では、直結ギアとして低減速ギアを採用することにより、人間との物理的インタラクションを重視するタイプのロボット100に求められている駆動系自身の受動的特性を得ている。
【0041】
図4には、脚式移動ロボット100の制御システム構成を模式的に示している。同図に示すように、脚式移動ロボット100は、ヒトの四肢を表現した各機構ユニット30,40,50R/L,60R/Lと、各機構ユニット間の協調動作を実現するための適応制御を行なう制御ユニット80とで構成される(但し、R及びLの各々は、右及び左の各々を示す接尾辞である。以下同様)。
【0042】
脚式移動ロボット100全体の動作は、制御ユニット80によって統括的に制御される。制御ユニット80は、CPU(Central Processing Unit)やメモリ等の主要回路コンポーネント(図示しない)で構成される主制御部81と、電源回路やロボット100の各構成要素とのデータやコマンドの授受を行なうインターフェース(いずれも図示しない)などを含んだ周辺回路82とで構成される。
【0043】
本発明を実現する上で、この制御ユニット80の設置場所は特に限定されない。図4では体幹部ユニット40に搭載されているが、頭部ユニット30に搭載してもよい。あるいは、脚式移動ロボット100外に制御ユニット80を配備して、脚式移動ロボット100の機体とは有線若しくは無線で交信するようにしてもよい。
【0044】
図3に示した脚式移動ロボット100内の各関節自由度は、それぞれに対応するアクチュエータによって実現される。すなわち、頭部ユニット30には、首関節ヨー軸1、首関節ピッチ軸2、首関節ロール軸3の各々を表現する首関節ヨー軸アクチュエータA1、首関節ピッチ軸アクチュエータA2、首関節ロール軸アクチュエータA3が配設されている。
【0045】
また、体幹部ユニット40には、体幹ピッチ軸9、体幹ロール軸10の各々を表現する体幹ピッチ軸アクチュエータA9、体幹ロール軸アクチュエータA10が配備されている。
【0046】
また、腕部ユニット50R/Lは、上腕ユニット51R/Lと、肘関節ユニット52R/Lと、前腕ユニット53R/Lに細分化されるが、肩関節ピッチ軸4、肩関節ロール軸5、上腕ヨー軸6、肘関節ピッチ軸7、手首関節ヨー軸8の各々を表現する肩関節ピッチ軸アクチュエータA4、肩関節ロール軸アクチュエータA5、上腕ヨー軸アクチュエータA6、肘関節ピッチ軸アクチュエータA7、手首関節ヨー軸アクチュエータA8が配備されている。
【0047】
また、脚部ユニット60R/Lは、大腿部ユニット61R/Lと、膝ユニット62R/Lと、脛部ユニット63R/Lに細分化されるが、股関節ヨー軸11、股関節ピッチ軸12、股関節ロール軸13、膝関節ピッチ軸14、足首関節ピッチ軸15、足首関節ロール軸16の各々を表現する股関節ヨー軸アクチュエータA11、股関節ピッチ軸アクチュエータA12、股関節ロール軸アクチュエータA13、膝関節ピッチ軸アクチュエータA14、足首関節ピッチ軸アクチュエータA15、足首関節ロール軸アクチュエータA16が配備されている。
【0048】
各関節に用いられるアクチュエータA1,A2,A3…は、より好ましくは、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニット内に搭載したタイプの小型ACサーボ・アクチュエータ(前述)で構成することができる。
【0049】
頭部ユニット30、体幹部ユニット40、腕部ユニット50、各脚部ユニット60などの各機構ユニット毎に、アクチュエータ駆動制御用の副制御部35,45,55,65が配備されている。
【0050】
機体の体幹部40には、加速度センサ95と姿勢センサ96が配設されている。加速度センサ95は、X,Y,Z各軸方向に配置する。機体の腰部に加速度センサ95を配設することによって、質量操作量が大きな部位である腰部を制御対象点として設定して、その位置における姿勢や加速度を直接計測して、ZMPに基づく姿勢安定制御を行なうことができる。
【0051】
また、各脚部60R,Lには、接地確認センサ91及び92と、加速度センサ93,94がそれぞれ配設されている。接地確認センサ91及び92は、例えば足底に圧力センサを装着することにより構成され、床反力の有無により足底が着床したか否かを検出することができる。また、加速度センサ93,94は、少なくともX及びYの各軸方向に配置する。左右の足部に加速度センサ93,94を配設することにより、ZMP位置に最も近い足部で直接ZMP方程式を組み立てることができる。
【0052】
質量操作量が大きな部位である腰部にのみ加速度センサを配置した場合、腰部のみが制御対象点に設定され、足部の状態は、この制御対象点の計算結果を基に相対的に算出しなければならず、足部と路面との間では以下の条件を満たすことが、前提となってしまう。
【0053】
(1)路面はどんな力やトルクが作用しても動くことがない。
(2)路面での並進に対する摩擦係数は充分に大きく、滑りが生じない。
【0054】
これに対し、本実施形態では、路面との接触部位である足部にZMPと力を直接計測する反力センサ・システム(床反力センサなど)を配備するとともに、制御に用いるローカル座標とその座標を直接的に計測するための加速度センサを配設する。この結果、ZMP位置に最も近い足部で直接ZMP方程式を組み立てることができ、上述したような前提条件に依存しない、より厳密な姿勢安定制御を高速で実現することができる。この結果、力やトルクが作用すると路面が動いてしまう砂利上や毛足の長い絨毯上や、並進の摩擦係数が充分に確保できずに滑りが生じ易い住居のタイルなどであっても、機体の安定歩行(運動)を保証することができる。
【0055】
主制御部80は、ある動作期間の初期点と終端点における各制御対象の制御値のみを規定した動作パターンが投入されると、PTP制御により、動作期間中における各制御対象の動作はスプライン補間や線形補間などで補間して動作の再生を行なう。そして、一方の終端点と他方の初期点との連続性が保証される動作パターン同士を連結して機体上で再生することにより、歩行やダンス、その他の複雑で長期的な行動を実現する。
【0056】
また、主制御部80は、各センサ91〜93の出力に応答して制御目標をダイナミックに補正することができる。より具体的には、副制御部35,45,55,65の各々に対して適応的な制御を行い、脚式移動ロボット100の上肢、体幹、及び下肢が協調して駆動する全身運動パターンを実現する。
【0057】
ロボット100の機体上での全身運動は、足部運動、ZMP(Zero Moment Point)軌道、体幹運動、上肢運動、腰部高さなどを設定するとともに、これらの設定内容に従った動作を指示するコマンドを各副制御部35,45,55,65に転送する。そして、各々の副制御部35,45…では、主制御部81からの受信コマンドを解釈して、各アクチュエータA1,A2,A3…に対して駆動制御信号を出力する。ここで言う「ZMP」とは、歩行中の床反力によるモーメントがゼロとなる床面上の点のことであり、また、「ZMP軌道」とは、例えばロボット100の歩行動作期間中にZMPが動く軌跡を意味する(前述)。
【0058】
なお、本実施形態に係る脚式移動ロボット100は、腰部位置に重心が設定されており、姿勢安定制御の重要な制御対象点であるとともに、装置の「基体」を構成する。
【0059】
ロボットは、転倒や人間の体の挟み込み、モータの過電流などの障害が発生して緊急停止した場合、通常の動作を再開するためには、いずれかの動作パターンの初期状態まで一旦移行し、その初期姿勢から動作を開始する必要がある。実際に初期姿勢に遷移する際には、意図しないロボット自身の自己干渉や、周囲環境との間の外部干渉が生じる可能性があるが、これらの干渉の発生しない動作をすべて事前に用意することは、現実的に不可能である。
【0060】
このため、本発明者らは、脚式移動ロボットが緊急停止状態から自動復帰するためには、以下のいずれかの方法が必要であると思料する。すなわち、
【0061】
(A)厳密な干渉問題を解くことなく、干渉が発生した場合でも動作を続行するための方法
(B)厳密な干渉問題を解くことなく、干渉しない動作を生成する方法
(C)厳密な干渉問題を解きながら、干渉しない動作を生成する方法
【0062】
以下、図面を参照しながら、脚式移動ロボットが緊急停止状態から自動復帰する幾つかの方法について説明する。
【0063】
A.厳密な干渉問題を解くことなく復帰する方法
自律的に生成した動作を各関節の制御によって実現させる場合、意図しないロボット自身の自己干渉や周囲環境との間の外部干渉が生じる可能性がある。この場合に、厳密な干渉問題を解くことなく復帰動作を完了させるため幾つかの方法を以下に挙げる。
【0064】
A−1.関節アクチュエータを脱力する
自己干渉が生じた場合に、関節アクチュエータで発生させるトルク又は力を一時的に制限する。あるいは干渉が生じる場合に備えてあらかじめ制限する。
【0065】
図5〜図8には、直立姿勢の脚式移動ロボットの左腕を緊急停止状態から復帰させる様子を示している。
【0066】
図5に示すように胴体の前で左前腕が右前腕の上にある状態で、左前腕を下に降ろそうとすると、図6に示すように、右前腕と自己干渉してしまう。
【0067】
この例では、すべてのあるいは復帰に関連する関節アクチュエータのトルク又は力が一時的に制限されているので、左前腕が右前腕表面に接触しながら、復帰動作を継続し(図7)、左腕の復帰動作を無事に完了させることができる(図8)。
【0068】
A−2.可動部の先端から順次動作させていく
PTP制御により復帰動作を行なう場合、可動部の先端から順次動作させていく。例えば、上肢を復帰させるときには手先、下肢を復帰させるときには足先に近い関節から順次動作させていく。先端から緊急停止状態を解いていくことにより、肢体同士が絡まり難くなる。または、例えば脚の場合、膝関節など特徴的な関節から順次動作させていく。あるいはスタート時刻をずらして動作を行なう。
【0069】
図9〜図12には、脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で、足先に近い方から順に復帰させる動作を示している。
【0070】
脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢において、まず、足首関節から復帰動作を開始し(図9を参照のこと)、次いで、両脚の膝関節ロール軸を駆動し(図10を参照のこと)、さらに両脚の股関節を駆動させて両脚の干渉状態を解く(図11を参照のこと)という順で復帰動作を行なうことにより、両脚が絡まり合うことなく復帰動作を無事に完了させることができる(図12を参照のこと)。
【0071】
A−3.可動部の根元から順次動作させていく
PTP制御を行なう場合、ベースリンクに近い関節から順に動作させる。この場合、動作が始まっていない関節アクチュエータで発生させるトルク又は力を制限することによって、肢体同士が絡まるのを防止する。
【0072】
図13〜図16には、脚式移動ロボット100が、右脚の下に左脚が敷かれている床上姿勢で、胴体に近い方から順に復帰させる様子を示している。
【0073】
脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢において、まず、股関節から復帰動作を開始し(図13を参照のこと)、次いで、膝関節(図14を参照のこと)、足首関節(図15を参照のこと)の順で復帰動作を行なう。
【0074】
この場合、股関節を復帰させる時点において、両脚間の自己干渉が生じるが、膝関節以下の動作が始まっていない関節アクチュエータのトルクは制限されているので、左脚は右脚表面に接触しながら、絡まり合うことなく復帰動作を無事に完了させることができる(図16を参照のこと)。
【0075】
なお、復帰動作時にアクチュエータで発生されるトルクが増大することから、自己干渉並びに外部干渉を検出しながら、上述したA−1、A−2、A−3の各方法を選択的に適用して、復帰動作を行なうようにしてもよい。
【0076】
B.厳密な干渉問題を解くことなく干渉の生じない動作を自律的に生成する方法
脚式移動ロボットにおいて、厳密な干渉問題を解くことなく、干渉の生じない動作を自律的に生成するための幾つかの方法を以下に挙げる。
【0077】
B−1.小さなトルク又は力によって制御を継続する
障害発生後も、関節アクチュエータで発生させるトルク又は力を0にせず、小さなトルク又は力によって制御し続ける。このことによって、想定外の姿勢になることを防ぐことができるとともに、その後の復帰動作の生成が容易になる。
【0078】
図17〜図18には、脚式移動ロボット100が障害発生後に関節アクチュエータの発生トルクを0にした場合の挙動を示している。図17に示す直立姿勢から、何らかの障害発生により、脚式移動ロボット100が転倒したとする。このとき、発生トルクを0にしてしまうと、図18に示すように、想定外の姿勢になり易い。
【0079】
ここで言う想定外の姿勢とは、動作パターンを作成(プログラミング)する際に、想定していなかった姿勢のことであり、例えばPTP制御においては、初期点として合致する動作パターンが少ないことを意味する。このため、復帰が困難である。
【0080】
これに対し、図19〜図21には、脚式移動ロボット100が障害発生後に関節アクチュエータを弱いトルクで制御する場合の挙動を示している。図19に示す直立姿勢から、何らかの障害発生により、脚式移動ロボット100が転倒したとする。このとき、関節アクチュエータを弱いトルクで制御すると、図20に示すように、床上に着床した時点である程度の姿勢を保つことができる。
【0081】
ここで、ある程度の姿勢とは、動作パターンを作成(プログラミング)する際に、想定することができた姿勢のことであり、例えばPTP制御においては、初期点として合致する動作パターンが比較的多く存在することを意味する。このため、復帰が容易となる。
【0082】
B−2.障害発生時まで動作を遡る
障害発生時の姿勢から復帰させるために、障害が発生した時点までの動作と逆の動作を行なう。例えば、主制御部においては、PTP制御において、順次投入された動作パターンのログを記録しており、記録された逆の順で再投入することにより、障害が発生した時点までの動作と逆の動作を再生することができる。
【0083】
図22〜図24には、直立姿勢の脚式移動ロボットの左腕の緊急停止状態からの復帰を試みる様子を示している。
【0084】
胴体の前で左前腕が右前腕の上にある通常動作状態で(図22を参照のこと)、左前腕を下に降ろそうとするとしている途上で障害が発生し、機体が緊急停止したとする(図23を参照のこと)。このとき、左右の前腕同士が近接しているので、復帰動作を誤ると、左右の前腕が自己干渉してしまい(図24を参照のこと)、2次的な障害が発生してしまい、取り返しがつかなくなる。
【0085】
これに対し、図25〜図28には、上述と同様にして障害が発生したときに、障害が発生した時点までの動作と逆の動作を行なうことにより復帰する様子を示している。
【0086】
胴体の前で左前腕が右前腕の上にある通常動作状態で(図25を参照のこと)、左前腕を下に降ろそうとするとしている途上で障害が発生し、機体が緊急停止したとする(図26を参照のこと)。このとき、左前腕を障害発生時までと逆向きに動作を行なうことにより(図27を参照のこと)、自己干渉を起こすことなく、復帰動作を無事完了することができる(図28を参照のこと)。
【0087】
B−3.復帰姿勢から通常使用する初期姿勢までの動作を用意する
PTP制御が行なわれる場合、これらの動作は途中から再生しても安定性が満たされるとは限らない。そのため、ロボットの転倒や人間の体の挟み込み、モータの過電流などの障害が発生して緊急停止した場合、通常の動作を再開するためには、いずれかの動作パターンの初期状態まで一旦移行し、その初期姿勢から動作を開始する必要がある。
【0088】
そこで、複数の復帰姿勢を用意し、復帰姿勢から通常使用する初期姿勢までの動作を用意することで、所望の動作パターンの初期姿勢までの円滑に移行できるようにする。
【0089】
このとき、ロボットが取り得るすべての姿勢からPTP制御によっていずれかの復帰姿勢へ遷移できるような複数の復帰姿勢を用意する。また、同様に複数の復帰姿勢を用意し、それらを経由して通常使用する初期姿勢までの動作を完了する(図29を参照のこと)。
【0090】
B−4.自己干渉を考慮した機体設計
ロボットの関節の関節可動範囲や関節自由度配置をPTP制御などで干渉しないように設計する。
【0091】
C.厳密な干渉問題を解いて干渉の生じない動作を自律的に生成する方法
脚式移動ロボットにおいて、厳密な干渉問題を解くことによって干渉の生じない動作を自律的に生成して復帰する。
【0092】
[追補]
以上、特定の実施例を参照しながら、本発明について詳解してきた。しかしながら、本発明の要旨を逸脱しない範囲で当業者が該実施例の修正や代用を成し得ることは自明である。
【0093】
本発明の要旨は、必ずしも「ロボット」と称される製品には限定されない。すなわち、電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行なう機械装置あるいはその他一般的な移動体装置であるならば、例えば玩具などのような他の産業分野に属する製品であっても、同様に本発明を適用することができる。
【0094】
要するに、例示という形態で本発明を開示してきたのであり、本明細書の記載内容を限定的に解釈するべきではない。本発明の要旨を判断するためには、冒頭に記載した特許請求の範囲の欄を参酌すべきである。
【0095】
【発明の効果】
以上詳記したように、本発明によれば、可動部同士の自己干渉や周囲の物体との外部干渉に拘わらず緊急停止した状態から自立的に復帰することができる、優れた脚式移動ロボット及びその動作制御方法を提供することができる。
【図面の簡単な説明】
【図1】本発明の実施に供される脚式移動ロボットが直立している様子を前方から眺望した様子を示した図である。
【図2】本発明の実施に供される脚式移動ロボットが直立している様子を後方から眺望した様子を示した図である。
【図3】脚式移動ロボットが具備する関節自由度構成を模式的に示した図である。
【図4】脚式移動ロボット100の制御システム構成を模式的に示した図である。
【図5】脚式移動ロボット100が関節アクチュエータを脱力させて緊急停止状態から復帰する動作を説明するための図である。
【図6】脚式移動ロボット100が関節アクチュエータを脱力させて緊急停止状態から復帰する動作を説明するための図である。
【図7】脚式移動ロボット100が関節アクチュエータを脱力させて緊急停止状態から復帰する動作を説明するための図である。
【図8】脚式移動ロボット100が関節アクチュエータを脱力させて緊急停止状態から復帰する動作を説明するための図である。
【図9】脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で足先に近い方から順に復帰させる動作を説明するための図である。
【図10】脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で足先に近い方から順に復帰させる動作を説明するための図である。
【図11】脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で足先に近い方から順に復帰させる動作を説明するための図である。
【図12】脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で足先に近い方から順に復帰させる動作を説明するための図である。
【図13】脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で胴体に近い方から順に復帰させる動作を説明するための図である。
【図14】脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で胴体に近い方から順に復帰させる動作を説明するための図である。
【図15】脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で胴体に近い方から順に復帰させる動作を説明するための図である。
【図16】脚式移動ロボット100が右脚の下に左脚が敷かれている床上姿勢で胴体に近い方から順に復帰させる動作を説明するための図である。
【図17】脚式移動ロボット100が障害発生後に関節アクチュエータの発生トルクを0にした場合の挙動を説明するための図である。
【図18】脚式移動ロボット100が障害発生後に関節アクチュエータの発生トルクを0にした場合の挙動を説明するための図である。
【図19】脚式移動ロボット100が障害発生後に関節アクチュエータを弱いトルクで制御する場合の挙動を説明するための図である。
【図20】脚式移動ロボット100が障害発生後に関節アクチュエータを弱いトルクで制御する場合の挙動を説明するための図である。
【図21】脚式移動ロボット100が障害発生後に関節アクチュエータを弱いトルクで制御する場合の挙動を説明するための図である。
【図22】直立姿勢の脚式移動ロボットの左腕の緊急停止状態からの復帰を試みる様子を示した図である。
【図23】直立姿勢の脚式移動ロボットの左腕の緊急停止状態からの復帰を試みる様子を示した図である。
【図24】直立姿勢の脚式移動ロボットの左腕の緊急停止状態からの復帰を試みる様子を示した図である。
【図25】脚式移動ロボットが障害発生時までの動作と逆の動作を行なうことにより緊急停止状態から復帰する方法を説明するための図である。
【図26】脚式移動ロボットが障害発生時までの動作と逆の動作を行なうことにより緊急停止状態から復帰する方法を説明するための図である。
【図27】脚式移動ロボットが障害発生時までの動作と逆の動作を行なうことにより緊急停止状態から復帰する方法を説明するための図である。
【図28】脚式移動ロボットが障害発生時までの動作と逆の動作を行なうことにより緊急停止状態から復帰する方法を説明するための図である。
【図29】復帰姿勢から通常使用する初期姿勢までの動作を用意する方法を説明するための図である。
【符号の説明】
1…首関節ヨー軸
2A…第1の首関節ピッチ軸
2B…第2の首関節(頭)ピッチ軸
3…首関節ロール軸
4…肩関節ピッチ軸
5…肩関節ロール軸
6…上腕ヨー軸
7…肘関節ピッチ軸
8…手首関節ヨー軸
9…体幹ピッチ軸
10…体幹ロール軸
11…股関節ヨー軸
12…股関節ピッチ軸
13…股関節ロール軸
14…膝関節ピッチ軸
15…足首関節ピッチ軸
16…足首関節ロール軸
30…頭部ユニット,40…体幹部ユニット
50…腕部ユニット,51…上腕ユニット
52…肘関節ユニット,53…前腕ユニット
60…脚部ユニット,61…大腿部ユニット
62…膝関節ユニット,63…脛部ユニット
80…制御ユニット,81…主制御部
82…周辺回路
91,92…接地確認センサ
93,94…加速度センサ
95…姿勢センサ
96…加速度センサ
100…脚式移動ロボット
Claims (16)
- 基体と前記基体に接続される複数の可動部を備えたロボット装置であって、
所定の障害の発生に応じて装置動作を停止させる停止手段と、
前記ロボット装置自身の自己干渉及び/又は周囲環境との間の外部干渉の問題を厳密に解くことなく該停止された装置動作を復帰させる復帰手段と、
を具備することを特徴とするロボット装置。 - 前記複数の可動部は、少なくとも上肢、下肢および体幹部を含む、
ことを特徴とする請求項1に記載のロボット装置。 - 前記復帰手段は、自己干渉が生じた場合に、自己干渉が生じた部位における自由度を構成する関節アクチュエータで発生させるトルク又は力を一時的に制限する、あるいは干渉が生じる場合に備えてあらかじめ制限する、
ことを特徴とする請求項1に記載のロボット装置。 - 前記復帰手段は、前記可動部の先端から順次動作させていく、
ことを特徴とする請求項1に記載のロボット装置。 - 前記復帰手段は、前記可動部を前記基体に近い関節から順に動作させるとともに、動作が始まっていない関節アクチュエータで発生させるトルク又は力を制限する、
ことを特徴とする請求項1に記載のロボット装置。 - 前記復帰手段は、干渉の生じないような動作を自律的に生成する、
ことを特徴とする請求項1に記載のロボット装置。 - 前記停止手段は、障害発生後も、前記可動部の関節アクチュエータを小さなトルク又は力によって制御し続ける、
ことを特徴とする請求項6に記載のロボット装置。 - 前記復帰手段は、障害が発生した時点までの動作と逆の動作を行なう、
ことを特徴とする請求項6に記載のロボット装置。 - 基体と前記基体に接続される複数の可動部を備えたロボット装置の動作制御方法であって、
所定の障害の発生に応じて装置動作を停止させる停止ステップと、
前記ロボット装置自身の自己干渉及び/又は周囲環境との間の外部干渉の問題を厳密に解くことなく該停止された装置動作を復帰させる復帰ステップと、
を具備することを特徴とするロボット装置の動作制御方法。 - 前記複数の可動部は、少なくとも上肢、下肢および体幹部を含む、
ことを特徴とする請求項9に記載のロボット装置の動作制御方法。 - 前記復帰ステップでは、自己干渉が生じた場合に、自己干渉が生じた部位における自由度を構成する関節アクチュエータで発生させるトルク又は力を一時的に制限する、あるいは干渉が生じる場合に備えてあらかじめ制限する、
ことを特徴とする請求項9に記載のロボット装置の動作制御方法。 - 前記復帰ステップでは、前記可動部の先端から順次動作させていく、
ことを特徴とする請求項9に記載のロボット装置の動作制御方法。 - 前記復帰ステップでは、前記可動部を前記基体に近い関節から順に動作させるとともに、動作が始まっていない関節アクチュエータで発生させるトルク又は力を制限する、
ことを特徴とする請求項9に記載のロボット装置の動作制御方法。 - 前記復帰ステップでは、干渉の生じないような動作を自律的に生成する、
ことを特徴とする請求項9に記載のロボット装置の動作制御方法。 - 前記停止ステップでは、障害発生後も、前記可動部の関節アクチュエータを小さなトルク又は力によって制御し続ける、
ことを特徴とする請求項14に記載のロボット装置の動作制御方法。 - 前記復帰ステップでは、障害が発生した時点までの動作と逆の動作を行なう、ことを特徴とする請求項14に記載のロボット装置の動作制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003078834A JP4110525B2 (ja) | 2003-03-20 | 2003-03-20 | ロボット装置及びその動作制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003078834A JP4110525B2 (ja) | 2003-03-20 | 2003-03-20 | ロボット装置及びその動作制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004283954A true JP2004283954A (ja) | 2004-10-14 |
JP4110525B2 JP4110525B2 (ja) | 2008-07-02 |
Family
ID=33293202
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003078834A Expired - Fee Related JP4110525B2 (ja) | 2003-03-20 | 2003-03-20 | ロボット装置及びその動作制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4110525B2 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010119549A (ja) * | 2008-11-19 | 2010-06-03 | Sammy Corp | 可動役物ユニットの制御方法及び遊技機 |
JP2016064479A (ja) * | 2014-09-25 | 2016-04-28 | ファナック株式会社 | ロボット制御装置 |
JP2017177269A (ja) * | 2016-03-29 | 2017-10-05 | 本田技研工業株式会社 | ロボットおよびその制御方法 |
WO2018037662A1 (ja) * | 2016-08-26 | 2018-03-01 | シャープ株式会社 | ロボット、ロボットの制御方法、および制御プログラム |
-
2003
- 2003-03-20 JP JP2003078834A patent/JP4110525B2/ja not_active Expired - Fee Related
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010119549A (ja) * | 2008-11-19 | 2010-06-03 | Sammy Corp | 可動役物ユニットの制御方法及び遊技機 |
JP2016064479A (ja) * | 2014-09-25 | 2016-04-28 | ファナック株式会社 | ロボット制御装置 |
JP2017177269A (ja) * | 2016-03-29 | 2017-10-05 | 本田技研工業株式会社 | ロボットおよびその制御方法 |
WO2018037662A1 (ja) * | 2016-08-26 | 2018-03-01 | シャープ株式会社 | ロボット、ロボットの制御方法、および制御プログラム |
JPWO2018037662A1 (ja) * | 2016-08-26 | 2019-03-07 | シャープ株式会社 | ロボット、ロボットの制御方法、および制御プログラム |
Also Published As
Publication number | Publication date |
---|---|
JP4110525B2 (ja) | 2008-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3555107B2 (ja) | 脚式移動ロボット及び脚式移動ロボットの動作制御方法 | |
JP3824608B2 (ja) | 脚式移動ロボット及びその動作制御方法 | |
JP4305323B2 (ja) | ロボット装置の動作制御装置及び動作制御方法 | |
WO2003078109A1 (fr) | Dispositif de commande operationnelle pour robot mobile du type a jambes, procede de commande operationnelle, et robot | |
JP3528171B2 (ja) | 移動ロボット装置及び移動ロボット装置の転倒制御方法 | |
JP4660870B2 (ja) | 脚式移動ロボット及びその制御方法 | |
JP4110525B2 (ja) | ロボット装置及びその動作制御方法 | |
JP4289446B2 (ja) | 脚式移動ロボット | |
JP4289447B2 (ja) | ロボット装置及び関節軸駆動装置 | |
JP4770990B2 (ja) | 脚式移動ロボット及びその制御方法 | |
JP2001157972A (ja) | 脚式移動ロボット | |
JP3813102B2 (ja) | 脚式ロボットの姿勢制御装置及び姿勢制御方法 | |
JP3555946B2 (ja) | 移動ロボット装置及び移動ロボット装置の制御方法 | |
JP4981074B2 (ja) | 脚式移動ロボット | |
JP3555947B2 (ja) | 移動ロボット装置、移動ロボット装置の制御方法、移動ロボット装置の運動パターン生成方法、並びに移動ロボット装置の運動制御プログラム | |
JP3522741B2 (ja) | 脚式移動ロボットの動作制御装置及び動作制御方法、並びにロボット装置 | |
JP3555948B2 (ja) | 移動ロボット装置、移動ロボット装置の動作制御装置及び動作制御方法 | |
JP2001150375A (ja) | 脚式移動ロボットの制御システム | |
JP2005007501A (ja) | ロボット装置及びその動作制御方法 | |
JP3443116B2 (ja) | 移動ロボット及び移動ロボットの制御方法 | |
JP2005014144A (ja) | ロボット装置及びその動作制御方法 | |
JP2003159676A (ja) | 脚式移動ロボットの制御方法 | |
JP2005040913A (ja) | ロボット装置及びその動作制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20051201 |
|
A131 | Notification of reasons for refusal |
Effective date: 20070605 Free format text: JAPANESE INTERMEDIATE CODE: A131 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070806 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080115 |
|
A521 | Written amendment |
Effective date: 20080225 Free format text: JAPANESE INTERMEDIATE CODE: A523 |
|
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: 20080314 |
|
A61 | First payment of annual fees (during grant procedure) |
Effective date: 20080327 Free format text: JAPANESE INTERMEDIATE CODE: A61 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 3 Free format text: PAYMENT UNTIL: 20110418 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110418 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120418 Year of fee payment: 4 |
|
LAPS | Cancellation because of no payment of annual fees |