JP2005088175A - ロボット装置及びロボット装置の動作制御方法 - Google Patents
ロボット装置及びロボット装置の動作制御方法 Download PDFInfo
- Publication number
- JP2005088175A JP2005088175A JP2003329130A JP2003329130A JP2005088175A JP 2005088175 A JP2005088175 A JP 2005088175A JP 2003329130 A JP2003329130 A JP 2003329130A JP 2003329130 A JP2003329130 A JP 2003329130A JP 2005088175 A JP2005088175 A JP 2005088175A
- Authority
- JP
- Japan
- Prior art keywords
- control
- robot apparatus
- moving
- distribution
- attention point
- 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.)
- Withdrawn
Links
Images
Landscapes
- Toys (AREA)
- Manipulator (AREA)
Abstract
【課題】 静止物又は動体としての対象物に対して高精度に接近又は接触することができるロボット装置及びロボット装置の動作制御方法を提供する。
【解決手段】 ロボット装置1は、制御の対象となる手先(制御注目点)114aを対象物10の表面に接触させる動作をする。ロボット装置1は、(2A):歩行によるアプローチ、(2B):下半身動作によるアプローチ、(2C):腕等の上半身動作によるアプローチ等の複数の動作を有し、(2A)>(2B)>(2C)の順に、手先114aを移動させることが可能な可動範囲は狭いが制御精度が高いものとなっており、これらの各動作により得られる制御注目点の可動範囲分布(L(x),H(x))と、対象物10との距離から得られる対象物10の存在確率分布O(x)とに基づき上半身の可動範囲Lのなかで制御注目点を最も移動させやすい位置にて対象物に接触できるように各動作を切り替える。
【選択図】 図5
【解決手段】 ロボット装置1は、制御の対象となる手先(制御注目点)114aを対象物10の表面に接触させる動作をする。ロボット装置1は、(2A):歩行によるアプローチ、(2B):下半身動作によるアプローチ、(2C):腕等の上半身動作によるアプローチ等の複数の動作を有し、(2A)>(2B)>(2C)の順に、手先114aを移動させることが可能な可動範囲は狭いが制御精度が高いものとなっており、これらの各動作により得られる制御注目点の可動範囲分布(L(x),H(x))と、対象物10との距離から得られる対象物10の存在確率分布O(x)とに基づき上半身の可動範囲Lのなかで制御注目点を最も移動させやすい位置にて対象物に接触できるように各動作を切り替える。
【選択図】 図5
Description
本発明は、自律的に動作するロボット装置及びロボット装置の動作制御方法に関し、静止物体又は動体に対してのアプローチ動作を効率的に制御するロボット装置及びロボット装置の動作制御方法に関する。
電気的又は磁気的な作用を用いて人間(生物)の動作に似た運動を行う機械装置を「ロボット」という。我が国においてロボットが普及し始めたのは、1960年代末からであるが、その多くは、工場における生産作業の自動化・無人化等を目的としたマニピュレータ及び搬送ロボット等の産業用ロボット(Industrial Robot)であった。
最近では、人間のパートナーとして生活を支援する、即ち住環境その他の日常生活上の様々な場面における人的活動を支援する実用ロボットの開発が進められている。このような実用ロボットは、産業用ロボットとは異なり、人間の生活環境の様々な局面において、個々に個性の相違した人間、又は様々な環境への適応方法を自ら学習する能力を備えている。例えば、犬又は猫のように4足歩行の動物の身体メカニズム及びその動作を模した「ペット型」ロボット、或いは、2足直立歩行を行う人間等の身体メカニズム及びその動作をモデルにしてデザインされた「人間型」又は「人間形」ロボット(Humanoid Robot)等のロボット装置は、既に実用化されつつある。
これらのロボット装置は、産業用ロボットと比較して、例えばエンターテインメント性を重視した様々な動作等を行うことができるため、エンターテインメントロボットと呼称される場合もある。また、そのようなロボット装置には、カメラ等の撮像手段や、各種センサ等を搭載して外部からの情報を取得し、これらの外部情報(外部刺激)と、自己の内部の状態に応じて自律的に行動することができる。
このような自律に移動可能なロボット装置において、このカメラにより撮像した画像内に認識された対象物に対して、その対象物に接触するため等に接近する際、又はカメラにより飛来する対象物を認識してこれに接触する際、対象物の位置計測又は接触位置の予測を行って、その位置にロボット装置上の接触点を制御する。
従来、人間と共存するロボット装置を目指し、人間と共存する基本機能を有するロボット装置として、人間とビーチバレーボールを打ち合ったり、ビーチボールを拾ったりするビーチボールロボットの技術が開示されている(下記非特許文献1〜5参照)。このビーチボールロボットは、対象物であるボールとの相対的な位置関係を利用してボールに近づいたり、飛んでくるボールの位置計測データ列から逐次最小二乗法を用いてボールの打ち返し位置や時刻を推定してボールを打ち返したりするものである。
ここで、上記ビーチボールロボットがビーチボールを打ち合う際には、ビーチボールの飛行時間は1秒と短く、ロボット自身も高速に移動しながらボールを相手に打ち返すために、カメラが搭載される雲台部、打点予測部、コート内を移動させる移動機構(Gアーム)及びその根元の関節を使用して振り子のように動かしボールを打ち返すための左腕アーム(Aアーム)からなる4つのシステムの各々の動作を制御してボールを打ち合う動作を実現する。GアームとAアームは始め初期位置・姿勢で待機し、人間のボール打ち返しを検出すると、Gアームは毎回算出される推定打点・打刻に到達するための起動を生成し、移動動作を行う。一方、Aアームは打刻の0.2秒前からボールヒット動作を開始し、打ち返した後にGアームともに初期位置・姿勢に戻る。
辰野恭市,「人とビーチバレーボールを打ち合うロボット」,日本ロボット学会誌,2000年7月,第18巻,第5号,p.105−111
尾崎文雄ら,「ビーチボールロボット−ビジュアルフィードバックによるビーチボール拾い−」,第15回日本ロボット学会技術講演会(平成9年9月12日,13日,14日)予稿集,p.131−132
吉見卓ら,「ビーチボールロボットの打点位置・打刻予測システム」,第15回日本ロボット学会技術講演会(平成9年9月12日,13日,14日)予稿集,p.375−376
小川秀樹ら,「ビーチボールロボットの「ボール打ち合い」動作制御システム」,第15回日本ロボット学会技術講演会(平成9年9月12日,13日,14日)予稿集,p.377−378
辰野恭市ら,「ビーチボールロボットの概要」,第15回日本ロボット学会技術講演会(平成9年9月12日,13日,14日)予稿集,p.765−766
しかしながら、上述のビーチバレーロボットは、予測打刻の0.2ms前からボールヒット動作を行うAアームを動作させ、予測打刻の0.2ms前までは移動動作はGアームのみで行うものであり、ボールに接近するにつれて移動目標の計測・予測制度が変化した場合に、移動目標への収束を最適に行うことができず、対象物に対して正確なアプローチをすることが困難な場合が生じる。
一方で、ボールを拾ったり、飛んでくるボールを打ち返しりする際、制御よくボールに接触しようとして最も制御精度の高い部分のみをその動作に用いると、ロボット装置の可動範囲が非常に限られたものになるため、接触できる対象物が空間的に限られてしまう。
特に、2足又は4足の脚式移動型等のロボット装置に対し、このような対象物へのアプローチ機能を持たせる場合、制御精度の高低に関わらず移動目標にロボット装置の接触部位(接触点)を近づけようとすると、接触点を移動目標に最適に収束させることが困難になる。
本発明は、このような従来の実情に鑑みて提案されたものであり、静止物又は動体としての対象物に対して高精度に接近又は接触することができるロボット装置及びロボット装置の動作制御方法を提供することを目的とする。
上述した目的を達成するために、本発明に係るロボット装置は、自律的に動作可能なロボット装置において、制御の対象となる制御注目点を、移動目標に移動させる制御動作を生成する動作生成手段と、上記制御動作の生成を制御する動作制御手段とを有し、上記動作生成手段は、上記制御注目点を上記移動目標に移動させるための制御精度が異なる制御動作を複数生成可能であって、上記動作制御手段は、上記移動目標の不確定性に基づき、第1の制御動作から第2の制御動作に切り替え制御することを特徴とする。
本発明においては、ロボット装置が例えば腕部や脚部の一部を制御注目点とし、これを静止物体が置かれている位置や動体が飛んでくるような位置を予測した移動目標に移動させるための複数の制御動作を用意しておき、移動目標の不確定性に応じて所定の制御精度の制御動作を選択して生成させることができる。
この場合、上記第2の制御動作は、上記第1の制御動作より制御精度が高く、上記第1の制御動作は装置全体を動かす動作であり、上記第2の制御動作は装置の一部分を動かす動作であるか、上記第2の制御動作は、上記第1の制御動作より上記制御注目点に近い部位を動かす動作であるか、又は、上記第1の制御動作は、上記第2の制御動作より上記制御注目点を移動させることが可能な範囲を示す可動範囲が広い及び/又は上記制御注目点を移動させる動作速度が速い動作とすることができ、これらの制御精度が異なる等する複数の制御動作を移動目標の存在確率に応じて、適切に切り替え制御することができる。
また、上記複数の制御動作は、対象物に上記制御注目点を接近又は接触させるための動作であり、上記動作制御手段は、上記対象物の位置を推定し、該推定した位置に該対象物が存在するとされる存在確率の分布に基づき、上記複数の制御動作を切り替え制御することができ、例えば、上記対象物までの距離が小さいほど、上記制御注目点に近い部位を動かす制御動作を生成させたり、脚式移動型である場合には、上記対象物までの距離が大きいほど、脚部に近い部位を動かす制御動作を生成させたりすることができ、対象物までの距離が遠く、存在確率分布が高域であるような場合には、可動範囲が広くしたがって制御精度が低いような制御動作により大まかな制御を行い、対象物の距離が近くなり存在確率分布が小さくなってきたタイミングで制御精度が高い制御動作に切り替え制御することができ、対象物との接触可能な接触点範囲を広くすることができる。
更に、上記複数の制御動作は、対象物に上記制御注目点を接近又は接触させるための動作であり、上記動作制御手段は、上記対象物の位置を推定し、該推定した位置に該対象物が存在するとされる存在確率の分布と上記制御注目点を移動させることが可能な範囲の冗長性を示す可動範囲の分布とに基づき上記制御動作を切り替え制御することができ、例えば上記対象物が静止物体である場合、上記動作制御手段は、上記動作制御手段は、上記第1の制御動作の動作中に、上記存在確率の分布と上記制御注目点を移動させる際の容易性に基づき得られる可動範囲の分布との内積が所定の閾値以上又は最大になった場合に、該第1の制御動作より制御精度が高い第2の制御動作を生成させることができ、存在確率分布と可動範囲分布とから動作切り替えの最適なタイミングを得ることができ、可動範囲分布の最も移動容易性、例えば冗長性が高い位置を目標位置とすることができる。
更にまた、上記動作制御手段は、上記第2の制御動作の動作中に、上記存在確率の分布が変化した場合、再び上記第1の制御動作を生成させることができ、例えば制御精度を上げた制御動作に切り替えた等した際、誤差範囲が予測以上であった場合には、再び大まかな制御動作に戻って制御をやり直してもよい。
また、上記対象物は、動体である場合には、上記動作制御手段は、所定の時刻における上記動体の位置を推定し、該推定した位置に該動体が存在するとされる存在確率の分布に基づき、上記制御動作を切り替える、例えば、上記距離計測結果から予測された上記動体の予測軌道に基づき上記存在確率の分布を決定することができ、予測軌道を予測することで、より正確な存在確率を得ることができる。
更に、上記動作制御手段は、上記制御注目点を移動させる際の容易性に基づき得られる可動範囲の分布と、この可動範囲の分布の略重心を含む曲面における上記存在確率の分布とに基づき上記制御動作を切り替え制御することができ、打面上で最も冗長性が高い位置を動体を打ち返したり、つかんだりするための目標位置とすることができる。
本発明に係るロボット装置の制御方法は、自律的に動作可能なロボット装置の動作制御方法において、制御の対象となる制御注目点を、移動目標に移動させる制御動作を生成する動作生成工程と、上記制御動作の生成を制御する動作制御工程とを有し、上記動作生成工程では、上記制御注目点を上記移動目標に移動させるための制御精度が異なる制御動作を複数生成可能であって、上記動作制御工程では、上記移動目標の不確定性に基づき、第1の制御動作から第2の制御動作に切り替え制御することを特徴とする。
本発明によれば、自律的に動作可能なロボット装置及びその動作制御方法において、制御の対象となる制御注目点を移動目標に移動させる制御動作を生成し、上記制御動作の生成を制御する。この上記制御動作として、上記制御注目点を上記移動目標に移動させるための異なる制御精度の複数の制御動作を生成可能であって、上記移動目標の存在確率に基づき、複数の制御動作を切り替え制御するので、移動目標位置までの計測結果及びその予測誤差に応じた制御動作を順次選択することができ、従来手法よりも、制御注目点を移動させることができる可動範囲内でその移動容易性が高い領域を移動目標に移動することができ、制御注目点を正確且つ容易に移動目標に移動させることができる。したがって、制御注目点をスムーズに移動目標に収束させることができ、例えば広い範囲の対象物に対して、素早く接触することができるようになり、外界の対象物に対して、幅広いインタラクションを期待することができるので、高いエンターテインメント性を有するロボット装置を提供することができる。
以下、本発明を適用した具体的な実施の形態について、図面を参照しながら詳細に説明する。この実施の形態は、対象物に、装置の一部分等を接触させるような、アプローチ動作を行うロボット装置に適用したものである。本実施の形態においては、2足歩行を行う人間型のロボット装置を例にとって説明するが、2足歩行のロボット装置に拘わらず、4足又は車輪等により移動可能なロボット装置であって、物体に対する異なるアプローチ動作を有するロボット装置であればよい。
ここでは、先ず、上記アプローチ動作を行わせるロボット装置の一例として、2足歩行型のロボット装置について説明し、次にロボット装置の動作制御の具体例、即ち静止した物体をつかむ動作及び動物体を打ち返す動作等の動作制御方法について説明する。
(1)ロボット装置
この人間型のロボット装置は、住環境その他の日常生活上の様々な場面における人的活動を支援する実用ロボットであり、内部状態(怒り、悲しみ、喜び、楽しみ等)に応じて行動できるほか、人間が行う基本的な動作を表出できるエンターテインメントロボットである。図1は、本実施の形態におけるロボット装置の概観を示す斜視図である。
この人間型のロボット装置は、住環境その他の日常生活上の様々な場面における人的活動を支援する実用ロボットであり、内部状態(怒り、悲しみ、喜び、楽しみ等)に応じて行動できるほか、人間が行う基本的な動作を表出できるエンターテインメントロボットである。図1は、本実施の形態におけるロボット装置の概観を示す斜視図である。
図1に示すように、ロボット装置1は、体幹部ユニット2の所定の位置に頭部ユニット3が連結されると共に、左右2つの腕部ユニット4R/Lと、左右2つの脚部ユニット5R/Lが連結されて構成されている(但し、R及びLの各々は、右及び左の各々を示す接尾辞である。以下において同じ。)。
このロボット装置1が具備する関節自由度構成を図2に模式的に示す。頭部ユニット3を支持する首関節は、首関節ヨー軸101と、首関節ピッチ軸102と、首関節ロール軸103という3自由度を有している。
また、上肢を構成する各々の腕部ユニット4R/Lは、肩関節ピッチ軸107と、肩関節ロール軸108と、上腕ヨー軸109と、肘関節ピッチ軸110と、前腕ヨー軸111と、手首関節ピッチ軸112と、手首関節ロール輪113と、手部114とで構成される。手部114は、実際には、複数本の指を含む多関節・多自由度構造体である。ただし、手部114の動作は、ロボット装置1の姿勢制御や歩行制御に対する寄与や影響が少ないので、本明細書では簡単のため、ゼロ自由度と仮定する。したがって、各腕部は7自由度を有するとする。
また、体幹部ユニット2は、体幹ピッチ軸104と、体幹ロール軸105と、体幹ヨー軸106という3自由度を有する。
また、下肢を構成する各々の脚部ユニット5R/Lは、股関節ヨー軸115と、股関節ピッチ軸116と、股関節ロール軸117と、膝関節ピッチ軸118と、足首関節ピッチ軸119と、足首関節ロール軸120と、足部121とで構成される。本明細書中では、股関節ピッチ軸116と股関節ロール軸117の交点は、ロボット装置1の股関節位置を定義する。人体の足部121は、実際には多関節・多自由度の足底を含んだ構造体であるが、本明細書においては、簡単のためロボット装置1の足底は、ゼロ自由度とする。したがって、各脚部は、6自由度で構成される。
以上を総括すれば、ロボット装置1全体としては、合計で3+7×2+3+6×2=32自由度を有することになる。ただし、エンターテインメント向けのロボット装置1が必ずしも32自由度に限定されるわけではない。設計・制作上の制約条件や要求仕様等に応じて、自由度すなわち関節数を適宜増減することができることはいうまでもない。
上述したようなロボット装置1がもつ各自由度は、実際にはアクチュエータを用いて実装される。外観上で余分な膨らみを排してヒトの自然体形状に近似させること、2足歩行という不安定構造体に対して姿勢制御を行うこと等の要請から、アクチュエータは小型且つ軽量であることが好ましい。
このようなロボット装置は、ロボット装置全体の動作を制御する制御システムを例えば体幹部ユニット2等に備える。図3は、ロボット装置1の制御システム構成を示す模式図である。図3に示すように、制御システムは、ユーザ入力等に動的に反応して情緒判断や感情表現を司る思考制御モジュール200と、アクチュエータ350の駆動等ロボット装置1の全身協調運動を制御する運動制御モジュール300とで構成される。
思考制御モジュール200は、情緒判断や感情表現に関する演算処理を実行するCPU(Central Processing Unit)211や、RAM(Random Access Memory)212、ROM(Read Only Memory)213及び外部記憶装置(ハード・ディスク・ドライブ等)214等で構成され、モジュール内で自己完結した処理を行うことができる、独立駆動型の情報処理装置である。
この思考制御モジュール200は、画像入力装置251から入力される画像データや音声入力装置252から入力される音声データ等、外界からの刺激等に従って、ロボット装置1の現在の感情や意思を決定する。ここで、画像入力装置251は、例えばCCD(Charge Coupled Device)カメラを複数備えており、また、音声入力装置252は、例えばマイクロホンを複数備えている。
また、思考制御モジュール200は、意思決定に基づいた動作又は行動シーケンス、すなわち四肢の運動を実行するように、運動制御モジュール300に対して指令を発行する。
一方の運動制御モジュール300は、ロボット装置1の全身協調運動を制御するCPU311や、RAM312、ROM313及び外部記憶装置(ハード・ディスク・ドライブ等)314等で構成され、モジュール内で自己完結した処理を行うことができる独立駆動型の情報処理装置である。また、外部記憶装置314には、例えば、オフラインで算出された歩行パターンや目標とするZMP軌道、その他の行動計画を蓄積することができる。
この運動制御モジュール300には、図2に示したロボット装置1の全身に分散するそれぞれの関節自由度を実現するアクチュエータ350、対象物との距離を測定する距離計測センサ(図示せず)、体幹部ユニット2の姿勢や傾斜を計測する姿勢センサ351、左右の足底の離床又は着床を検出する接地確認センサ352,353、足部121の足底121に設けられる荷重センサ、バッテリ等の電源を管理する電源制御装置354等の各種の装置が、バス・インターフェース(I/F)301経由で接続されている。ここで、姿勢センサ351は、例えば加速度センサとジャイロ・センサの組み合わせによって構成され、接地確認センサ352,353は、近接センサ又はマイクロ・スイッチ等で構成される。
思考制御モジュール200と運動制御モジュール300は、共通のプラットフォーム上で構築され、両者間はバス・インターフェース201,301を介して相互接続されている。
運動制御モジュール300では、思考制御モジュール200から指示された行動を体現すべく、各アクチュエータ350による全身協調運動を制御する。すなわち、CPU311は、思考制御モジュール200から指示された行動に応じた動作パターンを外部記憶装置314から取り出し、又は、内部的に動作パターンを生成する。そして、CPU311は、指定された動作パターンに従って、足部運動、ZMP軌道、体幹運動、上肢運動、腰部水平位置及び高さ等を設定するとともに、これらの設定内容に従った動作を指示する指令値を各アクチュエータ350に転送する。
また、CPU311は、姿勢センサ351の出力信号によりロボット装置1の体幹部ユニット2の姿勢や傾きを検出するとともに、各接地確認センサ352,353の出力信号により各脚部ユニット5R/Lが遊脚又は立脚のいずれの状態であるかを検出することによって、ロボット装置1の全身協調運動を適応的に制御することができる。更に、CPU311は、ZMP位置が常にZMP安定領域の中心に向かうように、ロボット装置1の姿勢や動作を制御する。
また、運動制御モジュール300は、思考制御モジュール200において決定された意思通りの行動がどの程度発現されたか、すなわち処理の状況を、思考制御モジュール200に返すようになっている。このようにしてロボット装置1は、制御プログラムに基づいて自己及び周囲の状況を判断し、自律的に行動することができる。
(2)対象物へのアプローチ方法
次に、上述したロボット装置1が対象物に接触するタスク、具体的には静止物体又は動体に対してアプローチ動作を行う際の動作制御方法について説明する。本明細書においては、ロボット装置1が対象物に接触するタスクにおいて、以下の言葉を定義するものとする。なお、ここで接触するとは、対象物に触るのみならず、対象物をつかんだり、対象物を打ち返したり等も含むものとする。
次に、上述したロボット装置1が対象物に接触するタスク、具体的には静止物体又は動体に対してアプローチ動作を行う際の動作制御方法について説明する。本明細書においては、ロボット装置1が対象物に接触するタスクにおいて、以下の言葉を定義するものとする。なお、ここで接触するとは、対象物に触るのみならず、対象物をつかんだり、対象物を打ち返したり等も含むものとする。
移動目標:ロボット装置の身体、又はロボット装置が道具を扱って対象物に接触するタスクを実行する際に、移動目標となる地点
制御注目点:ロボット装置の身体上、又は道具などの部位で、上記移動目標に到達させる点
具体的に、移動目標とは、例えばロボット装置1に静止物体を接触させる動作を行わせる場合、その静止物体が置かれている位置であり、動体をつかんだり、打ち返したりするような場合は、動体をつかんだり、打ち返したりする位置を示す。
制御注目点:ロボット装置の身体上、又は道具などの部位で、上記移動目標に到達させる点
具体的に、移動目標とは、例えばロボット装置1に静止物体を接触させる動作を行わせる場合、その静止物体が置かれている位置であり、動体をつかんだり、打ち返したりするような場合は、動体をつかんだり、打ち返したりする位置を示す。
また、制御注目点は、例えば、ロボット装置1が上述したような人間型のロボット装置1である場合において、体幹部ユニット2に接合された腕部ユニット4R/Lの手部114にて対象物に接触する場合、その手部114上の先端等、対象物に接触させる位置(点)を示す。また上述の説明においては、この手部114をゼロ自由度として説明したが、実際には複数本の指を含む多関節・多自由度構造体であり、例えば人間と同様5本の指とする場合には、例えば人差し指を対象物に接触させようとした場合は、人差し指の先端等が制御注目点となる。
また、ロボット装置1がラケットやバット等の道具を扱うような場合は、制御注目点はその道具上の点となり、例えばラケットで対象物としてのボールを打つ動作をさせるような場合は、ラケットの面の中心点等とすることができる。
すなわち、対象物に接触するタスクは、制御注目点を移動目標に移動させることで実現される。以下では、制御注目点を移動目標に移動させる動作をアプローチ動作ともいう。
先ず、ここで物体までの距離と、位置測定精度及び軌道予測精度の関係について説明する。ロボット装置1が対象物に接触するためには、対象物までの距離を測定し、対象物に近づく動作を行う必要がある。ロボット装置1が対象物の位置測定を行う際に用いる手法としては以下のような方法が挙げられる。
(1A):カメラ等の撮像手段によって得られた画像中の対象物の位置又は大きさから求める方法
(1B):ステレオビジョンシステムによる距離測定方法
(1C):レンジファインダによる距離測定方法
(1D):測定距離センサ(position sensing device:PSD)による距離測定方法
(1E):超音波センサによる距離測定方法
(1A):カメラ等の撮像手段によって得られた画像中の対象物の位置又は大きさから求める方法
(1B):ステレオビジョンシステムによる距離測定方法
(1C):レンジファインダによる距離測定方法
(1D):測定距離センサ(position sensing device:PSD)による距離測定方法
(1E):超音波センサによる距離測定方法
いずれの方法も、一般的にロボット装置1からの距離が離れれば離れるほど、その位置測定精度は低下する。つまり、移動目標としての対象物の推定位置に当該対象物が存在するとされる存在確率の分布が広がり、移動目標の不確定性が高まる。
また、対象物が動体である場合、動体の軌道を予測する必要がある。この場合、上記位置測定結果を用いて軌道予測計算を行うことで動体の軌道を予測することができる。上述したように遠方の対象物は位置測定精度が低く、したがって遠方の対象物の予測軌道精度は低くなる。一方、対象物までの距離が短く測定精度が高い場合、ロボット装置1近傍の対象物の予測軌道精度が高くなる。このように、対象物までの距離によって位置測定精度が異なるため、対象物とのインタラクションを考えた場合、対象物の位置の不確定性を考慮する必要がある。
次に、ロボット装置1のアプローチ動作と制御精度の関係について説明する。ロボット装置1が対象物にアプローチする手段としては、上述の歩行ロボット装置1を例に挙げると、以下のようなものが考えられる。
(2A):歩行によるアプローチ
(2B):下半身動作によるアプローチ
(2C):腕等の上半身動作によるアプローチ
(2A):歩行によるアプローチ
(2B):下半身動作によるアプローチ
(2C):腕等の上半身動作によるアプローチ
この場合、身体の一部を上述の制御注目点とし、この制御注目点を目標位置に到達させるようなタスクを設定した場合について説明する。例えば手先を制御注目点とし、これを移動目標に到達させようとする場合、その制御精度は一般的に、(2A)<(2B)<(2C)の順に高くなる。この理由としては、以下に示すことが挙げられる。即ち、
(3A):制御する関節位置と手先の位置(制御注目点)の距離が遠い場合、その途中の関節の制御誤差が累積するため、制御精度が低下する
(3C):下半身に近いアクチュエータを動かすと、全身の重心バランスが大きく移動し、床との接触面との不安定さが制御精度を低下させる
すなわち、上述の3つのアプローチ方法において、(2A)>(2B)>(2C)の順に制御する関節位置が制御注目点である手先から遠くなっており、また(2A)>(2B)>(2C)の順に可能範囲が広くなっている。即ち、例えば上半身動作によるアプローチのみでは、対象物までの距離が離れすぎている等の理由で目標位置に制御注目点を移動させることができない場合は、歩行によるアプローチ動作が当然必要である。すなわち、通常、制御注目点を移動させることが可能な範囲を示す可動範囲が広くなると、制御注目点を移動目標位置に移動させる制御精度が低下する。このように、アプローチ手段としての制御する部位によって制御精度が異なるため、スムーズに、且つ的確に制御注目点を目標位置に到達させるためには、制御精度を考慮した制御手法を用いる必要がある。
(3A):制御する関節位置と手先の位置(制御注目点)の距離が遠い場合、その途中の関節の制御誤差が累積するため、制御精度が低下する
(3C):下半身に近いアクチュエータを動かすと、全身の重心バランスが大きく移動し、床との接触面との不安定さが制御精度を低下させる
すなわち、上述の3つのアプローチ方法において、(2A)>(2B)>(2C)の順に制御する関節位置が制御注目点である手先から遠くなっており、また(2A)>(2B)>(2C)の順に可能範囲が広くなっている。即ち、例えば上半身動作によるアプローチのみでは、対象物までの距離が離れすぎている等の理由で目標位置に制御注目点を移動させることができない場合は、歩行によるアプローチ動作が当然必要である。すなわち、通常、制御注目点を移動させることが可能な範囲を示す可動範囲が広くなると、制御注目点を移動目標位置に移動させる制御精度が低下する。このように、アプローチ手段としての制御する部位によって制御精度が異なるため、スムーズに、且つ的確に制御注目点を目標位置に到達させるためには、制御精度を考慮した制御手法を用いる必要がある。
一方、制御精度が高い方法のみでは、可動範囲が狭く対象物に接触できないような場合や、制御精度が高い可動範囲内に対象物が存在したとしても、例えば上述のような可動範囲の境界上など、制御注目点を移動しにくく冗長性が低い領域に存在する場合においては逆にその制御が困難になる。
また、動体をつかんだり、打ち返したりする場合等、すばやい動作が必要な場合には、制御精度は低くても応答速度、移動速度が速い動作と、制御精度は高いが応答速度、移動速度が遅い動作とを適切に組み合わせる必要がある。
本実施の形態における動作制御方法は、可動範囲又は移動速度等が異なり、したがって制御精度が異なる制御動作を複数有するロボット装置が物体へ接近又は接触しようとする際、最も制御の容易性が高い、例えば制御の冗長性が高い領域内に対象物を位置させることにより、物体に精度よく容易にアプローチする方法を提案するものである。
(3)静止物体と接触するタスク
ロボット装置1の対象物へのアプローチ方法の第1の具体例として、ロボット装置1が静止物体と接触するタスクについて説明する。本具体例では、2足歩行タイプのロボット装置1が静止物体を把持する動作を制御するものとする。この場合、ロボット装置1の手先が制御注目点となり、静止物体表面上の、手先を接触させたい部分が目標位置となる。
ロボット装置1の対象物へのアプローチ方法の第1の具体例として、ロボット装置1が静止物体と接触するタスクについて説明する。本具体例では、2足歩行タイプのロボット装置1が静止物体を把持する動作を制御するものとする。この場合、ロボット装置1の手先が制御注目点となり、静止物体表面上の、手先を接触させたい部分が目標位置となる。
(3−1)可動範囲分布
本具体例においては、ロボット装置1のアプローチ動作として、上述の(2A):歩行によるアプローチ、(2B):下半身動作によるアプローチ、(2C):上半身動作によるアプローチの3つを有するものとする。ここで、下半身動作によるアプローチには、上述の図2に示す体幹ピッチ軸104、体幹ロール軸105、及び体幹ヨー軸106の3自由度を含むものとする。
本具体例においては、ロボット装置1のアプローチ動作として、上述の(2A):歩行によるアプローチ、(2B):下半身動作によるアプローチ、(2C):上半身動作によるアプローチの3つを有するものとする。ここで、下半身動作によるアプローチには、上述の図2に示す体幹ピッチ軸104、体幹ロール軸105、及び体幹ヨー軸106の3自由度を含むものとする。
図4(a)は、ロボット装置1を側面から見たときの、ロボット装置1の上半身動作による手先114aの可動範囲Hを示す模式図である。複数のアクチュエータを持つリンク機構は、移動目標位置に対して冗長性を持つ。一般的に、その冗長性が高い位置ほど、制御注目点をその位置に持ってくる自由度、容易性が高いといえる。
例えば、図4(a)における可動範囲Hの境界線上に移動目標となる物体がある場合、腕をまっすぐに伸ばした状態でしかその目標位置に到達することができない。すなわち、可動範囲H内において、その境界線近傍の冗長性が最も低い。しかし、ロボット装置1の胸部の前方部分に関しては、肩や腕の角度の組み合わせによって、数種類の到達方法がある。このように自由度の高い位置、この場合は胸部の前方部分で物体を把持するほうが、物体の扱いが容易となる。
本明細書においては、この制御注目点の上半身動作による手先の可動範囲H内において上記容易性の指標として、上記冗長性により重み付けした領域分布を可動範囲分布H(x)という。手先の可動範囲分布H(x)は、ロボット装置1の関節とリンク長とから、予め計算することができる。上述のロボット装置1においては、上半身動作の可動範囲分布H(x)が例えば図4(a)に示すようになる。ここで、可動範囲分布H(x)の最も冗長性が高い点である重心をHcとする。
ここで、xは、位置を表すベクトルであり、図4(a)に示すように、ワールド座標系{W}、すなわち環境に固定された座標での位置ベクトルを表すものとする。実際には、H(x)は3次元的な分布となり、図4(a)においては、色の濃い部分が冗長度の高い部分を表す。
また、本具体例においては、上述したように、体幹ピッチ軸104、体幹ロール軸105、及び体幹ヨー軸106からなる腰関節までを下半身動作に含めるため、H(x)は、上半身部分に含まれる腰関節に接続されている体幹部ユニット2を基準座標とする胸部座標系{H}に固定された分布関数となる。つまり、ワールド座標系{W}に対し、体幹部ユニット2の動きに合わせて、可動範囲分布H(x)は位置や向きを変えることになる。
また、図4(b)に下半身動作による重心Hcの可動範囲分布L(x)とその重心Lcを示す。可動範囲分布L(x)は、重心Hcの下半身動作による可動範囲Lに対して、その冗長性に基づき重み付けしたものであり、やはり胸部座標系{H}に固定された分布関数となっている。
(3−2)段階的アプローチによる静止物体把持タスク
ロボット装置1が対象物として静止物体に手先を接触させるタスクの様子を図5(a)乃至図5(c)に示す。図5(a)に示すように、本具体例においては、ロボット装置1が、ロボット装置1から距離L離れた、台座11等の上に載置された対象物10に接触する場合を示す。
ロボット装置1が対象物として静止物体に手先を接触させるタスクの様子を図5(a)乃至図5(c)に示す。図5(a)に示すように、本具体例においては、ロボット装置1が、ロボット装置1から距離L離れた、台座11等の上に載置された対象物10に接触する場合を示す。
予め、上半身の可動範囲分布H(x)と、可動範囲分布H(x)の重心Hcの下半身動作による可動範囲分布(以下、下半身の可動範囲分布という。)L(x)に基づいたアプローチ手法の切り替え閾値Vh1及びVl1を設定しておく。図5(a)に示すように、ロボット装置1が対象物10から遠い距離LEにある場合、対象物10の位置測定精度は低く、したがって、対象物10が存在するとされる存在確率分布O(x)は、実際の対象物10の体積より広くなっている。
ここで、対象物10の存在確率分布O(x)の算出方法としては、例えば、上述した(1A)〜(1E)に示すような距離測定方法のいずれか1つを使用して対象物10までの距離を測定する場合には、予め、測定された対象物との距離に対する誤差を求めておき、この誤差に基づき対象物10の存在確率を算出することができる。また、複数の距離測定方法を併用して対象物10までの距離を測定する場合には、各距離測定方法から得られる距離測定結果の違い、各距離測定方法が有する予め測定された誤差等に基づき対象物10の存在確率を算出するようにしてもよい。具体的には、距離センサから得られる測定距離と、ステレオビジョンシステムによる距離画像から得られる測定距離との差を利用するなどすればよい。図5(a)においては、そのようにして得られた存在確率において所定の値以上を有する範囲を対象物10の存在確率分布O(x)として示す。
ロボット装置1は、先ず、歩行により対象物10に接近する。この際、下半身の可動範囲分布L(x)と対象物の存在確率分布O(x)との積の空間積分値から得られる下記式(1)に示す評価値eva(L(x),O(x))を常に又は定期的に計算する。
上記式(1)の評価値を歩行によるアプローチ動作中、常に又は定期的に計算し、この評価値が切り替え閾値Vl1を超えない場合は、最も可動範囲が広く制御精度が低い歩行によるアプローチを行う。ロボット装置1が対象物10に近付くにつれて対象物10の位置測定精度が高くなるので、対象物の存在確率分布O(x)は狭くなる。なお、歩行によるアプローチ動作においては、下半身の可動範囲分布L(x)は、直立している場合の分布範囲を示すものとする。
そして、歩行によるアプローチを続けることで、評価値eva(L(x),O(x))が大きくなり、上記切り替え閾値Vl1より大きくなった場合、すなわち下記式(2)を満たした場合に、図5(b)に示すように、(2A):歩行によるアプローチから(2B):下半身動作によるアプローチへ、アプローチ手法を切替る。
この切り替え閾値Vl1は、ロボット装置1が歩行により予め近づけるとされる最短距離と、その最短距離において得られると予測される対象物の存在確率分布O(x)を予測し、この予測した存在確率分布O(x)と下半身の可動範囲分布L(x)とから得られる最大の評価値未満に設定されるものとする。
そして、(2B):下半身によるアプローチにより、対象物10へのアプローチ動作を続行するが、この動作中にも、下記式(3)に示す評価値eva(H(x),O(x))を計算する。そして、その価値eva(H(x),O(x))が、切り替え閾値Vh1より大きくなった場合、すなわち下記式(4)を満たした場合に、図5(c)に示すように、(2B):下半身動作によるアプローチから(2C):上半身動作によるアプローチへ、アプローチ手法を切替る。
図5(c)の右図に示すように、(2B):下半身動作によるアプローチが終了した時点で、対象物10はロボット装置1の上半身の可動範囲H(x)の中で、もっとも冗長性が高い位置にあることになる。これにより、ロボット装置1は、(2A):上半身動作によるアプローチにより容易に対象物を把持することができる。
このように、対象物10との距離に基づき、ロボット装置1の対象物10の位置測定精度を示す対象物の存在確率分布O(x)を求め、この存在確率分布O(x)と、各動作における可動範囲分布とから得られる評価値に基づき、制御精度が低いものから制御精度が高いものの順に動作を段階的に切り替えることで、各アプローチ動作の制御精度を考慮に入れつつ制御することができ、最終的に対象物10に制御注目点を接触させようとした場合に可動範囲内において最も冗長性が高い部分を移動目標位置に移動させ、対象物10を把持したりすることができる。
なお、この段階的アプローチは、制御精度が高い側の上位のアプローチ動作によって計測の誤差又は予測位置(存在確率分布)が変化した場合、新しい誤差分布に基づいて当該上位のアプローチ動作より制御精度が低い下位のアプローチを行うような、明確なアプローチ手法の切り替えがない手法を用いてもよい。
なお、ここでは、対象物の位置測定精度に基づき、制御精度が低いものから高いものへ段階的に切り替えるものとして説明したが、これは言い換えれば、可動範囲が広が制御精度があまり高くない動作から可動範囲が狭いが制御精度が高い動作へ段階的に切り替える手法や、移動速度は速いが制御精度が低い動作から移動速度は遅いが制御精度は高い動作へ段階的に切り替える手法において、このように制御注目点の可動範囲分布と対象物の存在確率分布とから得られる評価値がその動作切り替えのタイミングの指標として使用できることを示す。すなわち、この評価値により、おおまかな動作制御を行っておいてから、正確な動作制御に切り替える際の最適な切り替えタイミングを得ることができ、制御注目点の最も移動容易性が高い領域にて物体に接触することができる。
(4)動物体と接触するタスク
次に、ロボット装置1の対象物へのアプローチ方法の第2の具体例として、ロボット装置1が動体に接触するタスクについて説明する。本具体例では、上述した2足歩行タイプのロボット装置1が、バレーボールを行う動作によってロボット装置1に向かって飛んでくるボールに手先を接触させる動作を制御するものとする。この場合においても、ロボット装置1の手先が制御注目点となり、動体表面上の、手先を接触させたい部分が移動目標となる。
次に、ロボット装置1の対象物へのアプローチ方法の第2の具体例として、ロボット装置1が動体に接触するタスクについて説明する。本具体例では、上述した2足歩行タイプのロボット装置1が、バレーボールを行う動作によってロボット装置1に向かって飛んでくるボールに手先を接触させる動作を制御するものとする。この場合においても、ロボット装置1の手先が制御注目点となり、動体表面上の、手先を接触させたい部分が移動目標となる。
上述の静止物体に接触するタスクと同様に、ここでもロボット装置1のアプローチ手法を、(2A):歩行によるアプローチ、(2B):下半身動作によるアプローチ、(2C):上半身動作によるアプローチの3つとする。
図6に、ロボット装置1に向かってくる動体であるボール20を手先に接触させるタスクを示す。この動体と接触するタスクは、静止物体に対するタスクと異なり、対象物である動体20とロボット装置1の姿勢の時間軸方向のパラメータも考慮しなくてはならない。動体に、制御注目点である手先114を接触させる戦略は幾つかあるが、ここでは打面D(x)=0を設定して、この打面D(x)=0とボール20の予測軌道Kとが交わる点を打点D0とする。この場合、打点D0が、制御注目点を移動させる移動目標となるが、本具体例においては、ボール20が打点に到達する予測時間TDに関しても考慮する。
打点D0にボール20が存在する予測時間TDは、予測軌道Kと打面D(x)との関係から求めることができる。図7に示すように、空気抵抗kを有する質量mのボール20の軌道を物理モデルとして、ワールド座標系{W}においてx、y、z方向と時間T=tとの関係をそれぞれ求めると、下記式(5)のように示される。
ここで、上記式(5)において、vx0、vy0、vz0は、それぞれの方向の初速度示し、x0、y0、z0はそれぞれの方向の初期位置を示し、計算の簡略化のため、k/mをkで置き換えている。これらの式に対して、観測されるボール20の位置と観測時間とを用いて、非線形最小2乗法の手法で数値的にボール20の軌道を求めることができる。
ボール20の位置観測値には、上述したように、確率的な観測誤差があるため、予測されるボール20の軌道も同様に確率分布を有する。
なお、打面D(x)=0は、図8(a)に示すように、ロボット装置1の制御注目点、本例においては、手先114aの可動分布範囲H(x)に基づいて予め決定しておく。打面D(x)=0の決定方法の例としては、ボール20を打ち返したい方向Pに垂直な接線を有して可動範囲分布H(x)において冗長性が高い部分を含む曲面を選択する等とすることができる。図8(b)に打面D(x)=0を示す。この打面D(x)=0上における、上半身の可動分布範囲をHd(x)とする。この打面D(x)=0は、上半身部分に含まれる腰関節に接続されている体幹部ユニット2を基準座標とする胸部座標系{H}に固定される。つまり、ワールド座標系{W}に対して、体幹部ユニット2の動きに合わせて、打面(x)=0は位置及び向きを変える。
ここでも、予め上半身の可動範囲分布H(x)と、下半身の可動範囲分布L(x)に基づいた、アプローチ手法の切り替え閾値Vl2及びVh2を設定しておく。ここで、上述した如く、上半身の可動範囲分布H(x)は、制御注目点が体幹部ユニット2に接続された腕部ユニット4R/Lにより移動可能な範囲を示し、図中の濃淡は、移動の容易性又は冗長性の大きさに比例するものとする。また、下半身の可動範囲分布L(x)は、可動範囲分布H(x)において最も移動の容易性又は冗長性が高い範囲として示される領域の重心点Hcが下半身の動作により移動可能となる範囲を示し、図中の濃淡は、移動の容易性又は冗長性の大きさを示すものとする。
図9(a)乃至図9(c)は、制御精度が低いが可動範囲が広い動作から制御精度が高いが可動範囲が狭い動作に段階的に切り替えながら動体に接触するタスクを示す模式図である。
先ず、図9(a)に示すように、位置測定から算出される物体20の予測軌道Kもその確からしさの確率の分布K(x,t)を有するものとする。ボール20がロボット装置1から離れた位置にある場合、ボール(物体)20の位置測定精度が低いため、位置測定から算出される物体の予測軌道も確率分布K(x,t)の範囲も広くなる。そのため、打面D(x)=0上のボール20の存在確率分布Od(x,t)は広い。この存在確率分布Od(x,t)とは、予測軌道の確率分布K(x,t)とボール20の存在確率分布O(x,t)とにより決定されるものである。ロボット装置1は、(2A):歩行によるアプローチによって、下記(6)に示す打面D(x)=0上のボール20の存在確率分布Od(x,t)と打面D(x)=0上の上半身の可動分布範囲Hd(x)との積の空間積分値(以下、評価値という。)がより大きな値を持つようなアプローチを行う。
そして、ボール20が近付くにつれて、ボール20の位置測定精度が上がり、これにより、予測軌道の確率分布K(x,t)の範囲が狭くなり、打面D(x)=0上のボール20の存在確率分布Od(x,t)の範囲も小さくなる。そのため、評価値eva(Hd(x),Od(x,t))は大きくなる。この評価値が、アプローチ手法の切り替え閾値Vl2より大きくなった時点、すなわち下記式(7)を満たした時点で、(2A)歩行によるアプローチから(2B)下半身動作によるアプローチに移行する。
この下半身動作によるアプローチにおいても同様に、評価値eva(Hd(x),Od(x,t))がより大きな値を持つように、下半身の制御を行う。
さらにボールがロボット装置1に接近し、評価値eva(Hd(x),Od(x,t))がアプローチ手法の切り替え閾値Vh2より大きくなった時点、即ち下記式(8)を満たした時点で(2B):下半身動作によるアプローチから(2C):上半身動作によるアプローチに移行する。
下半身動作のアプローチが終了した時点で、打点Dはロボット装置1の上半身の動作制御により制御注目点が移動可能な可動範囲Hのうち、最も容易に移動させることができる領域、すなわち最も冗長性が高い位置(領域)にあることになる。これにより、ロボット装置1は容易に制御注目点をボール20に接触させることができる。
上半身のアプローチでは、ボール20が打面を通過すると予測されるタイミングで、打面D(x)=0上の予測位置に手先114aを移動させることで、手先114aをボール20に接触させることができる。手先114aのストロークを適切に生成することで、希望する方向にボール20を打ち返すこともでき、又はボール20をキャッチすることもできる。
なお、上記手法は、サッカー、野球、テニス等の動作などにおいて、動くボールを身体の一部、又は手部114R/Lにより把持する等している道具上の所定の位置を制御注目点とし、接触させる場合にも適用できる。バットやテニスラケット等の道具を使用する場合には、バットの打面上の点や、ラケット面の中心点を制御注目点として動作制御させればよい。
このように、動体に接触又は動体を打ち返すようなタスクにおいても、対象物である動体20の距離計測結果に基づき動体の予測軌道を算出し、この予測軌道の分布と、制御注目点の可動範囲上に設定した打面とにより、打面上の対象物の存在確率を求めておき、この存在確率と打面上の可動範囲分布とから得られる評価値により、大まかな制御動作から細かく精巧な制御動作に切り替える適切なタイミングを得ることができ、制御注目点が可動範囲の中で最も冗長性が高い領域と、移動目的とが重なるように動作制御することができ、ロボット装置1は、確実且つ容易に動体をつかんだり、バットやラケット等にて打ち返したりすることができる。
なお、本発明は上述した実施の形態のみに限定されるものではなく、本発明の要旨を逸脱しない範囲において種々の変更が可能であることは勿論である。
1 ロボット装置、2 体幹部ユニット、4R/L 腕部ユニット、10 対象物、20 動体、104 体幹ピッチ軸、105 体幹ロール軸、106 体幹ヨー軸、114 手部、H(x) 上半身動作の可動範囲分布、Hc H(x)の重心、L(x) Hcの下半身動作による可動範囲分布、Lc L(x)の重心、O(x) 静止物体の存在確率分布、D(x)=0 打面、Hd(x) 打面上における上半身の可動分布範囲、Od(x,t) 打面上のボールの存在確率分布、O(x,t) ボール(動体)の存在確率分布、x 位置ベクトル、{W} ワールド座標系、{H} 胸部座標系、Vh1,Vl1,Vh2,Vl2 切り替え閾値
Claims (29)
- 自律的に動作可能なロボット装置において、
制御の対象となる制御注目点を、移動目標に移動させる制御動作を生成する動作生成手段と、
上記制御動作の生成を制御する動作制御手段とを有し、
上記動作生成手段は、上記制御注目点を上記移動目標に移動させるための制御精度が異なる制御動作を複数生成可能であって、
上記動作制御手段は、上記移動目標の不確定性に基づき、第1の制御動作から第2の制御動作に切り替え制御する
ことを特徴とするロボット装置。 - 上記第2の制御動作は、上記第1の制御動作より制御精度が高く、
上記第1の制御動作は装置全体を動かす動作であり、上記第2の制御動作は装置の一部分を動かす動作である
ことを特徴とする請求項1記載のロボット装置。 - 上記第2の制御動作は、上記第1の制御動作より制御精度が高く、
上記第2の制御動作は、上記第1の制御動作より上記制御注目点に近い部位を動かす動作である
ことを特徴とする請求項1記載のロボット装置。 - 上記第2の制御動作は、上記第1の制御動作より制御精度が高く、
上記第1の制御動作は、上記第2の制御動作より上記制御注目点を移動させることが可能な範囲を示す可動範囲が広い及び/又は上記制御注目点を移動させる動作速度が速い動作である
ことを特徴とする請求項1記載のロボット装置。 - 上記複数の制御動作は、対象物に上記制御注目点を接近又は接触させるための動作であり、
上記動作制御手段は、上記対象物の位置を推定し、該推定した位置に該対象物が存在するとされる存在確率の分布に基づき、上記複数の制御動作を切り替え制御する
ことを特徴とする請求項1記載のロボット装置。 - 上記複数の制御動作は、対象物に上記制御注目点を接近又は接触させるための動作であり、
上記動作制御手段は、上記対象物までの距離計測結果に基づき、上記複数の制御動作を切り替え制御する
ことを特徴とする請求項1記載のロボット装置。 - 上記動作制御手段は、上記対象物までの距離が小さいほど、上記制御注目点に近い部位を動かす制御動作を生成させる
ことを特徴とする請求項6記載のロボット装置。 - 脚式移動型であって、
上記動作制御手段は、上記対象物までの距離が大きいほど、脚部に近い部位を動かす制御動作を生成させる
ことを特徴とする請求項6記載のロボット装置。 - 上記複数の制御動作は、対象物に上記制御注目点を接近又は接触させるための動作であり、
上記動作制御手段は、上記対象物の位置を推定し、該推定した位置に該対象物が存在するとされる存在確率の分布と上記制御注目点を移動させることが可能な範囲の冗長性を示す可動範囲の分布とに基づき上記制御動作を切り替え制御する
ことを特徴とする請求項1記載のロボット装置。 - 上記対象物は、静止物体である
ことを特徴とする請求項1記載のロボット装置。 - 上記動作制御手段は、上記第1の制御動作の動作中に、上記存在確率の分布と上記制御注目点を移動させる際の容易性に基づき得られる可動範囲の分布との内積が所定の閾値以上又は最大になった場合に、該第1の制御動作より制御精度が高い第2の制御動作を生成させる
ことを特徴とする請求項5記載のロボット装置。 - 上記動作制御手段は、上記第2の制御動作の動作中に、上記存在確率の分布が変化した場合、再び上記第1の制御動作を生成させる
ことを特徴とする請求項11記載のロボット装置。 - 上記対象物は、動体である
ことを特徴とする請求項6記載のロボット装置。 - 上記動作制御手段は、所定の時刻における上記動体の位置を推定し、該推定した位置に該動体が存在するとされる存在確率の分布に基づき、上記制御動作を切り替える
ことを特徴とする請求項13記載のロボット装置。 - 上記動作制御手段は、上記距離計測結果から予測された上記動体の予測軌道に基づき上記存在確率の分布を決定する
ことを特徴とする請求項14記載のロボット装置。 - 上記動作制御手段は、上記制御注目点を移動させる際の容易性に基づき得られる可動範囲の分布と、この可動範囲の分布の略重心を含む曲面における上記存在確率の分布とに基づき上記制御動作を切り替え制御する
ことを特徴とする請求項14記載のロボット装置。 - 自律的に動作可能なロボット装置の動作制御方法において、
制御の対象となる制御注目点を、移動目標に移動させる制御動作を生成する動作生成工程と、
上記制御動作の生成を制御する動作制御工程とを有し、
上記動作生成工程では、上記制御注目点を上記移動目標に移動させるための制御精度が異なる制御動作を複数生成可能であって、
上記動作制御工程では、上記移動目標の不確定性に基づき、第1の制御動作から第2の制御動作に切り替え制御する
ことを特徴とするロボット装置の動作制御方法。 - 上記第2の制御動作は、上記第1の制御動作より制御精度が高く、
上記第1の制御動作は装置全体を動かす動作であり、上記第2の制御動作は装置の一部分を動かす動作である
ことを特徴とする請求項17記載のロボット装置の動作制御方法。 - 上記第2の制御動作は、上記第1の制御動作より制御精度が高く、
上記第2の制御動作は、上記第1の制御動作より上記制御注目点に近い部位を動かす動作である
ことを特徴とする請求項17記載のロボット装置の動作制御方法。 - 上記第2の制御動作は、上記第1の制御動作より制御精度が高く、
上記第1の制御動作は、上記第2の制御動作より上記制御注目点を移動させることが可能な範囲を示す可動範囲が広い及び/又は上記制御注目点を移動させる動作速度が速い動作である
ことを特徴とする請求項17記載のロボット装置の動作制御方法。 - 上記複数の制御動作は、対象物に上記制御注目点を接近又は接触させるための動作であり、
上記動作制御工程では、上記対象物の位置を推定し、該推定した位置に該対象物が存在するとされる存在確率の分布に基づき、上記複数の制御動作を切り替え制御する
ことを特徴とする請求項17記載のロボット装置の動作制御方法。 - 上記複数の制御動作は、対象物に上記制御注目点を接近又は接触させるための動作であり、
上記動作制御工程では、上記対象物までの距離計測結果に基づき、上記複数の制御動作を切り替え制御する
ことを特徴とする請求項17記載のロボット装置の動作制御方法。 - 上記複数の制御動作は、対象物に上記制御注目点を接近又は接触させるための動作であり、
上記動作制御工程では、上記対象物の位置を推定し、該推定した位置に該対象物が存在するとされる存在確率の分布と、上記制御注目点を移動させることが可能な範囲の冗長性を示す可動範囲の分布とに基づき上記制御動作を切り替え制御する
ことを特徴とする請求項17記載のロボット装置の動作制御方法。 - 上記対象物は、静止物体である
ことを特徴とする請求項17記載のロボット装置の動作制御方法。 - 上記動作制御工程では、上記第1の制御動作の動作中に、上記存在確率の分布と上記制御注目点を移動させる際の容易性に基づき得られる可動範囲の分布との内積が所定の閾値以上又は最大になった場合に、該第1の制御動作より制御精度が高い第2の制御動作を生成させる
ことを特徴とする請求項21記載のロボット装置の動作制御方法の動作制御方法。 - 上記動作制御工程では、上記第2の制御動作の動作中に、上記存在確率の分布が変化した場合、再び上記第1の制御動作を生成させる
ことを特徴とする請求項25記載のロボット装置の動作制御方法。 - 上記対象物は、動体である
ことを特徴とする請求項22記載のロボット装置の動作制御方法。 - 上記動作制御工程では、所定の時刻における上記動体の位置を推定し、該推定した位置に該動体が存在するとされる存在確率の分布に基づき、上記制御動作を切り替える
ことを特徴とする請求項27記載のロボット装置の動作制御方法。 - 上記存在確率の分布は、上記距離計測結果から予測された上記動体の予測軌道に基づき決定される
ことを特徴とする請求項28記載のロボット装置の動作制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003329130A JP2005088175A (ja) | 2003-09-19 | 2003-09-19 | ロボット装置及びロボット装置の動作制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003329130A JP2005088175A (ja) | 2003-09-19 | 2003-09-19 | ロボット装置及びロボット装置の動作制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2005088175A true JP2005088175A (ja) | 2005-04-07 |
Family
ID=34458462
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003329130A Withdrawn JP2005088175A (ja) | 2003-09-19 | 2003-09-19 | ロボット装置及びロボット装置の動作制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2005088175A (ja) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008246607A (ja) * | 2007-03-29 | 2008-10-16 | Honda Motor Co Ltd | ロボット、ロボットの制御方法およびロボットの制御プログラム |
JP2011148081A (ja) * | 2009-12-24 | 2011-08-04 | Honda Motor Co Ltd | 行動制御システムおよびロボット |
JP2011235379A (ja) * | 2010-05-07 | 2011-11-24 | Honda Motor Co Ltd | 制御装置 |
WO2013076829A1 (ja) * | 2011-11-22 | 2013-05-30 | 株式会社日立製作所 | 自律移動システム |
JP2013198943A (ja) * | 2012-03-23 | 2013-10-03 | Toyota Motor Corp | 移動ロボット |
WO2019003401A1 (ja) * | 2017-06-29 | 2019-01-03 | 株式会社ソニー・インタラクティブエンタテインメント | ロボットの制御装置、制御方法および制御プログラム |
CN110238861A (zh) * | 2019-06-14 | 2019-09-17 | 武汉职业技术学院 | 一种基于Arduino的室内安防机器人 |
-
2003
- 2003-09-19 JP JP2003329130A patent/JP2005088175A/ja not_active Withdrawn
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2042275A3 (en) * | 2007-03-29 | 2009-08-05 | Honda Motor Co., Ltd | Robot, control method of robot and control program of robot |
US8260457B2 (en) | 2007-03-29 | 2012-09-04 | Honda Motor Co., Ltd. | Robot, control method of robot and control program of robot |
JP2008246607A (ja) * | 2007-03-29 | 2008-10-16 | Honda Motor Co Ltd | ロボット、ロボットの制御方法およびロボットの制御プログラム |
US8660699B2 (en) | 2009-12-24 | 2014-02-25 | Honda Motor Co., Ltd. | Behavior control system and robot |
JP2011148081A (ja) * | 2009-12-24 | 2011-08-04 | Honda Motor Co Ltd | 行動制御システムおよびロボット |
JP2011235379A (ja) * | 2010-05-07 | 2011-11-24 | Honda Motor Co Ltd | 制御装置 |
JPWO2013076829A1 (ja) * | 2011-11-22 | 2015-04-27 | 株式会社日立製作所 | 自律移動システム |
WO2013076829A1 (ja) * | 2011-11-22 | 2013-05-30 | 株式会社日立製作所 | 自律移動システム |
US9062980B2 (en) | 2011-11-22 | 2015-06-23 | Hitachi, Ltd. | Autonomous mobile system |
JP2013198943A (ja) * | 2012-03-23 | 2013-10-03 | Toyota Motor Corp | 移動ロボット |
WO2019003401A1 (ja) * | 2017-06-29 | 2019-01-03 | 株式会社ソニー・インタラクティブエンタテインメント | ロボットの制御装置、制御方法および制御プログラム |
CN110831725A (zh) * | 2017-06-29 | 2020-02-21 | 索尼互动娱乐股份有限公司 | 机器人控制装置、控制方法及控制程序 |
JPWO2019003401A1 (ja) * | 2017-06-29 | 2020-04-16 | 株式会社ソニー・インタラクティブエンタテインメント | ロボットの制御装置、制御方法および制御プログラム |
JP7069155B2 (ja) | 2017-06-29 | 2022-05-17 | 株式会社ソニー・インタラクティブエンタテインメント | ロボットの制御装置、制御方法および制御プログラム |
US11453128B2 (en) | 2017-06-29 | 2022-09-27 | Sony Interactive Entertainment Inc. | Robot control apparatus, control method and control program |
CN110238861A (zh) * | 2019-06-14 | 2019-09-17 | 武汉职业技术学院 | 一种基于Arduino的室内安防机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Diftler et al. | Evolution of the NASA/DARPA robonaut control system | |
KR100977348B1 (ko) | 다리식 이동 로봇의 동작 제어 장치 및 동작 제어 방법 및 로봇 장치 | |
US8818555B2 (en) | Path planning apparatus of robot and method and computer-readable medium thereof | |
JP6715952B2 (ja) | バランスのとれた運動および行動能力が向上した移動型ロボット | |
KR100898435B1 (ko) | 로봇 장치 및 그 제어 방법 | |
JP3714268B2 (ja) | ロボット装置 | |
JP4911149B2 (ja) | ロボット装置及びロボット装置の制御方法 | |
Wang et al. | The hermes humanoid system: A platform for full-body teleoperation with balance feedback | |
JP4239635B2 (ja) | ロボット装置、その動作制御方法、及びプログラム | |
Al-Shuka et al. | Modeling, stability and walking pattern generators of biped robots: a review | |
JP2001277159A (ja) | 脚式移動ロボット及びその制御方法、並びに、脚式移動ロボット用相対移動測定センサ | |
JP2001277163A (ja) | ロボットの制御装置及び制御方法 | |
JP2006082150A (ja) | ロボット装置及びその行動制御方法 | |
JP7318655B2 (ja) | 情報処理装置、制御方法及びプログラム | |
JP2003266345A (ja) | 経路計画装置、経路計画方法及び経路計画プログラム並びに移動型ロボット装置 | |
JP2003266349A (ja) | 位置認識方法、その装置、そのプログラム、その記録媒体及び位置認識装置搭載型ロボット装置 | |
JP2002144260A (ja) | 脚式移動ロボット及びその制御方法 | |
Jianhua | Design and kinematic simulation for Six-DOF leg mechanism of hexapod robot | |
JP2005088175A (ja) | ロボット装置及びロボット装置の動作制御方法 | |
JP2002307340A (ja) | 脚式移動ロボット及びその制御方法 | |
JP4408616B2 (ja) | 脚式移動ロボットの動作制御装置及び動作制御方法 | |
JP4660870B2 (ja) | 脚式移動ロボット及びその制御方法 | |
JP3615539B2 (ja) | ロボット装置の動作制御装置及び動作制御方法、並びにロボット装置の遠隔操作装置及び遠隔操作方法 | |
Mellmann et al. | Dynamic motion control: Adaptive bimanual grasping for a humanoid robot | |
JP4539291B2 (ja) | ロボット装置及びその動作制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20061205 |