JP3331674B2 - ７軸多関節ロボットマニピュレータの肘回転方法 - Google Patents
７軸多関節ロボットマニピュレータの肘回転方法Info
- Publication number
- JP3331674B2 JP3331674B2 JP13136893A JP13136893A JP3331674B2 JP 3331674 B2 JP3331674 B2 JP 3331674B2 JP 13136893 A JP13136893 A JP 13136893A JP 13136893 A JP13136893 A JP 13136893A JP 3331674 B2 JP3331674 B2 JP 3331674B2
- Authority
- JP
- Japan
- Prior art keywords
- axis
- manipulator
- robot manipulator
- elbow
- angle
- 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
Links
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Description
【０００１】
【産業上の利用分野】本発明は宇宙、深海、原子力発電
所あるいは一般産業における７軸関節型ロボットマニピ
ュレータの肘回転方法に関するものである。
所あるいは一般産業における７軸関節型ロボットマニピ
ュレータの肘回転方法に関するものである。
【０００２】
【従来の技術】従来の６軸関節型ロボットマニピュレー
タに、さらにもう１軸追加し人間の腕に似せた７軸関節
型ロボットマニピュレータ（図４参照）は、作業中先端
の制御点での位置・姿勢を変化させないで、肘部分のみ
回転させるという動作が可能である。
タに、さらにもう１軸追加し人間の腕に似せた７軸関節
型ロボットマニピュレータ（図４参照）は、作業中先端
の制御点での位置・姿勢を変化させないで、肘部分のみ
回転させるという動作が可能である。
【０００３】
【発明が解決しようとする課題】しかしながら、６軸関
節型ロボットマニピュレータと異なり、冗長軸があるた
め、先端の制御点での位置・姿勢がきまっても角関節軸
の角度は一義的に決まらないため、制御方法に工夫が必
要である。本出願人は先に、特願平３−２８６６６５、
特願平４−７０３２５、特願平４−１１０７７３号等を
提案しているが、演算が複雑である等の不具合がある。
そこで、本発明は、先端制御点の位置・姿勢を元のまま
で肘を回転させる効率的な方法を提供することを目的と
するものである。
節型ロボットマニピュレータと異なり、冗長軸があるた
め、先端の制御点での位置・姿勢がきまっても角関節軸
の角度は一義的に決まらないため、制御方法に工夫が必
要である。本出願人は先に、特願平３−２８６６６５、
特願平４−７０３２５、特願平４−１１０７７３号等を
提案しているが、演算が複雑である等の不具合がある。
そこで、本発明は、先端制御点の位置・姿勢を元のまま
で肘を回転させる効率的な方法を提供することを目的と
するものである。
【０００４】
【課題を解決するための手段】７軸多関節型ロボットマ
ニピュレータの肘を回転するには次のようにして行う。 （１）マニピュレータの先端に置ける制御点とマニピュ
レータの肩の線を回転軸に選択する。 （２）７軸多関節型ロボットマニピュレータの７軸を固
定して６軸ロボットマニピュレータとして考える。 （３）６軸ロボットマニピュレータを先の回転軸回りに
微小角度だけ回転させる。このための軸角度の逆変換の
計算で求める。 （４）この回転によって制御点での姿勢のみ微小な変化
を生ずる来すのでこれを修正する。 （５）第一軸を除く先端からの６軸をとって６軸ロボッ
トマニピュレータを想定する。 （６）最初の制御点での姿勢に肘回転後の制御点の姿勢
を合わせるための逆変換の計算を行い先端６軸の角度を
求める。 （７）以上でもって肘を微小角度だけ回転させる関節角
度が求められる。 （８）（２）に戻ってこの計算を繰り返せばさらに肘が
回転する軸角度が次々にもとまる。
ニピュレータの肘を回転するには次のようにして行う。 （１）マニピュレータの先端に置ける制御点とマニピュ
レータの肩の線を回転軸に選択する。 （２）７軸多関節型ロボットマニピュレータの７軸を固
定して６軸ロボットマニピュレータとして考える。 （３）６軸ロボットマニピュレータを先の回転軸回りに
微小角度だけ回転させる。このための軸角度の逆変換の
計算で求める。 （４）この回転によって制御点での姿勢のみ微小な変化
を生ずる来すのでこれを修正する。 （５）第一軸を除く先端からの６軸をとって６軸ロボッ
トマニピュレータを想定する。 （６）最初の制御点での姿勢に肘回転後の制御点の姿勢
を合わせるための逆変換の計算を行い先端６軸の角度を
求める。 （７）以上でもって肘を微小角度だけ回転させる関節角
度が求められる。 （８）（２）に戻ってこの計算を繰り返せばさらに肘が
回転する軸角度が次々にもとまる。
【０００５】
【作用】上記の方法により、７軸多関節型ロボットマニ
ピュレータの肘回転が、制御点での位置姿勢を元のまま
に保って可能になる。
ピュレータの肘回転が、制御点での位置姿勢を元のまま
に保って可能になる。
【０００６】
【実施例】以下、本発明の実施例を詳細に説明する。７
軸関節型ロボットマニピュレータの最初のジョイントの
角度を｛ 0ｑi ｝とし、先端制御点の微小な位置・姿勢
変化と各軸の微小角度の関係は次のように表される。
軸関節型ロボットマニピュレータの最初のジョイントの
角度を｛ 0ｑi ｝とし、先端制御点の微小な位置・姿勢
変化と各軸の微小角度の関係は次のように表される。
【０００７】
【数１】
【０００８】ただし、 Δｒ：作業空間における制御点での微小位置変化 Δω：作業空間における制御点での微小姿勢変化 ｚi ：ＤＨモデルにおけるｉ軸の回転軸方向ベクトル ｈi ：ＤＨモデルにおけるｉ軸回転軸位置から制御点に
到るベクトル Δｑ：ロボットマニピュレータの微小回転角度ベクトル
［Δｑ1 Δｑ2 …Δｑ7］T
到るベクトル Δｑ：ロボットマニピュレータの微小回転角度ベクトル
［Δｑ1 Δｑ2 …Δｑ7］T
【０００９】ロボットマニピュレータの肩の位置から制
御点に向かう単位回転軸ベクトルｋとする（図１参
照）。この軸回りにΔθだけ回転することを考える。制
御点位置は不変で姿勢のみ変化するので、この変化は次
のように示される。 ［ΔｒT ΔωT ］T ＝［０T ［Δθ＊ｋ］T ］T （２） なお、 ［ΔｒT ΔωT ］T ＝［０T ０T ］T として
（１）式の左辺に代入して、肘を回転するような解を見
つけることが前述の特願平４−７０３２５の方法であっ
た。本発明の方法は（１）式を次のように分解する。
御点に向かう単位回転軸ベクトルｋとする（図１参
照）。この軸回りにΔθだけ回転することを考える。制
御点位置は不変で姿勢のみ変化するので、この変化は次
のように示される。 ［ΔｒT ΔωT ］T ＝［０T ［Δθ＊ｋ］T ］T （２） なお、 ［ΔｒT ΔωT ］T ＝［０T ０T ］T として
（１）式の左辺に代入して、肘を回転するような解を見
つけることが前述の特願平４−７０３２５の方法であっ
た。本発明の方法は（１）式を次のように分解する。
【００１０】
【数２】
【００１１】ただしｑ7 は固定。ベクトルΔｑは［Δｑ
1 ，Δｑ2 ，…，Δｑ6 ］T である（図２参照）。
1 ，Δｑ2 ，…，Δｑ6 ］T である（図２参照）。
【００１２】
【数３】
【００１３】ただしｑ1 は固定。ベクトルΔｑは［Δｑ
2 ，Δｑ3 ，…，Δｑ7 ］T である（図３参照）。
（４）式において（２）式の値をいれてΔｑ1 の値を求
める。Δｑ7 ＝０として新たなｑを求める。 ｑi ＝ｑi ＋Δｑi （ｉ＝１，２，…，７） （５） この値を使って｛ｚi ｝と｛ｈi ｝を求める。そして
（４）式に代入する。そこで新たに次式を計算する。 ［ΔｒT ΔωT ］T ＝［０T −［Δθ＊ｋ］T ］T （６） この意味は、肘回転によって制御点での姿勢変化を元に
戻すことを意味している。（６）を（４）に代入しこの
式を解くことによってΔｑi を求める。Δｑi＝０とし
て 1ｑi を求める。 1ｑi ＝ｑi ＋Δｑi （ｉ＝１，２，…，７） （７） 以上の計算によって得られる｛ 1ｑi ｝はマニピュレー
タを回転軸ｋの回りに角度Δθだけ回転した場合に得ら
れる関節角度である。このことを繰り返せばマニピュレ
ータの肘は制御点での位置と姿勢を元のまま保った可能
な限り回転する。
2 ，Δｑ3 ，…，Δｑ7 ］T である（図３参照）。
（４）式において（２）式の値をいれてΔｑ1 の値を求
める。Δｑ7 ＝０として新たなｑを求める。 ｑi ＝ｑi ＋Δｑi （ｉ＝１，２，…，７） （５） この値を使って｛ｚi ｝と｛ｈi ｝を求める。そして
（４）式に代入する。そこで新たに次式を計算する。 ［ΔｒT ΔωT ］T ＝［０T −［Δθ＊ｋ］T ］T （６） この意味は、肘回転によって制御点での姿勢変化を元に
戻すことを意味している。（６）を（４）に代入しこの
式を解くことによってΔｑi を求める。Δｑi＝０とし
て 1ｑi を求める。 1ｑi ＝ｑi ＋Δｑi （ｉ＝１，２，…，７） （７） 以上の計算によって得られる｛ 1ｑi ｝はマニピュレー
タを回転軸ｋの回りに角度Δθだけ回転した場合に得ら
れる関節角度である。このことを繰り返せばマニピュレ
ータの肘は制御点での位置と姿勢を元のまま保った可能
な限り回転する。
【００１４】（３）または（４）式を解くことは６元の
連立方程式を解くことである。ロボットマニピュレータ
の形態が特異点状態に入るとマトリクスが縮退して解け
なくなることがある。この場合、制御点の位置あるいは
姿勢を多少犠牲にして解を求めることが必要になること
がある。従って事前にシミュレータでもってこのような
動作が可能であることを確認しておくことが必要であ
る。以上の説明では７軸多関節ロボットマニピュレータ
の関節は回転軸のみとしてのみ説明したがスライド軸を
中心に含む場合でも同様な論法で可能であることは言う
までもない。ただし、この場合、機構的に肘回転が実現
不可能となる制約が多くなることは言うまでもなく、人
間腕型７軸多関節ロボットマニピュレータではスライド
軸は採用されないことが多い。
連立方程式を解くことである。ロボットマニピュレータ
の形態が特異点状態に入るとマトリクスが縮退して解け
なくなることがある。この場合、制御点の位置あるいは
姿勢を多少犠牲にして解を求めることが必要になること
がある。従って事前にシミュレータでもってこのような
動作が可能であることを確認しておくことが必要であ
る。以上の説明では７軸多関節ロボットマニピュレータ
の関節は回転軸のみとしてのみ説明したがスライド軸を
中心に含む場合でも同様な論法で可能であることは言う
までもない。ただし、この場合、機構的に肘回転が実現
不可能となる制約が多くなることは言うまでもなく、人
間腕型７軸多関節ロボットマニピュレータではスライド
軸は採用されないことが多い。
【００１５】
【発明の効果】以上に述べたように、本発明によれば、
７軸多関節型のロボットマニピュレータの肘回転によっ
て、障害物の回避あるいは場合によって肘関節の回転に
よって制御点での取りうる動作範囲が広くなるという効
果がある。
７軸多関節型のロボットマニピュレータの肘回転によっ
て、障害物の回避あるいは場合によって肘関節の回転に
よって制御点での取りうる動作範囲が広くなるという効
果がある。
【図１】７軸多関節ロボットマニピュレータの制御点、
肩の点、肘回転軸ベクトルｋを示す図
肩の点、肘回転軸ベクトルｋを示す図
【図２】７軸目を固定した場合のベクトルｈi とｚi を
示す図
示す図
【図３】１軸目を固定した場合のベクトルｈi とｚi を
示す図
示す図
【図４】７軸多関節ロボットマニピュレータの例を示す
図
図
【数２】
【数２】
───────────────────────────────────────────────────── フロントページの続き (56)参考文献 特開 平２−269586（ＪＰ，Ａ) 特開 平１−267706（ＪＰ，Ａ) 特開 昭62−251901（ＪＰ，Ａ) 特開 平３−217906（ＪＰ，Ａ) 特開 昭64−8407（ＪＰ，Ａ) (58)調査した分野(Int.Cl.7，ＤＢ名) B25J 9/10 G05B 19/18
Claims (2)
- 【請求項１】 ７軸多関節型ロボットマニピュレータに
おいて、マニピュレータの肩の点と前記制御点を結ぶ回
転軸を想定し、 ７軸多関節型ロボットマニピュレータの第７軸を固定し
て根本の第１軸から６軸をとった疑似６軸ロボットマニ
ピュレータを仮想し、 その疑似６軸ロボットマニピュレータを前記回転軸回り
に微小角度だけ回転させるための軸角度を逆変換の計算
で求め、 この回転によって制御点での姿勢にずれが生ずるのでこ
れを補正し、 第一軸を除く先端からの６軸をとって疑似６軸ロボット
マニピュレータを仮想し、 最初の制御点での姿勢に肘回転後の制御点の姿勢を合わ
せるための逆変換の計算を行い先端６軸の角度を求め、 以上により求まった７軸の軸角度を指令軸角度として動
作させることにより前記回転軸のまわりに先端制御点で
の位置・姿勢を変化させないでマニピュレータの肘部分
を微小角度だけ回転させることを特徴とする７軸多関節
ロボットマニピュレータの肘回転方法。 - 【請求項２】 ７軸多関節型ロボットマニピュレータに
おいて、先端制御点での位置・姿勢を変化させないでマ
ニピュレータの肩の点と前記制御点を結ぶ回転軸（ｋ）
のまわりにマニピュレータの肘部分を微小角度（Δθ）
だけ回転させるために、最小のジョイント角度を｛ 0ｑ
i ｝として、まず７軸目を固定した擬似６軸ロボットマ
ニピュレータのヤコビアン方程式 ［０T ［Δθ＊ｋ］T ］T ＝ＪB ＊［Δｑ1 Δｑ2 …
Δｑ6 ］T を解いてマニピュレータの各ジョイント微小角度（Δｑ
i ｉ＝１，２，…，６；Δｑ7 ＝０）を求め、次に、 ｑi ＝ｑi ＋Δｑi （ｉ＝１，２，…，７） により各ジョイントの角度をもとめ、この角度を用いて
マニピュレータの先端６軸よりなる疑似６軸ロボットマ
ニピュレータのヤコビアン方程式 ［０T −［Δθ＊ｋ］T ］T ＝ＪF ＊［Δｑ2 Δ
ｑ3 ．．．Δｑ7 ］T を解いてマニピュレータの各ジョイント微小角度（Δｑ
1 ｉ＝２，３，…，７；Δｑ1 ＝０）を求め、1 ｑi ＝ｑi ＋Δｑi （ｉ＝１，２，…，７） として最終的なジョイント角度｛ 1ｑi ｝を求め、Δθ
の回転を実現するために最初のジョイント角度
｛ 0ｑi ｝に微小角度｛ 1ｑi − 0ｑi ｝を加えること
によって肘回転を行うことを特徴とする７軸多関節ロボ
ットマニピュレータの肘回転方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP13136893A JP3331674B2 (ja) | 1993-05-07 | 1993-05-07 | ７軸多関節ロボットマニピュレータの肘回転方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP13136893A JP3331674B2 (ja) | 1993-05-07 | 1993-05-07 | ７軸多関節ロボットマニピュレータの肘回転方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH06315880A JPH06315880A (ja) | 1994-11-15 |
| JP3331674B2 true JP3331674B2 (ja) | 2002-10-07 |
Family
ID=15056302
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP13136893A Expired - Lifetime JP3331674B2 (ja) | 1993-05-07 | 1993-05-07 | ７軸多関節ロボットマニピュレータの肘回転方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3331674B2 (ja) |
Families Citing this family (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3207728B2 (ja) * | 1995-10-11 | 2001-09-10 | 三菱重工業株式会社 | 冗長マニピュレータの制御方法 |
| JP2010036293A (ja) * | 2008-08-04 | 2010-02-18 | Jtekt Corp | 多関節ロボット |
| CN102811843A (zh) * | 2010-09-03 | 2012-12-05 | Abb研究有限公司 | 工业机器人、用于该工业机器人的组件系统以及用于组装该工业机器人的方法 |
| JP5948932B2 (ja) * | 2012-02-16 | 2016-07-06 | セイコーエプソン株式会社 | ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム |
| CN102672720B (zh) * | 2012-05-31 | 2014-12-03 | 中国航天科技集团公司第五研究院第五一三研究所 | 一种三关节机械臂的控制方法 |
| KR102109594B1 (ko) * | 2012-08-15 | 2020-05-12 | 인튜어티브 서지컬 오퍼레이션즈 인코포레이티드 | 영-공간을 이용하여 조인트 운동을 상쇄하기 위한 시스템 및 방법 |
| JP2015037818A (ja) * | 2013-08-17 | 2015-02-26 | セイコーエプソン株式会社 | ロボット、ロボットの制御方法、プログラム及び経路作成装置 |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS62251901A (ja) * | 1986-04-25 | 1987-11-02 | Fanuc Ltd | 多軸ロボツトの経路制御装置 |
| JPH0820894B2 (ja) * | 1987-07-01 | 1996-03-04 | 株式会社日立製作所 | 産業用ロボツトの動作制御方法 |
| JPH01267706A (ja) * | 1988-04-19 | 1989-10-25 | Toyoda Mach Works Ltd | ロボットの制御方法 |
| JPH02269586A (ja) * | 1989-04-11 | 1990-11-02 | Toshiba Corp | マニピュレータ駆動制御装置 |
| JP2874238B2 (ja) * | 1990-01-23 | 1999-03-24 | 株式会社安川電機 | 多関節形ロボットの制御方法 |
-
1993
- 1993-05-07 JP JP13136893A patent/JP3331674B2/ja not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| JPH06315880A (ja) | 1994-11-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3207728B2 (ja) | 冗長マニピュレータの制御方法 | |
| JP5114019B2 (ja) | エフェクタの軌道を制御するための方法 | |
| US8560122B2 (en) | Teaching and playback method based on control of redundancy resolution for robot and computer-readable medium controlling the same | |
| JPH0282302A (ja) | ロボット制御装置 | |
| EP0402788B1 (en) | Method of controlling robot movements | |
| US7248012B2 (en) | Teaching data preparing method for articulated robot | |
| WO1999033617A1 (fr) | Structure de bras pour robots de travail a morphologie de type humain | |
| Aboaf et al. | Living with the singularity of robot wrists | |
| JP3331674B2 (ja) | ７軸多関節ロボットマニピュレータの肘回転方法 | |
| JPS6126106A (ja) | 工具位置補正方式 | |
| WO1990002028A1 (en) | Vertical articulated robot | |
| JPS62194513A (ja) | ロボツトの円弧補間姿勢制御装置 | |
| JP2979552B2 (ja) | ロボットの制御方法 | |
| JPH05177563A (ja) | マスタスレーブマニピュレータの制御方法 | |
| CN112917479A (zh) | 五轴机器人的近似位姿计算方法、装置和存储介质 | |
| JPH0647689A (ja) | 多関節形ロボットの制御方法 | |
| JP3146463B2 (ja) | 冗長軸マニピュレータの肘移動制御装置 | |
| JPH07200018A (ja) | ロボットの制御装置 | |
| JP2676721B2 (ja) | 多関節型ロボットの制御装置 | |
| JPH0355182A (ja) | 多関節ロボット | |
| Chandra et al. | Dual-arm coordination using dual quaternions and virtual mechanisms | |
| JP3402378B2 (ja) | ７軸マニピュレータの制御方法 | |
| Bastawade et al. | Geometrical modelling of kinematics of articulated robotic arm | |
| JP2576176B2 (ja) | ロボットの制御方法 | |
| Potkonjak et al. | Improvement of dynamic capabilities of heavy robots |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080726 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090726 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090726 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100726 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100726 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110726 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120726 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130726 Year of fee payment: 11 |
|
| EXPY | Cancellation because of completion of term |