JP3937108B2 - ロボットの制御方法およびロボット - Google Patents
ロボットの制御方法およびロボット Download PDFInfo
- Publication number
- JP3937108B2 JP3937108B2 JP19429397A JP19429397A JP3937108B2 JP 3937108 B2 JP3937108 B2 JP 3937108B2 JP 19429397 A JP19429397 A JP 19429397A JP 19429397 A JP19429397 A JP 19429397A JP 3937108 B2 JP3937108 B2 JP 3937108B2
- Authority
- JP
- Japan
- Prior art keywords
- target
- posture
- arm
- compliance
- robot
- 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 - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、コンプライアンスを持ったロボットアームとエンドエフェクタのコンプライアンス制御方法に関する。
【０００２】
【従来の技術】
ロボットによって対象物あるいは外界との物理的な接触を伴う作業を行う場合、エンドエフェクタ自体にコンプライアンスを持たせることが一般的である。この場合、エンドエフェクタにＲＣＣデバイスのような機械的なコンプライアンス機構を設ける、あるいはエンドエフェクタ自体をコンプライアンス制御する、あるいはロボットア−ムをコンプライアンスアンス制御することが考えられる。
ロボットアームのコンプライアンス制御とは、ロボットアーム先端の位置と姿勢、およびアーム先端にかかる力を用いて、ロボットの軟らかい動きをさせる力制御手法である。この手法は、弾性・粘性・慣性の各パラメータを仮想的に設定したモデルの運動をロボットの動きで実現するもので、パラメータの値を変えることによりロボットの見かけ上の応答特性を自由に設定することができる。コンプライアンス制御は、
【０００３】
【数１】
【０００４】
という特性方程式で表される。ここで、Ｍは仮想慣性係数、Ｄは仮想粘性係数、Ｋは仮想弾性係数、Ｆはアーム先端が受ける力、Ｆｄは目標力、ｘはアーム先端の現在位置、ｘｄは目標位置を表す。アーム先端に加わる外力Ｆを力センサによって計測し、（１）または（２）式を満足するようにロボットを制御する。一般によく利用される手法として、図３または図４に示すように、コンプライアンスのモデルにしたがってロボットが追従すべき値をコンプライアンス計算部２Ａまたは２Ｂで（１）または（２）式より求め、その位置に対応するロボットの各関節角度を逆キネマティクス計算部３によって求め、これをロボットへの位置指令とする制御方法がある。エンドエフェクタの一つとして多指ハンドを考えた場合、特開平５ー１７７５６６にて開示されているように、コンプライアンス制御を用いた協調制御により外乱が加わっても安定して把持できることが示されている。
【０００５】
物体の接触を伴う作業をロボットアームにより行う場合、アーム自体をコンプライアンス制御する手法やアーム先端にコンプライアンス制御されたツールを取り付ける手法およびそれらを組み合わせた手法を用いることにより、環境の誤差などを吸収し高精度な作業の実現が期待できる。
ここでは操作対象物のある面を環境のある面に押しつける動作を、エンドエフェクタとしてコンプライアンス制御された多指ハンドを持つロボットアームに行わせる例を示す。図５および６はその制御ブロック図で、目標指令決定部１Ｂ又は２Ｂとコンプライアンス計算部４Ａ又は４Ｂと逆キネマティクス計算部５を備えたものである。押しつけ動作は、押しつける面同士が平行になるように操作対象物の姿勢を保ちながら環境へ接近させることで実現される。ここで操作対象物の回転に関するコンプライアンスが軟らかくなるように（１）式または（２）式のパラメータを設定することによって、押しつける環境と操作対象物との相対的な位置および姿勢が不確定な場合にも対象に倣う形で押しつけ動作が達成される。予想される環境面１６にコンプライアンス制御された多指ハンド１３によって把持された対象１４をロボットアーム１１によって押しつける作業において、予想される環境面１６と実際の環境面１５との誤差がある場合、図７のように目標とは異なる形で操作対象物１４と環境面１５の接触が生じる。操作対象物１４と環境面１５との接触によって生じる力とモーメントがハンドの力覚センサ１２によって計測され、制御システム内でコンプライアンス中心１７における力１９とモーメント２０へと変換され、（１）式または（２）式のＦとして利用される。ここで、コンプライアンス中心１７の回りの回転の仮想弾性係数Ｋを軟らかく設定しておけば、操作対象物は加わったモーメント２０の方向に回転し姿勢を変える。また、コンプライアンス中心１７の位置は設定されているＫと外力１８の平衡点へ移動する。このためパラメータの設置が適当ならば図８に示すように環境面１５に対して操作対象物１４の押しつけが達成される。
【０００６】
多指ハンドはアームと比較して外部からの力やモーメントに対し高い応答性を得られる。そのため多指ハンドのコンプライアンス制御を利用することにより、アームのみを用いた場合よりも環境の変化や誤差に対して高速かつ柔軟に対応することが可能である。
【０００７】
【発明が解決しようとする課題】
上述した従来の方法では、環境面の誤差の大部分をより応答性の高い多指ハンドで吸収することとなるため、押しつけ動作が終了した時点で図８のように多指ハンドの姿勢がハンドのベースに対して大きく傾く場合がある。このため、この後さらにハンドによって物体の位置姿勢を操作する場合に操作可能な範囲が限られてしまうという問題があった。これは多指ハンドに限らずコンプライアンス制御されたエンドフェクタを利用する場合に常に生じる問題である。また、目標姿勢からのずれが生じた状態で（２）式が成立するために外力と目標が一致しない。これらは多指ハンドに限らずコンプライスアンス制御されたエンドフェクタを持つアームを利用する場合に常に生じる問題である。
【０００９】
本発明の目的は、ロボットアームとコンプライアンス制御されたエンドエフェクタによる操作対象物の環境との接触を伴う動作において、操作対象物の姿勢が変化してもエンドエフェクタの位置や姿勢の偏りを小さくする、ロボットのコンプライアンスの制御方法およびロボットを提供することにある。
【００１０】
【課題を解決するための手段】
本発明の第１のロボットの制御方法は、アームの先端にエンドエフェクタが取り付けられたロボットの制御方法において、
該エンドエフェクタは該アーム先端からの位置あるいは姿勢を変更するための自由度を少なくとも１自由度持ち、それらの自由度のうち一つ以上は機械的あるいは制御によるコンプライアンスが付与されており、
外界からエンドエフェクタの操作対象物に加わる力である外力によって操作対象物の姿勢が変化するような動作を行う場合に、前記操作対象物の位置、姿勢の変化をエンドエフェクタで計測し、計測結果に基づいて、操作対象物の位置、姿勢が、エンドエフェクタの座標系での操作対象物の予め決められた位置、姿勢に保たれるようにアームの位置、姿勢を変更するものである。
【００１１】
したがって、コンプライアンス制御によって操作対象物が環境へ倣うようにエンドエフェクタが操作対象物に加わる外力にしたがって姿勢を変えるのと同時に、操作対象物にかかる外力が目標力と等しくなるようにアームがその位置、姿勢を変更するならば、図８のように操作対象物の姿勢変化によってエンドエフェクタの姿勢の偏った状態から、外力と目標力の等しい状態、すなわち図２のように操作対象物を操作しやすい姿勢になる。これによって、この後のエンドエフェクタによる操作対象物の正確な位置や姿勢の操作が容易になる。
本発明のロボットは、
多指ハンド、アーム先端にそれぞれ取り付けられた力覚センサと、
ハンドベース座標系での各指先端位置の目標指令と各指の力覚センサからの力情報に基づいてコンプライアンス計算を行い、各指先位置を決定するコンプライアンス計算部と、各指毎に逆キネマティクスを解き、前記各指先位置を関節角度指令に変換し、前記多指ハンドへ送る逆キネマティクス計算部を含むハンド制御部と、
操作対象物を環境に押しつける動作をロボットアームで行う場合、操作対象物のハンドベース座標系での目標位置と目標姿勢が動作開始時に与えられ、これら目標位置、目標姿勢と操作対象物の現在位置および現在姿勢から目標指令を作成し、動作時、ハンド制御部のコンプライアンス計算部において求められた、操作対象物のハンドベース座標系における位置、姿勢と予め与えられた操作対象物の目標位置、目標姿勢との差をとり、これをアームの座標系における値に変換してアームの目標位置、目標姿勢に加えて、これに基づいて目標指令を生成する目標指令決定部と、前記目標指令とアームの力覚センサからの力情報に基づいて、アームの目標位置、目標姿勢を計算するコンプライアンス計算部と、前記目標位置、目標姿勢を実現するアームの関節角度を求め、これをロボットアームへの指令とする位置制御を行う逆キネマティクス計算部を含むアーム制御部と
を有する。
【００１６】
【発明の実施の形態】
次に、本発明の実施の形態について図面を参照して説明する。
図１は本発明の一実施の形態のロボットのブロック図である。
これはコンプライアンス制御されたロボットアームの先端にコンプライアンス制御された多指ハンド８を取り付けたものである。アーム制御部では目標指令決定部１Ａがアーム先端を最終的な目標位置および姿勢へ移動させるための目標指令ｘｄを時系列的にコンプライアンス計算部２Ａへ渡す。コンプライアンス計算部２Ａではこの目標指令ｘｄと力覚センサ６からの力情報Ｆから特性方程式（１）に基づいてアーム先端の目標位置、姿勢を計算し、これを実現するアームの関節角度を逆キネマティクス計算部３で求め、これをロボットアームへの指令とする位置制御を行う。ハンド制御部も同様に操作対象物を把持するためのハンドベース座標系での各指先端位置の目標指令ｘｄと各指の力覚センサ７からの力情報に基づいてコンプライアンス計算部４Ａが協調も含めたコンプライアンス計算を行い、各指先位置ｘｄ'を決定する。これを逆キネマティクス計算部５で各指毎に逆キネマティクスを解き、関節角度指令θを多指ハンド８へ送る。
【００１７】
操作対象物を環境に押しつける動作をこのロボットアームで行う場合、本実施形態では予めハンドが操作対象物を最も動作しやすくなるような操作対象物のハンドベース座標系での目標位置、姿勢を動作開始時にアームの目標指令決定部１Ａに与え、この目標とアームの目標位置、姿勢、操作対象物の現在位置姿勢情報に基づいて目標指令ｘｄを作成する。動作時に、コンプライアンス計算部４Ａにおいて、各指の先端位置の情報より操作対象物のハンドベース座標系における位置、姿勢を計算する。本実施形態ではこの操作対象物の位置、姿勢情報をアームの目標指令決定部１Ａへ逐次送る。目標指令決定部１Ａではこの操作対象物の位置、姿勢と予め与えられた操作対象物の目標位置姿勢との差を取り、これをアームの座標系へ変換してアームの目標位置、姿勢へ加え、これに基づいて目標指令ｘｄを生成し、コンプライアンス計算部２Ａへ送る。これによって押しつけ動作中のハンドの最適な姿勢からのずれを補償するようにアームの位置、姿勢が制御される。
【００２３】
【発明の効果】
以上説明したように、本発明は下記のような効果がある。
請求項１と２の発明は、コンプライアンスを持つエンドエフェクタを先端に持つロボットアームを用いた操作対象物の環境への接触を伴う動作において、操作対象物の位置、姿勢の変化に合わせてアームの目標指令を変更するようにしたことにより、エンドエフェクタの最適な姿勢からの偏りを減少させ、その後のエンドエフェクタによる操作対象物の操作性を向上させることができるという効果がある。
【図面の簡単な説明】
【図１】本発明の第１の実施形態を示すブロック図である。
【図２】本発明を用いて押し付けが達成された時点でのアームとハンドの姿勢を示す図で
ある。
【図３】第１の従来例のブロック図である。
【図４】第２の従来例のブロック図である。
【図５】第３の従来例のブロック図である。
【図６】第４の従来例のブロック図である。
【図７】押しつけ動作時に操作対象物が環境と接触した時点での力関係を示す図である。
【図８】押しつけが達成された時点でのアームとバンドの姿勢を示す図である。
【符号の説明】
１Ａ、１Ｂ 目標指令決定部（アーム）
２Ａ、２Ｂ コンプライアンス計算部（アーム）
３ 逆キネマティクス計算部（アーム）
４Ａ、４Ｂ コンプライアンス計算部（ハンド）
５ 逆キネマティクス計算部（ハンド）
６，７ 力覚センサ
８ 多指ハンド
１１ ロボットアーム
１２ 力覚センサ
１３ 多指ハンド
１４ 操作対象物
１５ 実際の環境面
１６ 予想される環境面
１７ コンプライアンス制御中心
１８ 操作対象物が環境から受ける力
１９ コンプライアンス中心の受ける力
２０ コンプライナアンス中心の受けるモーメント
【発明の属する技術分野】
本発明は、コンプライアンスを持ったロボットアームとエンドエフェクタのコンプライアンス制御方法に関する。
【０００２】
【従来の技術】
ロボットによって対象物あるいは外界との物理的な接触を伴う作業を行う場合、エンドエフェクタ自体にコンプライアンスを持たせることが一般的である。この場合、エンドエフェクタにＲＣＣデバイスのような機械的なコンプライアンス機構を設ける、あるいはエンドエフェクタ自体をコンプライアンス制御する、あるいはロボットア−ムをコンプライアンスアンス制御することが考えられる。
ロボットアームのコンプライアンス制御とは、ロボットアーム先端の位置と姿勢、およびアーム先端にかかる力を用いて、ロボットの軟らかい動きをさせる力制御手法である。この手法は、弾性・粘性・慣性の各パラメータを仮想的に設定したモデルの運動をロボットの動きで実現するもので、パラメータの値を変えることによりロボットの見かけ上の応答特性を自由に設定することができる。コンプライアンス制御は、
【０００３】
【数１】
という特性方程式で表される。ここで、Ｍは仮想慣性係数、Ｄは仮想粘性係数、Ｋは仮想弾性係数、Ｆはアーム先端が受ける力、Ｆｄは目標力、ｘはアーム先端の現在位置、ｘｄは目標位置を表す。アーム先端に加わる外力Ｆを力センサによって計測し、（１）または（２）式を満足するようにロボットを制御する。一般によく利用される手法として、図３または図４に示すように、コンプライアンスのモデルにしたがってロボットが追従すべき値をコンプライアンス計算部２Ａまたは２Ｂで（１）または（２）式より求め、その位置に対応するロボットの各関節角度を逆キネマティクス計算部３によって求め、これをロボットへの位置指令とする制御方法がある。エンドエフェクタの一つとして多指ハンドを考えた場合、特開平５ー１７７５６６にて開示されているように、コンプライアンス制御を用いた協調制御により外乱が加わっても安定して把持できることが示されている。
【０００５】
物体の接触を伴う作業をロボットアームにより行う場合、アーム自体をコンプライアンス制御する手法やアーム先端にコンプライアンス制御されたツールを取り付ける手法およびそれらを組み合わせた手法を用いることにより、環境の誤差などを吸収し高精度な作業の実現が期待できる。
ここでは操作対象物のある面を環境のある面に押しつける動作を、エンドエフェクタとしてコンプライアンス制御された多指ハンドを持つロボットアームに行わせる例を示す。図５および６はその制御ブロック図で、目標指令決定部１Ｂ又は２Ｂとコンプライアンス計算部４Ａ又は４Ｂと逆キネマティクス計算部５を備えたものである。押しつけ動作は、押しつける面同士が平行になるように操作対象物の姿勢を保ちながら環境へ接近させることで実現される。ここで操作対象物の回転に関するコンプライアンスが軟らかくなるように（１）式または（２）式のパラメータを設定することによって、押しつける環境と操作対象物との相対的な位置および姿勢が不確定な場合にも対象に倣う形で押しつけ動作が達成される。予想される環境面１６にコンプライアンス制御された多指ハンド１３によって把持された対象１４をロボットアーム１１によって押しつける作業において、予想される環境面１６と実際の環境面１５との誤差がある場合、図７のように目標とは異なる形で操作対象物１４と環境面１５の接触が生じる。操作対象物１４と環境面１５との接触によって生じる力とモーメントがハンドの力覚センサ１２によって計測され、制御システム内でコンプライアンス中心１７における力１９とモーメント２０へと変換され、（１）式または（２）式のＦとして利用される。ここで、コンプライアンス中心１７の回りの回転の仮想弾性係数Ｋを軟らかく設定しておけば、操作対象物は加わったモーメント２０の方向に回転し姿勢を変える。また、コンプライアンス中心１７の位置は設定されているＫと外力１８の平衡点へ移動する。このためパラメータの設置が適当ならば図８に示すように環境面１５に対して操作対象物１４の押しつけが達成される。
【０００６】
多指ハンドはアームと比較して外部からの力やモーメントに対し高い応答性を得られる。そのため多指ハンドのコンプライアンス制御を利用することにより、アームのみを用いた場合よりも環境の変化や誤差に対して高速かつ柔軟に対応することが可能である。
【０００７】
【発明が解決しようとする課題】
上述した従来の方法では、環境面の誤差の大部分をより応答性の高い多指ハンドで吸収することとなるため、押しつけ動作が終了した時点で図８のように多指ハンドの姿勢がハンドのベースに対して大きく傾く場合がある。このため、この後さらにハンドによって物体の位置姿勢を操作する場合に操作可能な範囲が限られてしまうという問題があった。これは多指ハンドに限らずコンプライアンス制御されたエンドフェクタを利用する場合に常に生じる問題である。また、目標姿勢からのずれが生じた状態で（２）式が成立するために外力と目標が一致しない。これらは多指ハンドに限らずコンプライスアンス制御されたエンドフェクタを持つアームを利用する場合に常に生じる問題である。
【０００９】
本発明の目的は、ロボットアームとコンプライアンス制御されたエンドエフェクタによる操作対象物の環境との接触を伴う動作において、操作対象物の姿勢が変化してもエンドエフェクタの位置や姿勢の偏りを小さくする、ロボットのコンプライアンスの制御方法およびロボットを提供することにある。
【００１０】
【課題を解決するための手段】
本発明の第１のロボットの制御方法は、アームの先端にエンドエフェクタが取り付けられたロボットの制御方法において、
該エンドエフェクタは該アーム先端からの位置あるいは姿勢を変更するための自由度を少なくとも１自由度持ち、それらの自由度のうち一つ以上は機械的あるいは制御によるコンプライアンスが付与されており、
外界からエンドエフェクタの操作対象物に加わる力である外力によって操作対象物の姿勢が変化するような動作を行う場合に、前記操作対象物の位置、姿勢の変化をエンドエフェクタで計測し、計測結果に基づいて、操作対象物の位置、姿勢が、エンドエフェクタの座標系での操作対象物の予め決められた位置、姿勢に保たれるようにアームの位置、姿勢を変更するものである。
【００１１】
したがって、コンプライアンス制御によって操作対象物が環境へ倣うようにエンドエフェクタが操作対象物に加わる外力にしたがって姿勢を変えるのと同時に、操作対象物にかかる外力が目標力と等しくなるようにアームがその位置、姿勢を変更するならば、図８のように操作対象物の姿勢変化によってエンドエフェクタの姿勢の偏った状態から、外力と目標力の等しい状態、すなわち図２のように操作対象物を操作しやすい姿勢になる。これによって、この後のエンドエフェクタによる操作対象物の正確な位置や姿勢の操作が容易になる。
本発明のロボットは、
多指ハンド、アーム先端にそれぞれ取り付けられた力覚センサと、
ハンドベース座標系での各指先端位置の目標指令と各指の力覚センサからの力情報に基づいてコンプライアンス計算を行い、各指先位置を決定するコンプライアンス計算部と、各指毎に逆キネマティクスを解き、前記各指先位置を関節角度指令に変換し、前記多指ハンドへ送る逆キネマティクス計算部を含むハンド制御部と、
操作対象物を環境に押しつける動作をロボットアームで行う場合、操作対象物のハンドベース座標系での目標位置と目標姿勢が動作開始時に与えられ、これら目標位置、目標姿勢と操作対象物の現在位置および現在姿勢から目標指令を作成し、動作時、ハンド制御部のコンプライアンス計算部において求められた、操作対象物のハンドベース座標系における位置、姿勢と予め与えられた操作対象物の目標位置、目標姿勢との差をとり、これをアームの座標系における値に変換してアームの目標位置、目標姿勢に加えて、これに基づいて目標指令を生成する目標指令決定部と、前記目標指令とアームの力覚センサからの力情報に基づいて、アームの目標位置、目標姿勢を計算するコンプライアンス計算部と、前記目標位置、目標姿勢を実現するアームの関節角度を求め、これをロボットアームへの指令とする位置制御を行う逆キネマティクス計算部を含むアーム制御部と
を有する。
【００１６】
【発明の実施の形態】
次に、本発明の実施の形態について図面を参照して説明する。
図１は本発明の一実施の形態のロボットのブロック図である。
これはコンプライアンス制御されたロボットアームの先端にコンプライアンス制御された多指ハンド８を取り付けたものである。アーム制御部では目標指令決定部１Ａがアーム先端を最終的な目標位置および姿勢へ移動させるための目標指令ｘｄを時系列的にコンプライアンス計算部２Ａへ渡す。コンプライアンス計算部２Ａではこの目標指令ｘｄと力覚センサ６からの力情報Ｆから特性方程式（１）に基づいてアーム先端の目標位置、姿勢を計算し、これを実現するアームの関節角度を逆キネマティクス計算部３で求め、これをロボットアームへの指令とする位置制御を行う。ハンド制御部も同様に操作対象物を把持するためのハンドベース座標系での各指先端位置の目標指令ｘｄと各指の力覚センサ７からの力情報に基づいてコンプライアンス計算部４Ａが協調も含めたコンプライアンス計算を行い、各指先位置ｘｄ'を決定する。これを逆キネマティクス計算部５で各指毎に逆キネマティクスを解き、関節角度指令θを多指ハンド８へ送る。
【００１７】
操作対象物を環境に押しつける動作をこのロボットアームで行う場合、本実施形態では予めハンドが操作対象物を最も動作しやすくなるような操作対象物のハンドベース座標系での目標位置、姿勢を動作開始時にアームの目標指令決定部１Ａに与え、この目標とアームの目標位置、姿勢、操作対象物の現在位置姿勢情報に基づいて目標指令ｘｄを作成する。動作時に、コンプライアンス計算部４Ａにおいて、各指の先端位置の情報より操作対象物のハンドベース座標系における位置、姿勢を計算する。本実施形態ではこの操作対象物の位置、姿勢情報をアームの目標指令決定部１Ａへ逐次送る。目標指令決定部１Ａではこの操作対象物の位置、姿勢と予め与えられた操作対象物の目標位置姿勢との差を取り、これをアームの座標系へ変換してアームの目標位置、姿勢へ加え、これに基づいて目標指令ｘｄを生成し、コンプライアンス計算部２Ａへ送る。これによって押しつけ動作中のハンドの最適な姿勢からのずれを補償するようにアームの位置、姿勢が制御される。
【００２３】
【発明の効果】
以上説明したように、本発明は下記のような効果がある。
請求項１と２の発明は、コンプライアンスを持つエンドエフェクタを先端に持つロボットアームを用いた操作対象物の環境への接触を伴う動作において、操作対象物の位置、姿勢の変化に合わせてアームの目標指令を変更するようにしたことにより、エンドエフェクタの最適な姿勢からの偏りを減少させ、その後のエンドエフェクタによる操作対象物の操作性を向上させることができるという効果がある。
【図面の簡単な説明】
【図１】本発明の第１の実施形態を示すブロック図である。
【図２】本発明を用いて押し付けが達成された時点でのアームとハンドの姿勢を示す図で
ある。
【図３】第１の従来例のブロック図である。
【図４】第２の従来例のブロック図である。
【図５】第３の従来例のブロック図である。
【図６】第４の従来例のブロック図である。
【図７】押しつけ動作時に操作対象物が環境と接触した時点での力関係を示す図である。
【図８】押しつけが達成された時点でのアームとバンドの姿勢を示す図である。
【符号の説明】
１Ａ、１Ｂ 目標指令決定部（アーム）
２Ａ、２Ｂ コンプライアンス計算部（アーム）
３ 逆キネマティクス計算部（アーム）
４Ａ、４Ｂ コンプライアンス計算部（ハンド）
５ 逆キネマティクス計算部（ハンド）
６，７ 力覚センサ
８ 多指ハンド
１１ ロボットアーム
１２ 力覚センサ
１３ 多指ハンド
１４ 操作対象物
１５ 実際の環境面
１６ 予想される環境面
１７ コンプライアンス制御中心
１８ 操作対象物が環境から受ける力
１９ コンプライアンス中心の受ける力
２０ コンプライナアンス中心の受けるモーメント
Claims (2)
- アームの先端にエンドエフェクタが取り付けられたロボットの制御方法において、
該エンドエフェクタは該アーム先端からの位置あるいは姿勢を変更するための自由度を少なくとも１自由度持ち、それらの自由度のうち一つ以上は機械的あるいは制御によるコンプライアンスが付与されており、
外界からエンドエフェクタの操作対象物に加わる力である外力によって該操作対象物の姿勢が変化するような動作を行う場合に、前記操作対象物の位置、姿勢の変化をエンドエフェクタで計測し、計測結果に基づいて、前記操作対象物の位置、姿勢が、前記エンドエフェクタの座標系での前記操作対象物の予め決められた位置、姿勢に保たれるように前記アームの位置、姿勢を変更することを特徴とする、ロボットの制御方法。 - アームの先端にコンプライアンス制御された多指ハンドが取り付けられたロボットにおいて、
多指ハンド、アーム先端にそれぞれ取り付けられた力覚センサと、
ハンドベース座標系での各指先端位置の目標指令と各指の前記力覚センサからの力情報に基づいてコンプライアンス計算を行い、各指先位置を決定するコンプライアンス計算部と、各指毎に逆キネマティクスを解き、前記各指先位置を関節角度指令に変換し、前記多指ハンドへ送る逆キネマティクス計算部を含むハンド制御部と、
操作対象物を環境に押しつける動作をロボットアームで行う場合、前記操作対象物のハンドベース座標系での目標位置と目標姿勢が動作開始時に与えられ、これら目標位置、目標姿勢と操作作対象物の現在位置および現在姿勢から目標指令を作成し、動作時、前記ハンド制御部のコンプライアンス計算部において求められた、操作対象物のハンドベース座標系における位置、姿勢と予め与えられた操作対象物の目標位置、目標姿勢との差をとり、これを前記アームの座標系における値に変換して前記アームの目標位置、目標姿勢に加えて、これに基づいて目標指令を生成する目標指令決定部と、前記目標指令と前記アームの前記力覚センサからの力情報に基づいて、前記アームの目標位置、目標姿勢を計算するコンプライアンス計算部と、前記目標位置、目標姿勢を実現するアームの関節角度を求め、これをロボットアームへの指令とする位置制御を行う逆キネマティクス計算部を含むアーム制御部と
を有することを特徴とするロボット。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP19429397A JP3937108B2 (ja) | 1997-07-18 | 1997-07-18 | ロボットの制御方法およびロボット |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP19429397A JP3937108B2 (ja) | 1997-07-18 | 1997-07-18 | ロボットの制御方法およびロボット |
Related Child Applications (2)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2006028773A Division JP2006137001A (ja) | 2006-02-06 | 2006-02-06 | 把持物体の位置、姿勢修正方法 |
| JP2006229656A Division JP2006341372A (ja) | 2006-08-25 | 2006-08-25 | ロボットの制御方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH1133952A JPH1133952A (ja) | 1999-02-09 |
| JP3937108B2 true JP3937108B2 (ja) | 2007-06-27 |
Family
ID=16322192
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP19429397A Expired - Fee Related JP3937108B2 (ja) | 1997-07-18 | 1997-07-18 | ロボットの制御方法およびロボット |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3937108B2 (ja) |
Families Citing this family (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2020194393A1 (ja) * | 2019-03-22 | 2020-10-01 | オムロン株式会社 | ロボットハンド、ロボットハンド制御方法及びプログラム |
| CN112109074A (zh) * | 2020-02-21 | 2020-12-22 | 深圳市三宝创新智能有限公司 | 一种机器人目标图像抓取方法 |
| CN111452048B (zh) * | 2020-04-09 | 2023-06-02 | 亚新科国际铸造（山西）有限公司 | 多机器人相对空间位置关系的标定方法和装置 |
| CN112223788B (zh) * | 2020-09-08 | 2022-02-01 | 武汉大学 | 纤维自动铺放系统以及其铺放轨迹的规划方法 |
| CN112754616B (zh) * | 2020-12-30 | 2022-05-10 | 诺创智能医疗科技(杭州)有限公司 | 超声定位穿刺系统和存储介质 |
| CN113974874B (zh) * | 2021-10-28 | 2023-03-24 | 杭州柳叶刀机器人有限公司 | 机械臂自动定位方法、装置、终端设备和可读存储介质 |
| CN114473999B (zh) * | 2022-01-14 | 2023-09-29 | 浙江工业大学 | 一种自动换输液瓶的智能服务机器人系统 |
-
1997
- 1997-07-18 JP JP19429397A patent/JP3937108B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH1133952A (ja) | 1999-02-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US8909376B2 (en) | Robot hand and method of controlling the same | |
| JP7427358B2 (ja) | ロボットシステム、物品の製造方法、制御方法、制御プログラム、および記録媒体 | |
| EP1645374B1 (en) | Gripping hand with strain detecting means for adjusting its gripping force | |
| JP6484265B2 (ja) | 学習制御機能を備えたロボットシステム及び学習制御方法 | |
| JP6044511B2 (ja) | ロボットの制御方法及びロボットシステム | |
| Su et al. | Robust grasping for an under-actuated anthropomorphic hand under object position uncertainty | |
| JP3937108B2 (ja) | ロボットの制御方法およびロボット | |
| JP2024015086A (ja) | ロボットシステム、制御方法、物品の製造方法、制御プログラム、記録媒体 | |
| JP3369351B2 (ja) | 多関節マニピュレータの弾性設定方法および制御装置 | |
| JP2006341372A (ja) | ロボットの制御方法 | |
| JP3884249B2 (ja) | 人間型ハンドロボット用教示システム | |
| JP2021045810A (ja) | モーション情報生成装置、エンドエフェクタ、ロボット及びロボットシステム | |
| JP6322948B2 (ja) | ロボット制御装置、ロボットシステム、ロボット、ロボット制御方法、及びプログラム | |
| JP2005144573A (ja) | ロボットハンドの把持力制御方法 | |
| JPH05337860A (ja) | ロボットハンドの教示装置およびロボットハンド | |
| JPH06339885A (ja) | ロボットのコンプライアンス制御方法 | |
| JP4206305B2 (ja) | 多指ロボットハンドの制御方法及び装置 | |
| JPS6149075B2 (ja) | ||
| JPH06312392A (ja) | 多関節ロボットの制御装置 | |
| JP2737325B2 (ja) | ロボットの軌道生成方式 | |
| CN116852397B (zh) | 负压理疗机器人理疗力度及理疗路径的自适应调节方法 | |
| JP2583272B2 (ja) | ロボットの制御装置 | |
| JPH09225871A (ja) | ロボットのコンプライアンス制御方法 | |
| JP2011240418A (ja) | マニピュレータの制御装置 | |
| JPH058187A (ja) | ロボツト |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040618 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20051019 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20051207 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060206 |
|
| RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20060206 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060628 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060825 |
|
| 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: 20070228 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070313 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100406 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110406 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120406 Year of fee payment: 5 |
|
| LAPS | Cancellation because of no payment of annual fees |