JP3813102B2 - 脚式ロボットの姿勢制御装置及び姿勢制御方法 - Google Patents

脚式ロボットの姿勢制御装置及び姿勢制御方法 Download PDF

Info

Publication number
JP3813102B2
JP3813102B2 JP2002073389A JP2002073389A JP3813102B2 JP 3813102 B2 JP3813102 B2 JP 3813102B2 JP 2002073389 A JP2002073389 A JP 2002073389A JP 2002073389 A JP2002073389 A JP 2002073389A JP 3813102 B2 JP3813102 B2 JP 3813102B2
Authority
JP
Japan
Prior art keywords
posture
origin
basic
joint
axis
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
Application number
JP2002073389A
Other languages
English (en)
Other versions
JP2003266338A (ja
Inventor
裕一 服部
仁一 山口
憲一郎 長阪
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sony Corp
Original Assignee
Sony Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sony Corp filed Critical Sony Corp
Priority to JP2002073389A priority Critical patent/JP3813102B2/ja
Publication of JP2003266338A publication Critical patent/JP2003266338A/ja
Application granted granted Critical
Publication of JP3813102B2 publication Critical patent/JP3813102B2/ja
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Landscapes

  • Manipulator (AREA)
  • Toys (AREA)

Description

【0001】
【発明の属する技術分野】
本発明は、多数の関節自由度を持つ脚式ロボットの姿勢制御装置及び姿勢制御方法に係り、特に、複数の可動脚を備えた脚式移動脚式ロボットの姿勢制御装置及び姿勢制御方法に関する。
【0002】
さらに詳しくは、本発明は、エンターテインメント型のロボットのように、定型的な作業に限らず多種多様な機体動作を行なう脚式ロボットの姿勢制御装置及び姿勢制御方法に係り、特に、複数の基本姿勢をベースにして機体動作を制御する脚式ロボットの姿勢制御装置及び姿勢制御方法に関する。
【0003】
【従来の技術】
電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置のことを「ロボット」という。ロボットの語源は、スラブ語の"ROBOTA(奴隷機械)"に由来すると言われている。わが国では、ロボットが普及し始めたのは1960年代末からであるが、その多くは、工場における生産作業の自動化・無人化などを目的としたマニピュレータや搬送ロボットなどの産業用ロボット(industrial robot)であった。
【0004】
最近では、イヌやネコのように4足歩行の動物の身体メカニズムやその動作を模したペット型ロボット、あるいは、ヒトのような2足直立歩行を行う動物の身体メカニズムや動作をモデルにしてデザインされた「人間形」若しくは「人間型」と呼ばれるロボット(humanoid robot)など、脚式移動ロボットに関する研究開発が進展し、実用化への期待も高まってきている。
【0005】
ヒトの生体メカニズムや動作をエミュレートした脚式移動ロボットのことを、特に、「人間形」、若しくは「人間型」のロボット(humanoid robot)と呼ぶ。人間型ロボットは、例えば、生活支援、すなわち住環境その他の日常生活上の様々な場面における人的活動の支援などを行うことができる。
【0006】
脚式移動ロボットの用途の1つとして、産業活動・生産活動等における各種の難作業の代行が挙げられる。例えば、原子力発電プラントや火力発電プラント、石油化学プラントにおけるメンテナンス作業、製造工場における部品の搬送・組立作業、高層ビルにおける清掃、火災現場その他における救助といったような危険作業・難作業の代行などである。
【0007】
また、脚式移動ロボットの他の用途として、上述の作業支援というよりも、生活密着型、すなわち人間との「共生」あるいは「エンターティンメント」という用途が挙げられる。この種のロボットは、ヒトあるいはイヌ(ペット)、クマなどの比較的知性の高い脚式歩行動物の動作メカニズムや四肢を利用した豊かな感情表現を忠実に再現する。また、あらかじめ入力された動作パターンを単に忠実に実行するだけではなく、ユーザ(あるいは他のロボット)から受ける言葉や態度(「褒める」とか「叱る」、「叩く」など)に対して動的に対応した、生き生きとした応答表現を実現することも要求される。
【0008】
従来の玩具機械は、ユーザ操作と応答動作との関係が固定的であり、玩具の動作をユーザの好みに合わせて変更することはできない。この結果、ユーザは同じ動作しか繰り返さない玩具をやがては飽きてしまうことになる。これに対し、インテリジェントなロボットは、対話や機体動作などからなる行動を自律的に選択することから、より高度な知的レベルでリアリスティックなコミュニケーションを実現することが可能となる。この結果、ユーザはロボットに対して深い愛着や親しみを感じる。
【0009】
【発明が解決しようとする課題】
自動機械は、一般に、電源投入後、自己診断処理や初期化処理を経て通常の動作状態となる。また、その動作や行動は、あらかじめ規定されている状態遷移(ステートマシン)に従って制御される。
【0010】
ロボットにおいてステートマシンで規定されている各状態は、基本姿勢としての性質を持つ。例えば、基本姿勢となるポーズすなわち機体上の各関節角をあらかじめ定めておき、各基本姿勢間を繋ぐような各関節角の軌道を計算して、アクションすなわち機体動作を作成することができる。そして、複数のアクションを直列的あるいは並列的に組み合わせることにより、インタラクションなどの意味を備えたビヘイビアすなわち行動を編集することができる。
【0011】
ロボットを始めとする自動機械における基本姿勢は、動作の開始点、分岐点、終了点など機械制御において重要な意味を持つ。
【0012】
従来の産業用途のロボットは、その動作は比較的少数の定型的な動作の繰り返ししか行なわない。したがって、機体設計を特定の目的に限定して最適化することができるし、数少ない基本姿勢で済む。
【0013】
これに対し、上述したエンターテインメント型の脚式移動ロボットの場合、単なる歩行などの脚式作業の他に、跳躍やダンスなど多岐にわたる動作を行なう。また、脚だけでなく、胴体や上肢などを含めたさまざまな動作を行なう。このため、動作の開始点、分岐点、終了点として、どのような姿勢を基本姿勢として位置付けるかは、機体制御の効率化を考えても重要な問題である。
【0014】
2足直立姿勢や「休め」のポーズなど、見た目でロボットの基本姿勢を定義することもできる。しかしながら、機体の安定性や、消費エネルギ、次の状態への遷移を考慮して基本姿勢を設定しなければ、制御には不利である。
【0015】
安定性の低い姿勢を基本姿勢に設定した場合、常に姿勢安定制御を実行しなければならず、計算機への負荷は過大である。また、基本姿勢においても、常に姿勢維持のために関節軸アクチュエータがトルクを発生しなければならなくなり、消費電力の浪費になる。
【0016】
本発明は上述したような技術的課題を鑑みたものであり、その目的は、エンターテインメント型のロボットのように、定型的な作業に限らず多種多様な機体動作を好適に行なうことができる、優れた脚式ロボットの姿勢制御装置及び姿勢制御方法を提供することにある。
【0017】
本発明のさらなる目的は、複数の基本姿勢をベースにして機体動作を効率的に制御することができる、優れた脚式ロボットの姿勢制御装置及び姿勢制御方法を提供することにある。
【0018】
本発明のさらなる目的は、機体の安定性や、消費エネルギ、次の状態への遷移を考慮して基本姿勢を設定して機体運動を好適に制御することができる、優れた脚式ロボットの姿勢制御装置及び姿勢制御方法を提供することにある。
【0019】
【課題を解決するための手段及び作用】
本発明は、上記課題を参酌してなされたものであり、その第1の側面は、複数の関節自由度を備えるとともに複数の基本姿勢間の遷移により機体動作を制御する脚式ロボットの姿勢制御装置又は方法であって、
脱力した仰向け又はうつ伏せ姿勢で静止状態を維持する基本床上姿勢にて駆動電源を投入する電源投入手段又はステップと、
前記基本床上姿勢にて機体の初期化処理を行なう初期化手段又はステップと、床上姿勢において機体の傾斜確認及び/又は各関節自由度における原点探索を行なう原点探索手段又はステップと、
を具備することを特徴とする脚式ロボットの姿勢制御装置又は方法である。
【0020】
ここで、前記原点探索手段又はステップは、前記基本床上姿勢において探索対象となる関節角を原点探索方向に駆動させて原点を通過することによって原点チェックを行なうことができる。
【0021】
したがって、本発明の第1の側面に係る脚式ロボットの姿勢制御装置又は方法によれば、脚式移動ロボットの基本仰向け姿勢でオペレータが電源を投入すると、その姿勢のままハードウェアの診断やソフトウェアの初期化、機体の原点チェックなどの起動シーケンスを行なった後、所定の起き上がりモーション・シーケンスに従って基本立ち姿勢に自動的に遷移するので、起動時の作業負担が軽減される。そして、一旦基本立ち姿勢を形成すると、これを姿勢遷移の基準にして、歩行やダンスなど、脚部を始め全身の各部の自由度を活用した各種のパフォーマンスを行なうことが可能となる。
【0022】
また、本発明の第1の側面に係る脚式ロボットの姿勢制御装置又は方法によれば、基本仰向け姿勢のまま前記原点探索手段により原点チェックを行なうが、この時点で原点チェックに失敗したことに応答して前記機体起き上がり手段の起動を停止することにより、起き上がり動作時又は起き上がり後に機体が転倒するという事態を未然に防止することができる。
【0023】
起き上がり後の脚式移動ロボットは、機体のZMPをZMP安定領域の中心付近に配置した基本的な立脚姿勢をとる。基本立脚姿勢として、膝の曲げ角を小さくしてエネルギ消費量を抑制した基本立ち姿勢と、膝の曲げ角を比較的大きくして路面適応性並びに外力適応性を高めた基本歩行姿勢を規定している。基本歩行姿勢では膝の曲げ角を大きくした分だけエネルギ消費量が増大するが、歩行やその他の脚式動作への移行を円滑且つ効率的に行なうことができる。
【0024】
また、本発明の第2の側面は、複数の基本姿勢間の遷移により機体動作を制御する脚式ロボットの姿勢制御装置又は方法であって、
基本姿勢近傍の関節角度に原点を設定する原点設定手段又はステップと、
基本姿勢から関節が変位して原点を通過するときに原点チェックを行なう機体診断手段又はステップと、
を具備することを特徴とする脚式ロボットの姿勢制御装置又は方法である。
【0025】
そして、前記機体診断手段又はステップが原点チェックに失敗したことに応答して、機体動作を停止させるようにすることによって、その後の脚式動作において機体が転倒・落下するという事態を未然に防止することができる。
【0026】
本発明の第2の側面に係る脚式移動ロボットは、機体の立脚時においてZMPをZMP安定領域の中心付近に配置した基本姿勢として、膝の曲げ角を小さくしてエネルギ消費量を抑制した基本立ち姿勢と、膝の曲げ角を比較的大きくして路面適応性並びに外力適応性を高めた基本歩行姿勢を備えている。
【0027】
また、脚式移動ロボットは脚部において、足首ピッチ軸、足首ロール軸、膝ピッチ軸、股関節ロール軸、股関節ピッチ軸の関節自由度を備えている。そして、前記原点設定手段又はステップは、前記足首ロール軸及び股関節ロール軸の原点を前記基本歩行姿勢から単脚支持期最前期の間に設定するとともに、前記足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸の原点を前記基本立ち姿勢と前記基本歩行姿勢の間に設定してもよい。
【0028】
このような場合、前記機体診断手段又はステップは、立脚側への機体のZMPを移動させる歩行予備動作期間中に前記足首ロール軸及び股関節ロール軸の原点チェックを行なうことができるとともに、歩行停止毎に前記足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸の原点チェックを行なうことができる。
【0029】
また、脚式移動ロボットの胴体はさらに体幹ピッチ軸及び体幹ロール軸の関節自由度を備えていてもよい。そして、前記原点設定手段又はステップは、前記体幹ロール軸の原点を前記基本歩行姿勢から単脚支持期最前期の間に設定するとともに、前記体幹ピッチ軸の原点を前記基本立ち姿勢と前記基本歩行姿勢の間に設定してもよい。
【0030】
このような場合、前記機体診断手段又はステップは、立脚側への機体のZMPを移動させる歩行予備動作期間中に前記体幹ロール軸の原点チェックを行なうことができるとともに、歩行停止毎に前記体幹ピッチ軸の原点チェックを行なうことができる。
【0031】
本発明のさらに他の目的、特徴や利点は、後述する本発明の実施形態や添付する図面に基づくより詳細な説明によって明らかになるであろう。
【0032】
【発明の実施の形態】
以下、図面を参照しながら本発明の実施形態について詳解する。
【0033】
A.脚式移動ロボットの物理的構成
図1及び図2には本発明の実施に供される「人間形」又は「人間型」の脚式移動ロボットが直立している様子を前方及び後方の各々から眺望した様子を示している。図示の通り、脚式移動ロボットは、胴体部と、頭部と、左右の上肢部と、脚式移動を行う左右2足の下肢部とで構成され、例えば胴体に内蔵されている制御部(図示しない)により機体の動作を統括的にコントロールするようになっている。
【0034】
左右各々の下肢は、大腿部と、膝関節と、脛部と、足首と、足平とで構成され、股関節によって体幹部の略最下端にて連結されている。また、左右各々の上肢は、上腕と、肘関節と、前腕とで構成され、肩関節によって体幹部の上方の左右各側縁にて連結されている。また、頭部は、首関節によって体幹部の略最上端中央に連結されている。
【0035】
制御部は、この脚式移動ロボットを構成する各関節アクチュエータの駆動制御や各センサ(後述)などからの外部入力を処理するコントローラ(主制御部)や、電源回路その他の周辺機器類を搭載した筐体である。制御部は、その他、遠隔操作用の通信インターフェースや通信装置を含んでいてもよい。
【0036】
このように構成された脚式移動ロボットは、制御部による全身協調的な動作制御により、2足歩行を実現することができる。かかる2足歩行は、一般に、以下に示す各動作期間に分割される歩行周期を繰り返すことによって行われる。すなわち、
【0037】
(1)右脚を持ち上げた、左脚による単脚支持期
(2)右足が接地した両脚支持期
(3)左脚を持ち上げた、右脚による単脚支持期
(4)左足が接地した両脚支持期
【0038】
脚式移動ロボットにおける歩行制御は、あらかじめ下肢の目標軌道を計画し、上記の各期間において計画軌道の修正を行うことによって実現される。すなわち、両脚支持期では、下肢軌道の修正を停止して、計画軌道に対する総修正量を用いて腰の高さを一定値で修正する。また、単脚支持期では、修正を受けた脚の足首と腰との相対位置関係を計画軌道に復帰させるように修正軌道を生成する。
【0039】
歩行動作の軌道修正を始めとして、機体の姿勢安定制御には、一般に、ZMPに対する偏差を小さくするための位置、速度、及び加速度が連続となるように、5次多項式を用いた補間計算により行う。ZMP(Zero Moment Point)を歩行の安定度判別の規範として用いている。ZMPによる安定度判別規範は、歩行系から路面には重力と慣性力、並びにこれらのモーメントが路面から歩行系への反作用としての床反力並びに床反力モーメントとバランスするという「ダランベールの原理」に基づく。力学的推論の帰結として、足底接地点と路面の形成する支持多角形(すなわちZMP安定領域)の辺上あるいはその内側にピッチ軸及びロール軸モーメントがゼロとなる点、すなわち「ZMP(Zero Moment Point)」が存在する。
【0040】
図3には、この脚式移動ロボットが具備する関節自由度構成を模式的に示している。同図に示すように、脚式移動ロボットは、2本の腕部と頭部を含む上肢と、移動動作を実現する2本の脚部からなる下肢と、上肢と下肢とを連結する体幹部とで構成された、複数の肢を備えた構造体である。
【0041】
頭部を支持する首関節(Neck)は、首関節ヨー軸1と、第1及び第2の首関節ピッチ軸2A及び2Bと、首関節ロール軸3という3自由度を有している。
【0042】
また、各腕部は、その自由度として、肩(Shoulder)における肩関節ピッチ軸4と、肩関節ロール軸5と、上腕ヨー軸6、肘(Elbow)における肘関節ピッチ軸7と、手首(Wrist)における手首関節ヨー軸8と、手部とで構成される。手部は、実際には、複数本の指を含む多関節・多自由度構造体である。
【0043】
また、体幹部(Trunk)は、体幹ピッチ軸9と、体幹ロール軸10という2自由度を有する。
【0044】
また、下肢を構成する各々の脚部は、股関節(Hip)における股関節ヨー軸11と、股関節ピッチ軸12と、股関節ロール軸13と、膝(Knee)における膝関節ピッチ軸14と、足首(Ankle)における足首関節ピッチ軸15と、足首関節ロール軸16と、足部とで構成される。
【0045】
但し、エンターティンメント向けの脚式移動ロボットが上述したすべての自由度を装備しなければならない訳でも、あるいはこれに限定される訳でもない。設計・製作上の制約条件や要求仕様などに応じて、自由度すなわち関節数を適宜増減することができることは言うまでもない。
【0046】
上述したような脚式移動ロボットが持つ各自由度は、実際にはアクチュエータを用いて実装される。外観上で余分な膨らみを排してヒトの自然体形状に近似させること、2足歩行という不安定構造体に対して姿勢制御を行うことなどの要請から、アクチュエータは小型且つ軽量であることが好ましい。本実施形態では、ギア直結型で且つサーボ制御系をワンチップ化してモータ・ユニットに内蔵したタイプの小型ACサーボ・アクチュエータを搭載することとした(この種のACサーボ・アクチュエータに関しては、例えば本出願人に既に譲渡されている特開2000−299970号公報に開示されている)。本実施形態では、直結ギアとして低減速ギアを採用することにより、人間との物理的インタラクションを重視するタイプのロボットに求められている駆動系自身の受動的特性を得ている。
【0047】
B.脚式移動ロボットの制御システム構成
図4には、本発明に実施に供される脚式移動ロボットの制御システム構成を模式的に示している。同図に示すように、脚式移動ロボットは、全体の動作の統括的制御やその他のデータ処理を行う制御ユニット20と、入出力部40と、駆動部50と、電源部60とで構成される。以下、各部について説明する。
【0048】
入出力部40は、入力部として脚式移動ロボットの目に相当するCCDカメラ41や、耳に相当するマイクロフォン42、また、出力部として、口に相当するスピーカ43、あるいは点滅の組み合わせや点灯のタイミングにより顔の表情を形成するLEDインジケータ(目ランプ)44などを装備している。これら出力部は、音声出力やLEDの点滅などを用いて、機体動作以外の形式でもロボット装置1からのユーザ・フィードバックを表現することができる。
【0049】
また、ロボットが外部環境を取得するために、頭部や背中などの部位に配設されてユーザの接触を感知するタッチ・センサ45(あるいは五感に相当するその他の各種のセンサ)を含む。
【0050】
また、ロボットが機体で実行する動作や行動の状況を取得するために、接地センサ46や加速度センサ47を備えている。接地センサ46は、左右の足部の足底に配設されて、床反力などを検出して、現在着床中かどうかを判別するようになっている。加速度センサ47は、機体の傾斜・姿勢計測に用いられる。加速度センサ47を設置した場所で世界座標系を取得することができる。例えば、左右の両脚に加速度センサ47を設けることにより、立脚から判る世界座標系を使って期待の運動制御や姿勢制御を行なうことができる。また、機体の腰部に加速度センサ47を配設することにより、世界座標上の腰位置を基準にして姿勢安定制御を行なうことが可能となる。なお、加速度センサ47の代わりに、傾斜センサとジャイロの組み合わせによっても機体の傾斜を計測することができる。
【0051】
駆動部50は、制御部20が指令する所定の運動パターンに従って脚式移動ロボットの機体動作を実現する機能ブロックであり、行動制御による制御対象である。駆動部50は、脚式移動ロボットの各関節における自由度を実現するための機能モジュールであり、それぞれの関節におけるロール、ピッチ、ヨーなど各軸毎に設けられた複数の駆動ユニットで構成される。各駆動ユニットは、所定軸回りの回転動作を行うモータ51と、モータ51の回転位置を検出するエンコーダ52と、エンコーダ52の出力に基づいてモータ51の回転位置や回転速度を適応的に制御するドライバ53の組み合わせで構成される。各関節軸モータ51には、低減速ギア直結で、ドライバ53内蔵型のACサーボ・モータが使用されている(前述)。
【0052】
電源部60は、その字義通り、脚式移動ロボット内の各電気回路などに対して給電を行う機能モジュールである。本実施形態に係る脚式移動ロボットは、バッテリを用いた自律駆動式であり、電源部60は、充電バッテリ61と、充電バッテリ61の充放電状態を管理する充放電制御部62とで構成される。
【0053】
充電バッテリ61は、例えば、複数本のリチウムイオン2次電池セルをカートリッジ式にパッケージ化した「バッテリ・パック」の形態で構成される。
【0054】
また、充放電制御部62は、バッテリ61の端子電圧や充電/放電電流量、バッテリ61の周囲温度などを測定することでバッテリ61の残存容量を把握し、充電の開始時期や終了時期などを決定する。充放電制御部62が決定する充電の開始及び終了時期は制御ユニット20に通知され、ロボット装置1が充電オペレーションを開始及び終了するためのトリガとなる。
【0055】
図5には、制御ユニット20の構成をさらに詳細に図解している。同図に示すように、制御ユニット20は、メイン・コントローラとしてのCPU(Central Processing Unit)21が、メモリやその他の各回路コンポーネントや周辺機器とバス接続された構成となっている。バス27は、データ・バス、アドレス・バス、コントロール・バスなどを含む共通信号伝送路である。バス27上の各装置にはそれぞれに固有のアドレス(メモリ・アドレス又はI/Oアドレス)が割り当てられている。CPU21は、アドレスを指定することによってバス28上の特定の装置と通信することができる。
【0056】
RAM(Random Access Memory)22は、DRAM(Dynamic RAM)などの揮発性メモリで構成された書き込み可能メモリであり、CPU21が実行するプログラム・コードをロードしたり、実行プログラムによる作業データの一時的な保存のために使用される。
【0057】
実行されるプログラム・コードには、脚式移動ロボットの電源投入時に実行する起動シーケンス・プログラムや、脚式移動ロボットの運動系の動作を制御する動作制御プログラムなどが挙げられる。また、本実施形態では、運動系の動作制御は、姿勢安定性や消費電力、状態遷移を考慮した複数の基本姿勢を規定して、これら基本姿勢に基づく状態遷移により行なわれる。起動シーケンス・プログラムや運動系の動作制御の詳細については後述に譲る。
【0058】
ROM(Read Only Memory)23は、プログラムやデータを恒久的に格納する読み出し専用メモリである。また、不揮発性メモリ24は、例えばEEPROM(Electrically Erasable and Programmable ROM)のように電気的に消去再書き込みが可能なメモリ素子で構成され、逐次更新すべきデータを不揮発的に保持するために使用される。逐次更新すべきデータには、暗号鍵やその他のセキュリティ情報、出荷後にインストールすべき装置制御プログラムなどが挙げられる。
【0059】
機体動作のプラットフォームを構築するための装置制御プログラムは、ROM23やEEPROM24などの不揮発性記憶領域にマッピングされる。このうちハードウェア固有の制御プログラムはROM23内にあらかじめ用意され、ハードウェア変更に伴うプログラム・モジュール部分はEEPROM24に追記するようにしてもよい。本実施形態では、このプラットフォーム領域では、複数の基本姿勢をベースにして機体動作を効率的に制御するようになっている(後述)。また、脚式移動ロボットは、立ち姿勢などにおいて、歩行や跳躍、ダンスなど全身動作を利用した各種のパフォーマンスを行なうが、その装置制御プログラムは、プラットフォーム上で動作するアプリケーションとして位置付けられる。これらアプリケーション・プログラムは、外部記憶からRAM22上に随時ロードされ、CPU21によって実行される。
【0060】
インターフェース25は、制御ユニット20外の機器と相互接続し、データ交換を可能にするための装置である。インターフェース25は、例えば、カメラ41やマイクロフォン42、スピーカ43との間でデータ入出力を行う。また、インターフェース25は、駆動部50内の各ドライバ53−1…との間でデータやコマンドの入出力を行う。
【0061】
また、インターフェース25は、RS(Recommended Standard)−232Cなどのシリアル・インターフェース、IEEE(Institute of Electrical and electronics Engineers)1284などのパラレル・インターフェース、USB(Universal Serial Bus)インターフェース、i−Link(IEEE1394)インターフェース、SCSI(Small Computer System Interface)インターフェース、PCカードやメモリ・スティックを受容するメモリ・カード・インターフェース(カード・スロット)などのような、コンピュータの周辺機器接続用の汎用インターフェースを備え、ローカル接続された外部機器との間でプログラムやデータの移動を行うようにしてもよい。
【0062】
さらに、制御ユニット20は、無線通信インターフェース26やネットワーク・インターフェース・カード(NIC)27、赤外線通信(IrDA)インターフェースなどを含み、Bluetoothのような近接無線データ通信や、IEEE 802.11bのような無線ネットワーク、あるいはインターネットなどの広域ネットワークを経由して、外部のさまざまなホスト・コンピュータとデータ通信を行うことができる。
【0063】
このような脚式移動ロボットとホスト・コンピュータ間におけるデータ通信により、遠隔の計算機資源を用いて、脚式移動ロボットの複雑な動作制御を演算したり、リモート・コントロールすることができる。
【0064】
C.脚式移動ロボットの起動シーケンス
一般に、自動機械は、電源投入後、所定の自己診断や初期化処理を経て、通常の動作状態を回復することができる。情報機器のように機械運動系を持たない装置、据置き型の多軸自動機械であれば、起動時における装置の姿勢を考慮する必要はなく、装置本体を安定した場所に設置した状態(若しくは基本姿勢)で、オペレータが電源スイッチを投入するだけでよい。
【0065】
これに対し、図1〜図3に示すような直立歩行型の脚式移動ロボットの場合、歩行などの機体運動を考慮した場合における基準となる姿勢は、2足で立ち上がった立ち姿勢である。例えば、立ち姿勢の中では最も安定した状態(すなわち不安定性の極小点)を基本立ち姿勢にすることができる。しかし、このような基本立ち姿勢は、その姿勢を安定に維持するためには、姿勢安定制御の実行、制御指示による脚部などの関節軸モータのトルク生成が必要であり、これらの駆動のための電力消費を伴う。言い換えれば、無電源状態では立ち姿勢は決して安定ではない。
【0066】
そこで、本実施形態では、脚式移動ロボットの基本仰向け姿勢(若しくは基本うつ伏せ姿勢)を定義して、この基本仰向け姿勢でオペレータが電源を投入すると、脚式移動ロボットは、基本仰向け姿勢のまま、ハードウェアの診断やソフトウェアの初期化、機体(各関節アクチュエータ)の原点チェックなどの起動シーケンスを行なった後、所定の起き上がりモーション・シーケンスに従って基本立ち姿勢に自動的に遷移するようにした。一旦基本立ち姿勢を形成すると、これを姿勢遷移の基準にして、歩行やダンスなど、脚部を始め全身の各部の自由度を活用した各種のパフォーマンスを行なうことが可能となる。
【0067】
基本仰向け姿勢、すなわち立ち姿勢でない脱力姿勢からの機体の起動オペレーションが可能となることから、オペレータの作業負担は著しく軽減される。
【0068】
図6には、本実施形態に係る脚式移動ロボットの起動シーケンスをフローチャートの形式で示している。この起動シーケンスは、実際には、制御ユニット20内のCPU21が所定のプログラム・コードを実行するという形態で実現される。
【0069】
機体を基本仰向け姿勢にして、電源スイッチを操作して電源を投入する。これに応答して、制御ユニット20内では、自己診断テストなどを経てオペレーティング・システムが起動する(ステップS1)。図7には、基本仰向け姿勢の脚式移動ロボットを示している。
【0070】
次いで、機体のハードウェア構成(関節アクチュエータの接続関係など)を記述した所定の構成情報ファイルを用いて、脚式移動ロボットの実機ハードウェア構成をチェックする(ステップS2)。
【0071】
次いで、脚式移動ロボットの基本的な行動パターンやその組み合わせからなる複合パターンを記述したモーション・ファイルを、外部記憶装置から(あるいはネットワーク経由で)読み込んで登録する(ステップS3)。
【0072】
次いで、各センサのキャリブレーションを行なった後(ステップS4)、加速度センサ47を用いて世界座標系を確認してから(ステップS5)、各関節アクチュエータの原点チェックを行なう(ステップS6)。原点チェックは、ハードウェア原点探索指令を各関節アクチュエータに発行して、アクチュエータ側ではハードウェア原点の探索を行なうことにより構成される。原点チェック後、関節アクチュエータは、関節サーボのゲインを最低状態(受動的な駆動状態)にして、サーボを付勢する。
【0073】
原点を取得した後、制御システムは、これを基にソフトウェア原点を設定して、サーボ制御を行なうことが可能となる。機体を駆動させるときには、まず、関節サーボ・ゲインを高ゲインに設定する(ステップS7)。
【0074】
そして、所定の起き上がり動作ルーチンに従って機体を駆動して、図7に示すような基本仰向け姿勢からの起き上がりモーションを実行して、図8に示すような基本立ち姿勢に遷移する(ステップS8)。
【0075】
基本立ち姿勢は、立ち状態で最も安定した状態であり、姿勢安定制御のための計算機負荷や消費電力が最小又は極小となるような姿勢である。例えば、図8に示すように膝を伸展させて、直立状態を保つためのモータ・トルクを最小限に抑えている。
【0076】
他方、基本立ち姿勢は、姿勢安定性に優れているがこのまま歩行など脚式作業に移行するためには最適化されていない。そこで、脚式作業を開始する際には、まず、関節サーボ・ゲインを中ゲインに再設定してから(ステップS9)、図9に示すような基本歩行姿勢に遷移する(ステップS10)。後述するように、脚式移動ロボットは基本歩行姿勢を中心にして各種の立ち姿勢パフォーマンスへと効率的に遷移することができる。
【0077】
図8と図9の比較からも判るように、基本立ち姿勢において、股関節、膝関節、並びに足首関節の各ピッチ軸12、14、15を駆動して、機体の重心位置を少し落とす格好にすることによって、基本歩行姿勢に遷移する。基本歩行姿勢では、一方の脚を持ち上げて単脚支持期への遷移を円滑に行なうことができる。但し、膝を屈曲させた分だけ、この姿勢を維持するためのトルクが余分に必要とならことから、基本立ち姿勢に比し消費電力は増大する。
【0078】
C.脚式移動ロボットの原点チェック動作
関節アクチュエータに絶対座標系の測定器を用いた場合には、上記のステップS6における原点チェックを省略することもできる。但し、相対座標系の測定器を用いることにより、アクチュエータ周辺部品を小型・軽量化することができ、その分だけ機体設計が容易になる。
【0079】
本実施形態に係る脚式移動ロボットの原点は、両脚支持での立位、仰向け、そしてうつ伏せの各姿勢状態において、安全かつ安定にハードウェア原点の探索動作を行なえる場所に設定されている。
【0080】
原点チェックは、ハードウェア原点探索指令を各関節アクチュエータに発行して、アクチュエータ側ではハードウェア原点の探索を行なうことにより構成される。ハードウェア原点の探索は、基本姿勢において関節アクチュエータを駆動させて、原点を通過することによって行なわれる。
【0081】
図7に示す基本仰向け姿勢において、原点探索している様子を図10に示している。同図に示すように、各関節アクチュエータを作動させて、探索対象となる関節角を少し屈曲してハードウェア原点を通過することによって原点チェックが行なわれる。
【0082】
また、図11には基本うつ伏せ姿勢のロボットを示し、図12にはこの基本うつ伏せ姿勢において原点探索を行なっている様子を示している。基本仰向け姿勢の場合も、同様に、探索対象となる関節角を少し屈曲してハードウェア原点を通過することによって原点チェックが行なわれる。
【0083】
後述するように、本実施形態に係る脚式移動ロボットは、複数の基本姿勢を基準にして機体動作を行なう。この基本姿勢の近傍にハードウェア原点を配置することにより、ある基本姿勢から他の基本姿勢に遷移する過程を利用して、任意のタイミングで原点チェック動作を実行することができる。このような場合、基本的な実機動作に隠れて原点チェック処理を行なうことができるので、ユーザは意識する必要がない。
【0084】
例えば、基本歩行姿勢(図9を参照のこと)と、歩行を開始するための単脚支持期最前期の間に、脚部の各関節アクチュエータのハードウェア原点を配設しておくことにより、最初の歩行開始時に確実に原点チェックを行なうことができる。また、最初の歩行開始時に原点チェックしてエラーが発生した場合には、歩行動作を中断することにより、歩行後の機体の転倒などの不測の損害を回避することができる。
【0085】
本実施形態に係る脚式移動ロボットでは、脚部を構成する各関節アクチュエータにおいて、以下に示すハードウェア原点の設定を必須としている。
【0086】
【表1】
Figure 0003813102
【0087】
足首ロール軸16や股関節ロール軸13に関しては、歩行時の姿勢安定制御のための最も高い精度が要求される。そこで、基本歩行姿勢から単脚支持最前期の間という歩行予備動作中にこれらロール軸の原点を設定することにより、歩行予備動作中に原点チェックすることができる。また、原点チェックによりエラーを検出できれば歩行動作に遷移する前に機体を停止して安全を確保することができる。勿論、毎歩行予備動作において原点チェックを行なうこともできる。
【0088】
図13及び図14には、脚式移動ロボットの基本歩行姿勢と単脚支持期最前期の間を利用して原点チェックを行なっている様子を示している。
【0089】
歩き出し時には、必ずZMPを軸足(立脚)の足底に移動させなければならない。図13及び図14に示す例では、左足を軸足としており、左右両方の股関節ロール軸13並びに足首ロール軸16が回転して、ZMP(この場合は機体重心と等価)が左足底に移動させている。これらの各ロール軸アクチュエータのハードウェア原点を基本歩行姿勢と単脚支持期最前期の間に配置しておくことにより、歩行開始のための前処理に相当する股関節ロール軸13並びに足首ロール軸16の各関節アクチュエータ駆動を利用してその原点探索を行なうようになっている。
【0090】
なお、図示しないが、右足を軸足として歩行(単脚支持)を開始する場合も、図13に示した場合と同様の関節アクチュエータ動作により歩行開始前の原点チェックを行なうことができる。
【0091】
また、足首ピッチ軸15や膝関節ピッチ軸14、股関節ピッチ軸12などのピッチ軸は、基本立ち姿勢と基本歩行姿勢の間に原点を設定することにより、歩行停止毎に原点確認を行なうことができる。また、原点チェックによりエラーを検出できれば歩行準備に相当する期間に機体を停止して安全を確保することができる。
【0092】
基本立ち姿勢から基本歩行姿勢に遷移する際には、図8と図9の比較からも判るように、基本立ち姿勢において、股関節、膝関節、並びに足首関節の各ピッチ軸12、14、15を駆動して、機体の重心位置を少し落とす格好にすることによって、基本歩行姿勢に遷移する(前述)。これら各ピッチ軸アクチュエータのハードウェア原点を基本立ち姿勢と基本歩行姿勢の間に配置しておくことにより、歩行開始のための前処理に相当する股関節、膝関節、並びに足首関節の各ピッチ軸12、14、15の各関節アクチュエータ駆動を利用してその原点探索を行なうようになっている。
【0093】
また、体幹の関節アクチュエータにおいては、以下に示すようなハードウェア原点の設定を推奨する。
【0094】
【表2】
Figure 0003813102
【0095】
例えば、体幹ロール軸10に関しては、基本歩行姿勢から単脚支持最前期の間という歩行予備動作中にこれらロール軸の原点を設定することにより、歩行予備動作中に原点チェックすることができる。また、体幹ピッチ軸9に関しては、基本立ち姿勢と基本歩行姿勢時の間に原点を設定することにより、歩行停止毎に原点確認を行なうことができる。
【0096】
また、上肢の関節アクチュエータにおいては、以下に示すようなハードウェア原点の設定を推奨する。
【0097】
【表3】
Figure 0003813102
【0098】
腕部に関しては、肩関節ピッチ軸4及びロール軸5のハードウェア原点は、基本立ち姿勢時とソフトウェア原点の間に設定することが好ましい。また、上腕ヨー軸6のハードウェア原点は、基本立ち姿勢時とソフトウェア原点の間にあることが好ましい。また、肘関節ピッチ軸7のハードウェア原点は、基本立ち姿勢時とソフトウェア原点の間にあることが好ましい。また、手首関節ヨー軸8に関しては、ソフトウェア原点とハードウェア原点を一致させてもよい。
【0099】
なお、脚式移動ロボットの基本立ち姿勢は、ソフトウェア原点とは相違する。図15には、脚式移動ロボットが機体のすべての関節アクチュエータがソフトウェア原点に設定された状態で立脚している様子を示している。また、図16には脚式移動ロボットが仰向けになっている状態で関節アクチュエータがソフトウェア原点に設定されている様子を、図17には脚式移動ロボットがうつ伏せになっている状態で関節アクチュエータがソフトウェア原点に設定されている様子を、それぞれ示している。
【0100】
脚式移動ロボットの姿勢制御は、世界座標系に対する機体座標系(若しくは、機体の各部位毎に設定されるローカル座標系)を利用して行なわれる。このような場合、各関節アクチュエータへの駆動制御信号は、基本的には機体座標系に対する運動を指示する指令値となる。ソフトウェア原点は、このような機体制御システムの都合により定められるものであり、必ずしも、姿勢の安定性や、消費エネルギ、次の状態への遷移を考慮したものではない。
【0101】
図15〜図17に示す例では、頭部、胴体部、上肢及び下肢はいずれも、鉛直方向に伸張した状態でソフトウェア原点が設定されている。これは、姿勢の安定性や、消費エネルギ、次の状態への遷移を考慮した基本立ち姿勢(図8を参照のこと)とは明らかに相違する。
【0102】
D.脚式移動ロボットの運動系基本状態遷移
本実施形態に係る脚式移動ロボットの制御システムは、複数の基本姿勢を定義する。各々の基本姿勢は、機体の安定性や、消費エネルギ、次の状態への遷移を考慮して定義されており、基本姿勢間の遷移という形態により機体運動を効率的に制御することができる。
【0103】
図18には、本実施形態に係る脚式移動ロボットの運動系が持つ基本状態繊維を示している。同図に示すように、脚式移動ロボットは、基本仰向け姿勢、基本立ち姿勢、基本歩行姿勢、基本座り姿勢、基本うつ伏せ姿勢がそれぞれ仰向け時、立脚時、歩行準備時、着席時、及びうつ伏せ時における機体の安定性や、消費エネルギ、次の状態への遷移を考慮して定義されている。
【0104】
これら基本姿勢は、機体の動作制御プログラムのプラットフォームに位置付けられ、ROM23やEEPROM24などの不揮発性記憶領域にマッピングされる。また、脚式移動ロボットは、立ち姿勢などにおいて、歩行や跳躍、ダンスなど全身動作を利用した各種のパフォーマンスを行なうが、その装置制御プログラムは、プラットフォーム上で動作するアプリケーションとして位置付けられる。これらアプリケーション・プログラムは、外部記憶からRAM22上に随時ロードされ、CPU21によって実行される。
【0105】
基本仰向け姿勢は、図7に示した通りである。既に述べたように、機体への電源投入時に基本仰向け姿勢をとり、転倒などの心配がなく機械運動的に最も安定した状態からの起動を行うことができる。
【0106】
また、脚式移動ロボットは、起動時(図6を参照のこと)だけでなくシステム動作の終了時も基本仰向け姿勢に復帰するようになっている。したがって、機械運動学的に機体が最も安定した状態で作業を開始するとともに、最も安定した状態で作業を終了することから、脚式移動ロボットの動作オペレーションは自己完結的となる。
【0107】
勿論、機体の転倒時においても、床上での所定のモーションを経て一旦基本仰向け姿勢に戻った後に、規定の立ち上がり動作を実行することにより、基本立ち姿勢を介して、作業中断時の元の姿勢を回復することができる。
【0108】
また、本実施形態に係る脚式移動ロボットは、床上での基本姿勢として、基本仰向け姿勢の他に、図11に示したような基本うつ伏せ姿勢を備えている。この基本うつ伏せ姿勢は、基本仰向け姿勢と同様に、機械運動学的に機体が最も安定した状態であり、電源が遮断された脱力状態においても姿勢安定性を維持することができる。例えば、脚式作業において不測の外力などにより期待が転倒した場合、仰向け又はうつ伏せのいずれの状態で落下するか不明なので、本実施形態では、このように2通りの床上基本姿勢を規定している。
【0109】
基本うつ伏せ姿勢の状態で各関節アクチュエータを少しだけ駆動させることにより、探索対象となる関節角を少し屈曲してハードウェア原点を通過することによって原点チェックが行なわれる(図12を参照のこと)。
【0110】
基本仰向け姿勢と基本うつ伏せ姿勢の間は、各種の床上姿勢を経て可逆的に遷移することができる。逆に言えば、これら基本仰向け姿勢と基本うつ伏せ姿勢を基準にして各種の床上姿勢へ円滑に状態遷移することができる。
【0111】
基本仰向け姿勢は、機械運動学的には最も安定した基本姿勢であるが、脚式作業を考慮した場合、円滑な状態遷移を行うことはできない。そこで、図8に示すような基本立ち姿勢が定義されている。基本立ち姿勢を定義することで、その後の脚式作業へ滞りなく移行することができる。
【0112】
基本立ち姿勢は、立ち状態で最も安定した状態であり、姿勢安定制御のための計算機負荷や消費電力が最小又は極小となるような姿勢であり、膝を伸展させることにより直立状態を保つためのモータ・トルクを最小限に抑えている。この基本立ち姿勢から各種の立ち姿勢へ円滑に状態遷移して、たとえば上肢を利用したダンス・パフォーマンスなどを実演することができる。
【0113】
他方、基本立ち姿勢は、姿勢安定性に優れているがこのまま歩行など脚式作業に移行するためには最適化されていない。そこで、本実施形態に係る脚式移動ロボットは、立脚状態の他の基本姿勢として、図9に示すような基本歩行姿勢を定義している。
【0114】
基本立ち姿勢において、股関節、膝関節、並びに足首関節の各ピッチ軸12、14、15を駆動して、機体の重心位置を少し落とす格好にすることによって、基本歩行姿勢に遷移する。基本歩行姿勢では、通常の歩行動作を始めとして各種の脚式動作への遷移を円滑に行なうことができる。但し、膝を屈曲させた分だけ、この姿勢を維持するためのトルクが余分に必要とならことから、基本歩行姿勢は、基本立ち姿勢に比し消費電力は増大する。
【0115】
基本立ち姿勢は、機体のZMP位置はZMP安定領域の中心付近にあり、膝の曲げ角が小さくエネルギ消費量が低い姿勢である。これに対し、基本歩行姿勢では、ZMP位置が安定領域の中心付近にあるが、高い路面適応性、高い外力適応性を確保するために膝の曲げ角を比較的大きくとっている。
【0116】
また、本実施形態に係る脚式移動ロボットでは、さらに基本座り姿勢が定義されている。この基本座り姿勢(図示しない)では、所定の椅子に腰掛けたときに、姿勢安定制御のための計算機負荷や消費電力が最小又は極小となるような姿勢である。前述した、基本仰向け姿勢、基本うつ伏せ姿勢、並びに基本立ち姿勢からは、可逆的に基本姿勢へ遷移することができる。また、基本座り姿勢並びに基本立ち姿勢からは、各種の座り姿勢へと円滑に移行することができ、座り姿勢で例えば状態のみを用いた各種のパフォーマンスを実演することができる。
【0117】
E.その他の状態
本実施形態に係る脚式移動ロボットは、前項で説明したような基本姿勢以外にも、安全な機体動作を保証するために幾つかの主要な状態が定義されているので、ここで説明しておく。
【0118】
抱き上げ時の脱力状態は、オペレータがロボットを抱き上げたときに、関節アクチュエータが脱力して受動駆動を行う状態を指す。アクチュエータに低減速器が直結されていることに加えて、抱き上げを検出したことに応答して各関節アクチュエータに最低ゲインを設定したり、出力トルクを最小値に設定することにより、脱力状態を実現することができる。
【0119】
脚式移動ロボットが抱き上げられたかどうかは、脚部に設置されている床反力センサの出力がゼロになったこととの加速度センサがZ軸上方向の加速度を検出したことによって判断することができる。
【0120】
また、突発的転倒や、機体の落下時においても、このような脱力状態に遷移することにより、床面への着床時に印加される衝撃力が関節軸やアクチュエータ出力軸に伝播しなくなるようにして、機体へのダメージを最小限に抑えることができる。
【0121】
また、機体の暴走時やその他の不測の事態に遭遇したときに備えて、脚式移動ロボットは緊急停止機能を備えている。例えば機体に配設されている緊急停止ボタン(図示しない)を操作することにより、サーボ・ゲインを低下させた安全停止状態に陥る。
【0122】
また、図2に示したように、脚式移動ロボットの胴体後方の略上端縁には、オペレータが機体を把持するためのハンドルが設けられている。このハンドルには、オペレータが把持したことを検知することができるタッチ・センサが配設されている。そして、ハンドルの握りを検出するとシステムに対し脱力指示を発行して、上述した脱力状態に遷移させる。したがって、オペレータは、機体動作を緊急停止したいときに簡易な操作方法としてハンドルを握って脚式移動ロボットを持ち上げればよい。
【0123】
この脱力状態から機体動作を復帰させるためには、脚式移動ロボットを基本仰向け姿勢に配置すればよい。脚式移動ロボットは、所定の起き上がり動作を実行することにより、基本立ち姿勢を経て所望の脚式作業を回復することができる。
【0124】
[追補]
以上、特定の実施例を参照しながら、本発明について詳解してきた。しかしながら、本発明の要旨を逸脱しない範囲で当業者が該実施例の修正や代用を成し得ることは自明である。
【0125】
本発明の要旨は、必ずしも「ロボット」と称される製品には限定されない。すなわち、電気的若しくは磁気的な作用を用いて人間の動作に似せた運動を行う機械装置であるならば、例えば玩具等のような他の産業分野に属する製品であっても、同様に本発明を適用することができる。
【0126】
要するに、例示という形態で本発明を開示してきたのであり、本明細書の記載内容を限定的に解釈するべきではない。本発明の要旨を判断するためには、冒頭に記載した特許請求の範囲の欄を参酌すべきである。
【0127】
【発明の効果】
以上詳記したように、本発明によれば、エンターテインメント型のロボットのように、定型的な作業に限らず多種多様な機体動作を好適に行なうことができる、優れた脚式ロボットの姿勢制御装置及び姿勢制御方法を提供することができる。
【0128】
また、本発明によれば、複数の基本姿勢をベースにして機体動作を効率的に制御することができる、優れた脚式ロボットの姿勢制御装置及び姿勢制御方法を提供することができる。
【0129】
また、本発明によれば、機体の安定性や、消費エネルギ、次の状態への遷移を考慮して基本姿勢を設定して機体運動を好適に制御することができる、優れた脚式ロボットの姿勢制御装置及び姿勢制御方法を提供することができる。
【図面の簡単な説明】
【図1】本発明の実施に供される脚式移動ロボットが直立している様子を前方から眺望した様子を示した図である。
【図2】本発明の実施に供される脚式移動ロボットが直立している様子を後方から眺望した様子を示した図である。
【図3】脚式移動ロボットが具備する関節自由度構成を模式的に示した図である。
【図4】本発明に実施に供される脚式移動ロボットの制御システム構成を模式的に示した図である。
【図5】制御ユニット20の構成をさらに詳細に示した図である。
【図6】本実施形態に係る脚式移動ロボットの起動シーケンスをフローチャートである。
【図7】基本仰向け姿勢の脚式移動ロボットの様子を示した図である。
【図8】基本立ち姿勢の脚式移動ロボットの様子を示した図である。
【図9】基本歩行姿勢の脚式移動ロボットの様子を示した図である。
【図10】基本仰向け姿勢において原点探索をしている様子を示した図である。
【図11】基本うつ伏せ姿勢の脚式移動ロボットの様子を示した図である。
【図12】基本うつ伏せ姿勢において原点探索をしている様子を示した図である。
【図13】脚式移動ロボットの基本歩行姿勢と単脚支持期最前期の間を利用して原点チェックを行なっている様子を機体正面から示した図である。
【図14】脚式移動ロボットの基本歩行姿勢と単脚支持期最前期の間を利用して原点チェックを行なっている様子を機体右斜め前方から示した図である。
【図15】脚式移動ロボットが機体のすべての関節アクチュエータがソフトウェア原点に設定された状態で立脚している様子を示した図である。
【図16】脚式移動ロボットが仰向けになっている状態で関節アクチュエータがソフトウェア原点に設定されている様子を示した図である。
【図17】脚式移動ロボットがうつ伏せになっている状態で関節アクチュエータがソフトウェア原点に設定されている様子を示した図である。
【図18】本実施形態に係る脚式移動ロボットの運動系が持つ基本状態遷移を示した図である。
【符号の説明】
1…首関節ヨー軸
2A…第1の首関節ピッチ軸
2B…第2の首関節(頭)ピッチ軸
3…首関節ロール軸
4…肩関節ピッチ軸
5…肩関節ロール軸
6…上腕ヨー軸
7…肘関節ピッチ軸
8…手首関節ヨー軸
9…体幹ピッチ軸
10…体幹ロール軸
11…股関節ヨー軸
12…股関節ピッチ軸
13…膝関節ロール軸
14…膝関節ピッチ軸
15…足首関節ピッチ軸
16…足首関節ロール軸
20…制御ユニット
40…入出力部
41…カメラ,42…マイクロフォン
43…スピーカ,44…LEDインジケータ
45…タッチ・センサ,46…接地センサ
47…加速度センサ
50…駆動部
51…モータ,52…エンコーダ
53…ドライバ
60…電源部
61…充電バッテリ,62…充放電制御部

Claims (12)

  1. 少なくとも足首ロール軸と股関節ロール軸と体幹ロール軸を含む複数の関節自由度を備える脚式ロボットの姿勢制御装置であって、
    前記脚式ロボットは、機体の立脚時においてZMPをZMP安定領域の中心付近に配置した基本姿勢として、膝を比較的屈曲させて路面適応性並びに外力適応性を高めた基本歩行姿勢を備え、
    足首ロール軸、股関節ロール軸、又は体幹ロール軸のうち少なくとも1つの関節角度の原点を前記基本歩行姿勢から単脚支持最前期の間に設定する原点設定手段と、
    前記基本歩行姿勢から関節が変位して単脚支持最前期に向かうまでの間に、前記原点設定手段により原点が設定された関節軸の関節角度が原点を通過するときに原点チェックを行なう機体診断手段と、
    を具備することを特徴とする脚式ロボットの姿勢制御装置。
  2. 前記脚式ロボットの胴体はさらに体幹ピッチ軸の関節自由度を備えるとともに、機体の立脚時においてZMPをZMP安定領域の中心付近に配置した基本姿勢として膝を伸展させてエネルギ消費量を抑制した基本立ち姿勢をさらに備え、
    前記原点設定手段は、前記体幹ロール軸の原点を前記基本歩行姿勢から単脚支持期最前期の間に設定するとともに、前記体幹ピッチ軸の原点を前記基本立ち姿勢と前記基本歩行姿勢の間に設定し、
    前記機体診断手段は、基本歩行姿勢から単脚支持最前期の間という歩行予備動作期間中に前記体幹ロール軸の原点チェックを行なうとともに、歩行停止毎に前記体幹ピッチ軸の原点チェックを行なう、
    ことを特徴とする請求項1に記載の脚式ロボットの姿勢制御装置
  3. 少なくとも足首ピッチ軸と膝ピッチ軸と股関節ピッチ軸と体幹ピッチ軸を含む複数の関節自由度を備える脚式ロボットの姿勢制御装置であって、
    前記脚式ロボットは、機体の立脚時においてZMPをZMP安定領域の中心付近に配置した基本姿勢として、膝を伸展させてエネルギ消費量を抑制した基本立ち姿勢と、膝を比較的屈曲させて路面適応性並びに外力適応性を高めた基本歩行姿勢を備え、
    足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸、又は体幹ピッチ軸のうち少なくとも1つの関節角度の原点を前記基本立ち姿勢と前記基本歩行姿勢の間に設定する原点設定手段と、
    前記基本立ち姿勢から前記基本歩行姿勢に向かうまでの間に、前記原点設定手段により原点が設定された関節軸の関節角度が原点を通過するときに原点チェックを行なう機体診断手段と、
    を具備することを特徴とする脚式ロボットの姿勢制御装置。
  4. 前記脚式ロボットは脚部において、足首ロール軸及び股関節ロール軸の関節自由度をさらに備え、
    前記原点設定手段は、前記足首ロール軸及び股関節ロール軸の原点を前記基本歩行姿勢から単脚支持期最前期の間に設定するとともに、前記足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸の原点を前記基本立ち姿勢と前記基本歩行姿勢の間に設定し、
    前記機体診断手段は、基本歩行姿勢から単脚支持最前期の間という歩行予備動作期間中に前記足首ロール軸及び股関節ロール軸の原点チェックを行なうとともに、歩行停止毎に前記足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸の原点チェックを行なう、
    ことを特徴とする請求項3に記載の脚式ロボットの姿勢制御装置。
  5. 前記機体診断手段は、機体が床上姿勢のときに、原点のチェック対象となる関節角を、前記原点設定手段により設定された原点を探索する方向に駆動させて、関節角が原点を通 過することによって原点チェックを行なう、
    ことを特徴とする請求項1又は3のいずれかに記載の脚式ロボットの姿勢制御装置。
  6. 前記機体診断手段が原点チェックにより関節軸の原点を確認できないというエラーが発生したことに応答して機体を停止する手段をさらに備える、
    ことを特徴とする請求項1又は3のいずれかに記載の脚式ロボットの姿勢制御装置。
  7. 少なくとも足首ロール軸と股関節ロール軸と体幹ロール軸を含む複数の関節自由度を備える脚式ロボットの姿勢制御方法であって、
    前記脚式ロボットは、機体の立脚時においてZMPをZMP安定領域の中心付近に配置した基本姿勢として、膝を比較的屈曲させて路面適応性並びに外力適応性を高めた基本歩行姿勢を備え、
    足首ロール軸、股関節ロール軸、又は体幹ロール軸のうち少なくとも1つの関節角度の原点を前記基本歩行姿勢から単脚支持最前期の間に設定する原点設定ステップと、
    前記基本歩行姿勢から関節が変位して単脚支持最前期に向かうまでの間に、前記原点設定ステップにおいて原点が設定された関節軸の関節角度が原点を通過するときに原点チェックを行なう機体診断ステップと、
    を具備することを特徴とする脚式ロボットの姿勢制御方法。
  8. 前記脚式ロボットの胴体はさらに体幹ピッチ軸の関節自由度を備えるとともに、機体の立脚時においてZMPをZMP安定領域の中心付近に配置した基本姿勢として膝を伸展させてエネルギ消費量を抑制した基本立ち姿勢をさらに備え、
    前記原点設定ステップでは、前記体幹ロール軸の原点を前記基本歩行姿勢から単脚支持期最前期の間に設定するとともに、前記体幹ピッチ軸の原点を前記基本立ち姿勢と前記基本歩行姿勢の間に設定し、
    前記機体診断ステップでは、基本歩行姿勢から単脚支持最前期の間という歩行予備動作期間中に前記体幹ロール軸の原点チェックを行なうとともに、歩行停止毎に前記体幹ピッチ軸の原点チェックを行なう、
    ことを特徴とする請求項7に記載の脚式ロボットの姿勢制御方法。
  9. 少なくとも足首ピッチ軸と膝ピッチ軸と股関節ピッチ軸と体幹ピッチ軸を含む複数の関節自由度を備える脚式ロボットの姿勢制御方法であって、
    前記脚式ロボットは、機体の立脚時においてZMPをZMP安定領域の中心付近に配置した基本姿勢として、膝を伸展させてエネルギ消費量を抑制した基本立ち姿勢と、膝を比較的屈曲させて路面適応性並びに外力適応性を高めた基本歩行姿勢を備え、
    足首ロール軸、足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸、又は体幹ピッチ軸のうち少なくとも1つの関節角度の原点を前記基本立ち姿勢と前記基本歩行姿勢の間に設定する原点設定ステップと、
    前記基本立ち姿勢から前記基本歩行姿勢に向かうまでの間に、前記原点設定ステップにおいて原点が設定された関節軸の関節角度が原点を通過するときに原点チェックを行なう機体診断手段と、
    を具備することを特徴とする脚式ロボットの姿勢制御方法。
  10. 前記脚式ロボットは脚部において、足首ロール軸及び股関節ロール軸の関節自由度をさらに備え、
    前記原点設定ステップでは、前記足首ロール軸及び股関節ロール軸の原点を前記基本歩行姿勢から単脚支持期最前期の間に設定するとともに、前記足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸の原点を前記基本立ち姿勢と前記基本歩行姿勢の間に設定し、
    前記機体診断ステップでは、基本歩行姿勢から単脚支持最前期の間という歩行予備動作期間中に前記足首ロール軸及び股関節ロール軸の原点チェックを行なうとともに、歩行停 止毎に前記足首ピッチ軸、膝ピッチ軸、股関節ピッチ軸の原点チェックを行なう、
    ことを特徴とする請求項9に記載の脚式ロボットの姿勢制御方法。
  11. 前記機体診断ステップでは、機体が床上姿勢のときに、原点のチェック対象となる関節角を、前記原点設定ステップにおいて設定された原点を探索する方向に駆動させて、関節角が原点を通過することによって原点チェックを行なう、
    ことを特徴とする請求項7又は9のいずれかに記載の脚式ロボットの姿勢制御方法。
  12. 前記機体診断ステップにおいて原点チェックにより関節軸の原点を確認できないというエラーが発生したことに応答して機体を停止するステップをさらに備えることを特徴とする請求項7又は9のいずれかに記載の脚式ロボットの姿勢制御方法。
JP2002073389A 2002-03-15 2002-03-15 脚式ロボットの姿勢制御装置及び姿勢制御方法 Expired - Lifetime JP3813102B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2002073389A JP3813102B2 (ja) 2002-03-15 2002-03-15 脚式ロボットの姿勢制御装置及び姿勢制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2002073389A JP3813102B2 (ja) 2002-03-15 2002-03-15 脚式ロボットの姿勢制御装置及び姿勢制御方法

Publications (2)

Publication Number Publication Date
JP2003266338A JP2003266338A (ja) 2003-09-24
JP3813102B2 true JP3813102B2 (ja) 2006-08-23

Family

ID=29203066

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2002073389A Expired - Lifetime JP3813102B2 (ja) 2002-03-15 2002-03-15 脚式ロボットの姿勢制御装置及び姿勢制御方法

Country Status (1)

Country Link
JP (1) JP3813102B2 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9862095B2 (en) 2014-09-24 2018-01-09 Honda Motor Co., Ltd. Control device for mobile robot

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4996042B2 (ja) * 2004-05-28 2012-08-08 ソニー株式会社 ロボット装置及びその制御方法、並びにロボット装置の基本姿勢設定方法
CN102339060A (zh) * 2011-05-24 2012-02-01 北京工业大学 一种桌面型两轮机器人的舞步运动规划方法
JP2019198900A (ja) * 2018-05-14 2019-11-21 株式会社日立製作所 姿勢制御装置

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0778682B2 (ja) * 1985-08-07 1995-08-23 株式会社日立製作所 ロボツトの制御方式
JP3687076B2 (ja) * 1995-07-14 2005-08-24 ソニー株式会社 ロボット装置およびその制御方法
JP3776345B2 (ja) * 2001-10-04 2006-05-17 本田技研工業株式会社 自動原点合わせ方法及び自動原点確認方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9862095B2 (en) 2014-09-24 2018-01-09 Honda Motor Co., Ltd. Control device for mobile robot

Also Published As

Publication number Publication date
JP2003266338A (ja) 2003-09-24

Similar Documents

Publication Publication Date Title
JP3555107B2 (ja) 脚式移動ロボット及び脚式移動ロボットの動作制御方法
JP4127043B2 (ja) 脚式移動ロボット並びに脚式移動ロボットの関節軸として適用されるアクチュエータ装置
JP3615702B2 (ja) 脚式移動ロボットの動作制御装置及び動作制御方法、並びに、脚式移動ロボット
WO2003078109A1 (fr) Dispositif de commande operationnelle pour robot mobile du type a jambes, procede de commande operationnelle, et robot
JP2001277163A (ja) ロボットの制御装置及び制御方法
JP2001150374A (ja) ロボットの故障診断システム
WO2003078110A1 (fr) Robot, controleur de robot a jambes et procede correspondant, systeme de capteurs pour robot a jambes, et appareil locomoteur
JPWO2003011535A1 (ja) 脚式移動ロボット及びその動作制御方法
JP2002144260A (ja) 脚式移動ロボット及びその制御方法
JP2001138271A (ja) 脚式移動ロボット及び脚式移動ロボットの転倒時動作制御方法
JP4232376B2 (ja) 脚式移動ロボット
JP3813102B2 (ja) 脚式ロボットの姿勢制御装置及び姿勢制御方法
JP4289446B2 (ja) 脚式移動ロボット
JP2004001101A (ja) ロボット装置に用いられる手部装置及びロボット装置
JP4600551B2 (ja) 移動ロボット
JP2001138273A (ja) 脚式移動ロボット及びその制御方法
JP4770990B2 (ja) 脚式移動ロボット及びその制御方法
JP4110525B2 (ja) ロボット装置及びその動作制御方法
JP2001157972A (ja) 脚式移動ロボット
JP4981074B2 (ja) 脚式移動ロボット
JP3555946B2 (ja) 移動ロボット装置及び移動ロボット装置の制御方法
JP2002144261A (ja) 脚式移動ロボット及びその制御方法
JP3555947B2 (ja) 移動ロボット装置、移動ロボット装置の制御方法、移動ロボット装置の運動パターン生成方法、並びに移動ロボット装置の運動制御プログラム
JP2008296368A (ja) 脚式移動ロボット
JP4506249B2 (ja) ロボット装置及びその動作比較方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040908

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050128

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20050328

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050926

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20051117

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20060530

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 3813102

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20090609

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20100609

Year of fee payment: 4

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

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

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20120609

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

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20130609

Year of fee payment: 7

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

EXPY Cancellation because of completion of term