JP2006341372A - ロボットの制御方法 - Google Patents
ロボットの制御方法 Download PDFInfo
- Publication number
- JP2006341372A JP2006341372A JP2006229656A JP2006229656A JP2006341372A JP 2006341372 A JP2006341372 A JP 2006341372A JP 2006229656 A JP2006229656 A JP 2006229656A JP 2006229656 A JP2006229656 A JP 2006229656A JP 2006341372 A JP2006341372 A JP 2006341372A
- Authority
- JP
- Japan
- Prior art keywords
- arm
- compliance
- target
- force
- posture
- 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.)
- Abandoned
Links
Images
Abstract
【課題】ロボットアームとコンプライアンス制御されたエンドエフェクタによる操作対象物の環境との接触を伴う動作において、操作対象物の姿勢が変化してもエンドエフェクタの位置や姿勢の偏りを小さくする。
【解決手段】コンプライアンス計算部4Bにおいて、多指ハンド8の各指の先端位置の情報と各指先端の力覚センサ7で計測された力情報Fをもとにコンプライアンス中心の力を求め、操作対象物のハンドベース座標系における位置、姿勢を計算する。コンプライアンス計算部2Bでは、アームの力覚センサによって計測された外力Fからコンプライアンス中心に加わる外力と予め与えられた目標力、アームの現在位置、姿勢、目標指令からアームの位置、姿勢を計算する。ここで、アームの仮想弾性係数を0もしくは非常に小さく設定することによって、外力と目標力が等しくなるようにアームの位置・姿勢が制御される。
【選択図】図1
【解決手段】コンプライアンス計算部4Bにおいて、多指ハンド8の各指の先端位置の情報と各指先端の力覚センサ7で計測された力情報Fをもとにコンプライアンス中心の力を求め、操作対象物のハンドベース座標系における位置、姿勢を計算する。コンプライアンス計算部2Bでは、アームの力覚センサによって計測された外力Fからコンプライアンス中心に加わる外力と予め与えられた目標力、アームの現在位置、姿勢、目標指令からアームの位置、姿勢を計算する。ここで、アームの仮想弾性係数を0もしくは非常に小さく設定することによって、外力と目標力が等しくなるようにアームの位置・姿勢が制御される。
【選択図】図1
Description
本発明は、コンプライアンスを持ったロボットアームとエンドエフェクタのコンプライアンス制御方法に関する。
ロボットによって対象物あるいは外界との物理的な接触を伴う作業を行う場合、エンドエフェクタ自体にコンプライアンスを持たせることが一般的である。この場合、エンドエフェクタにRCCデバイスのような機械的なコンプライアンス機構を設ける、あるいはエンドエフェクタ自体をコンプライアンス制御する、あるいはロボットア−ムをコンプライアンスアンス制御することが考えられる。ロボットアームのコンプライアンス制御とは、ロボットアーム先端の位置と姿勢、およびアーム先端にかかる力を用いて、ロボットの軟らかい動きをさせる力制御手法である。この手法は、弾性・粘性・慣性の各パラメータを仮想的に設定したモデルの運動をロボットの動きで実現するもので、パラメータの値を変えることによりロボットの見かけ上の応答特性を自由に設定することができる。コンプライアンス制御は、
という特性方程式で表される。ここで、Mは仮想慣性係数、Dは仮想粘性係数、Kは仮想
弾性係数、Fはアーム先端が受ける力、Fdは目標力、xはアーム先端の現在位置、xd
は目標位置を表す。アーム先端に加わる外力Fを力センサによって計測し、(1)または
(2)式を満足するようにロボットを制御する。一般によく利用される手法として、図2または図3に示すように、コンプライアンスのモデルにしたがってロボットが追従すべき値をコンプライアンス計算部2Aまたは2Bで(1)または(2)式より求め、その位置に対応するロボットの各関節角度を逆キネマティクス計算部3によって求め、これをロボットへの位置指令とする制御方法がある。エンドエフェクタの一つとして多指ハンドを考えた場合、特開平5ー177566にて開示されているように、コンプライアンス制御を用いた協調制御により外乱が加わっても安定して把持できることが示されている。
弾性係数、Fはアーム先端が受ける力、Fdは目標力、xはアーム先端の現在位置、xd
は目標位置を表す。アーム先端に加わる外力Fを力センサによって計測し、(1)または
(2)式を満足するようにロボットを制御する。一般によく利用される手法として、図2または図3に示すように、コンプライアンスのモデルにしたがってロボットが追従すべき値をコンプライアンス計算部2Aまたは2Bで(1)または(2)式より求め、その位置に対応するロボットの各関節角度を逆キネマティクス計算部3によって求め、これをロボットへの位置指令とする制御方法がある。エンドエフェクタの一つとして多指ハンドを考えた場合、特開平5ー177566にて開示されているように、コンプライアンス制御を用いた協調制御により外乱が加わっても安定して把持できることが示されている。
物体の接触を伴う作業をロボットアームにより行う場合、アーム自体をコンプライアンス制御する手法やアーム先端にコンプライアンス制御されたツールを取り付ける手法およびそれらを組み合わせた手法を用いることにより、環境の誤差などを吸収し高精度な作業の実現が期待できる。ここでは操作対象物のある面を環境のある面に押しつける動作を、エンドエフェクタとしてコンプライアンス制御された多指ハンドを持つロボットアームに行わせる例を示す。図4および5はその制御ブロック図で、目標指令決定部1B又は2Bとコンプライアンス計算部4A又は4Bと逆キネマティクス計算部5を備えたものである。押しつけ動作は、押しつける面同士が平行になるように操作対象物の姿勢を保ちながら環境へ接近させることで実現される。ここで操作対象物の回転に関するコンプライアンスが軟らかくなるように(1)式または(2)式のパラメータを設定することによって、押しつける環境と操作対象物との相対的な位置および姿勢が不確定な場合にも対象に倣う形で押しつけ動作が達成される。予想される環境面16にコンプライアンス制御された多指ハンド13によって把持された対象14をロボットアーム11によって押しつける作業において、予想される環境面16と実際の環境面15との誤差がある場合、図6のように目標とは異なる形で操作対象物14と環境面15の接触が生じる。操作対象物14と環境面15との接触によって生じる力とモーメントがハンドの力覚センサ12によって計測され、制御システム内でコンプライアンス中心17における力19とモーメント20へと変換され、(1)式または(2)式のFとして利用される。ここで、コンプライアンス中心17の回りの回転の仮想弾性係数Kを軟らかく設定しておけば、操作対象物は加わったモーメント20の方向に回転し姿勢を変える。また、コンプライアンス中心17の位置は設定されているKと外力18の平衡点へ移動する。このためパラメータの設置が適当ならば図7に示すように環境面15に対して操作対象物14の押しつけが達成される。
多指ハンドはアームと比較して外部からの力やモーメントに対し高い応答性を得られる。そのため多指ハンドのコンプライアンス制御を利用することにより、アームのみを用いた場合よりも環境の変化や誤差に対して高速かつ柔軟に対応することが可能である。
上述した従来の方法では、環境面の誤差の大部分をより応答性の高い多指ハンドで吸収することとなるため、押しつけ動作が終了した時点で図7のように多指ハンドの姿勢がハンドのベースに対して大きく傾く場合がある。このため、この後さらにハンドによって物体の位置姿勢を操作する場合に操作可能な範囲が限られてしまうという問題があった。これは多指ハンドに限らずコンプライアンス制御されたエンドフェクタを利用する場合に常に生じる問題である。また、目標姿勢からのずれが生じた状態で(2)式が成立するために外力と目標が一致しない。これらは多指ハンドに限らずコンプライスアンス制御されたエンドフェクタを持つアームを利用する場合に常に生じる問題である。
本発明の目的は、ロボットアームとコンプライアンス制御されたエンドエフェクタによる操作対象物の環境との接触を伴う動作において、操作対象物の姿勢が変化してもエンドエフェクタの位置や姿勢の偏りを小さくする、ロボットのコンプライアンスの制御方法を提供することにある。
本発明のロボットの制御方法は、複数の自由度を持つロボットアームと、該アームの先端に取り付けられた少なくとも1自由度持つエンドエフェクタを有するロボットの制御方法において、アームとエンドエフェクタをそれぞれコンプライアンス制御し、それぞれのコンプライアンス制御中心を同一の点に設定し、エンドエフェクタが外界からエンドエフェクタの操作対象物に加わる力である外力と目標力が等しいときに所望の姿勢をとるように設定し、外力によって操作対象物の姿勢が変化するような動作を行う場合に、アームとエンドエフェクタのそれぞれに等しい目標力を予め与えてコンプライアンス制御を行い、動作時に操作対象物に加わる外力をエンドエフェクタおよびアームにおいて計測し、これが目標力と等しくなるようにアームの各部分の位置、姿勢を変更するものである。
本発明の実施態様によれば、アームとエンドエフェクタのコンプライアンス制御における目標力を一致させる。
以上説明したように、請求項1と2の発明は、複数の自由度を持つコンプライアンスを持つ先端部とそれ以外とに分割して制御可能なロボットアームを用いた操作対象物の環境への接触を伴う動作において、操作対象物に加わる外力が先端部の目標力と等しくなるようにアームのそれぞれの部分をコンプライアンス制御することにより、アーム先端部の最適な姿勢からの偏りを減少させ、その後のアームによる操作対象物の操作性を向上させる効果がある。
次に、本発明の実施の形態について図面を参照して説明する。図1は本発明の一実施形態のロボットのブロック図である。ハンド制御部では、操作対象物を把持するためのハンドベース座標系での各指先端位置の目標指令と各指の力覚センサ7からの力情報Fに基づいて、コンプライアンス中心に加わる外力を求め、コンプライアンス計算部4Bが物体を把持するための各指の協調も含めたコンプライアンス計算を特性方程式(2)により行い、各指先位置を決定する。これを逆キネマティクス部5で各指毎に逆キネマティクスを解き、関節角度指令を多指ハンド8へ送る。アーム制御部では、目標指令決定部1Bがアーム先端を最終的な目標位置および姿勢へ移動させるための目標指令を時系列的にコンプライアンス計算部2Bへ渡す。コンプライアンス計算部2Bでは、目標指令xdとアーム力覚センサ6からの力情報Fに基づいて、力情報Fをコンプライアンス中心における力へと変換し、コンプライアンス中心の目標位置、姿勢xd'を計算し、これを実現するアームの関節角度θを逆キネマティクス計算部3で求め、これをロボットアームへの指令とする位置制御を行う。アームとハンドのコンプライアンス制御中心は同一の座標に設定する。これによりアームとハンドそれぞれの求めるコンプライアンス中心に加わる外力は等しくなる。
操作対象物を環境に押しつける動作をこのロボットアームで行う場合、本実施形態ではハンド制御部のコンプライアンス計算部4Bに、押しつける動作のコンプライアンス中心における目標力をハンドベース座標系で与え、アーム制御部のコンプライアンス制御部2Bには、ハンドに与えた目標力をアームの姿勢変化に応じてロボットベース座標系に変換したものを常に与える。また、外力と目標力が等しい場合にハンドが操作対象物を最も操作しやすくなるように、操作対象物のハンドベース座標系での目標位置、姿勢をハンドに与える。動作時には、コンプライアンス計算部4Bにおいて、多指ハンド8の各指の先端位置の情報および各指先端の力覚センサ7で計測された力情報Fをもとにコンプライアンス中心の力を求め、操作対象物のハンドベース座標系における位置、姿勢を計算する。アームのコンプライアンス計算部2Bでは、アームの力覚センサによって計測された外力Fからコンプライアンス中心に加わる外力と予め与えられた目標力、アームの現在位置、姿勢、目標指令からアームの位置、姿勢を計算する。ここで、アームの仮想弾性係数を0もしくは非常に小さく設定することによって、外力と目標力が等しくなるようにアームの位置・姿勢が制御される。アームとハンドのコンプライアンス中心および目標力は同一に設定されているので、押しつけ動作中のハンドにおいても目標力と外力が等しくなり、その結果としてハンドの最適な姿勢からのずれが補償される。
1B 目標指令決定部(アーム)
2A,2B コンプライアンス計算部(アーム)
3 逆キネマティクス計算部(アーム)
4A,4B コンプライアンス計算部(ハンド)
5 逆キネマティクス計算部(ハンド)
6,7 力覚センサ
8 多指ハンド
11 ロボットアーム
12 力覚センサ
13 多指ハンド
14 操作対象物
15 実際の環境面
16 予想される環境面
17 コンプライアンス制御中心
18 操作対象物が環境から受ける力
19 コンプライアンス中心の受ける力
20 コンプライナアンス中心の受けるモーメント
2A,2B コンプライアンス計算部(アーム)
3 逆キネマティクス計算部(アーム)
4A,4B コンプライアンス計算部(ハンド)
5 逆キネマティクス計算部(ハンド)
6,7 力覚センサ
8 多指ハンド
11 ロボットアーム
12 力覚センサ
13 多指ハンド
14 操作対象物
15 実際の環境面
16 予想される環境面
17 コンプライアンス制御中心
18 操作対象物が環境から受ける力
19 コンプライアンス中心の受ける力
20 コンプライナアンス中心の受けるモーメント
Claims (2)
- 複数の自由度を持つロボットアームと、該アームの先端に取り付けられた少なくとも1自由度持つエンドエフェクタを有するロボットの制御方法において、
前記アームと前記エンドエフェクタをそれぞれコンプライアンス制御し、それぞれのコンプライアンス制御中心を同一の点に設定し、前記エンドエフェクタが外界からエンドエフェクタの操作対象物に加わる力である外力と目標力が等しいときに所望の姿勢をとるように設定し、外力によって前記操作対象物の姿勢が変化するような動作を行う場合に、前記アームと前記エンドエフェクタのそれぞれに等しい目標力を予め与えてコンプライアンス制御を行い、動作時に前記操作対象物に加わる外力を前記エンドエフェクタおよび前記アームにおいて計測し、これが目標力と等しくなるように前記アームの各部分の位置、姿勢を変更することを特徴とする、ロボットの制御方法。 - 前記アームと前記エンドエフェクタのコンプライアンス制御における目標力を一致させる請求項1記載のロボットの制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006229656A JP2006341372A (ja) | 2006-08-25 | 2006-08-25 | ロボットの制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006229656A JP2006341372A (ja) | 2006-08-25 | 2006-08-25 | ロボットの制御方法 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP19429397A Division JP3937108B2 (ja) | 1997-07-18 | 1997-07-18 | ロボットの制御方法およびロボット |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2006341372A true JP2006341372A (ja) | 2006-12-21 |
Family
ID=37638706
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2006229656A Abandoned JP2006341372A (ja) | 2006-08-25 | 2006-08-25 | ロボットの制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2006341372A (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104398346A (zh) * | 2014-11-07 | 2015-03-11 | 上海交通大学 | 可自主开门的智能轮椅及其自主开门方法 |
JP2015089582A (ja) * | 2013-11-05 | 2015-05-11 | セイコーエプソン株式会社 | ロボットシステム、制御装置、ロボット、駆動方法及びプログラム |
JP2016068169A (ja) * | 2014-09-29 | 2016-05-09 | セイコーエプソン株式会社 | ロボット、ロボットシステム、制御装置、及び制御方法 |
JP6046218B1 (ja) * | 2015-07-09 | 2016-12-14 | ファナック株式会社 | 物体と物体とを合わせ状態にするロボットのロボット制御装置 |
KR20170012455A (ko) * | 2014-07-16 | 2017-02-02 | 엑스 디벨롭먼트 엘엘씨 | 궤적 계획을 위한 물체 메트릭들의 실시간 결정 |
-
2006
- 2006-08-25 JP JP2006229656A patent/JP2006341372A/ja not_active Abandoned
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015089582A (ja) * | 2013-11-05 | 2015-05-11 | セイコーエプソン株式会社 | ロボットシステム、制御装置、ロボット、駆動方法及びプログラム |
KR20170012455A (ko) * | 2014-07-16 | 2017-02-02 | 엑스 디벨롭먼트 엘엘씨 | 궤적 계획을 위한 물체 메트릭들의 실시간 결정 |
KR101902678B1 (ko) * | 2014-07-16 | 2018-09-28 | 엑스 디벨롭먼트 엘엘씨 | 궤적 계획을 위한 물체 메트릭들의 실시간 결정 |
JP2016068169A (ja) * | 2014-09-29 | 2016-05-09 | セイコーエプソン株式会社 | ロボット、ロボットシステム、制御装置、及び制御方法 |
CN104398346A (zh) * | 2014-11-07 | 2015-03-11 | 上海交通大学 | 可自主开门的智能轮椅及其自主开门方法 |
JP6046218B1 (ja) * | 2015-07-09 | 2016-12-14 | ファナック株式会社 | 物体と物体とを合わせ状態にするロボットのロボット制御装置 |
CN106335053A (zh) * | 2015-07-09 | 2017-01-18 | 发那科株式会社 | 使物体和物体处于重合状态的机器人的机器人控制装置 |
JP2017019039A (ja) * | 2015-07-09 | 2017-01-26 | ファナック株式会社 | 物体と物体とを合わせ状態にするロボットのロボット制御装置 |
US9724825B2 (en) | 2015-07-09 | 2017-08-08 | Fanuc Corporation | Robot controller for robot which sets two objects in combined state |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8909376B2 (en) | Robot hand and method of controlling the same | |
KR101479233B1 (ko) | 로봇 및 그 협조작업 제어방법 | |
JP5281377B2 (ja) | ロボット装置 | |
EP1645374B1 (en) | Gripping hand with strain detecting means for adjusting its gripping force | |
JP6484265B2 (ja) | 学習制御機能を備えたロボットシステム及び学習制御方法 | |
KR101941844B1 (ko) | 로봇 및 그 제어방법 | |
JP2013039657A (ja) | シリアルロボットのための迅速な把持接触計算 | |
JP2006341372A (ja) | ロボットの制御方法 | |
JP2012006097A (ja) | ロボット装置 | |
Su et al. | Robust grasping for an under-actuated anthropomorphic hand under object position uncertainty | |
JP4211701B2 (ja) | ロボットハンドの把持制御装置 | |
JP6322949B2 (ja) | ロボット制御装置、ロボットシステム、ロボット、ロボット制御方法及びロボット制御プログラム | |
JPH08257958A (ja) | 多関節マニピュレータの柔軟性設定方法および制御装置 | |
JP3937108B2 (ja) | ロボットの制御方法およびロボット | |
JP4640499B2 (ja) | 把持制御装置 | |
JP4715296B2 (ja) | ロボットハンドの持ち替え把持制御方法。 | |
JP2015085499A (ja) | ロボット、ロボットシステム、制御装置及び制御方法 | |
WO2017175340A1 (ja) | 最適化装置及びそれを備えた垂直型多関節ロボット | |
JP2005144573A (ja) | ロボットハンドの把持力制御方法 | |
JP6322948B2 (ja) | ロボット制御装置、ロボットシステム、ロボット、ロボット制御方法、及びプログラム | |
JP7159525B2 (ja) | ロボット制御装置、学習装置、及びロボット制御システム | |
JP2003062775A (ja) | 人間型ハンドロボット用教示システム | |
JP2005335010A (ja) | 把持制御装置 | |
US20190389052A1 (en) | Control apparatus, robot, and robot system | |
JP5013476B2 (ja) | ロボットハンド装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A762 | Written abandonment of application |
Free format text: JAPANESE INTERMEDIATE CODE: A762 Effective date: 20090714 |