JP2011131326A - ロボットアームの干渉回避方法 - Google Patents
ロボットアームの干渉回避方法 Download PDFInfo
- Publication number
- JP2011131326A JP2011131326A JP2009292824A JP2009292824A JP2011131326A JP 2011131326 A JP2011131326 A JP 2011131326A JP 2009292824 A JP2009292824 A JP 2009292824A JP 2009292824 A JP2009292824 A JP 2009292824A JP 2011131326 A JP2011131326 A JP 2011131326A
- Authority
- JP
- Japan
- Prior art keywords
- arm
- joint
- robot arm
- posture
- rotation 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.)
- Granted
Links
Landscapes
- Manipulator (AREA)
Abstract
【解決手段】ロボットアームを現在の姿勢から別の姿勢に移行させる際に、制御装置により予め冗長関節12,14,16の必要回転角度を演算し、この必要回転角度による各関節、各アーム及びハンドの移動予測点が進入禁止領域20に入らない場合には、前記必要回転角度を各関節の指示値として、別の姿勢にロボットアームを移行させ、移動予測点が進入禁止領域20に入る場合には、あらかじめ設定された回避動作を実行する。
【選択図】図3
Description
この姿勢教示方法は、主に、姿勢変更・干渉判断過程(ステップa1)と、評価値計算過程(ステップa2)と、評価値比較・教示姿勢決定過程(ステップa3)とを有する。
仮位置決め過程(ステップa11)では、ハンド8を対象物Wに対して把持状態の姿勢に仮位置決めする。次に、仮位置決め内姿勢変更・干渉判断過程(ステップa12)では、各関節の姿勢を、取り得る範囲で計算によって種々変更した場合のロボットアームRAと障害物OBとの干渉を判断する。次に、繰り返し過程(ステップa13)では、ハンド8の姿勢を変更して仮位置決め過程(ステップa11)および仮位置決め内姿勢変更・干渉判断過程(ステップa12)を、ハンド8の把持可能な全ての姿勢の範囲で繰り返す。
そのため、ロボットアームの干渉回避のための関節位置の計算量が膨大となり、姿勢教示装置による演算処理時間が長くなる問題点があった。
本体に前記冗長関節を介して順次連結された複数のアームと、
前記最終端のアームに取り付けられたハンドとを有する多関節のロボットアームの干渉回避方法であって、
前記ロボットアームの作動領域内に進入禁止領域を予め設定し、
(A) 前記ロボットアームを現在の姿勢から別の姿勢に移行させる際に、制御装置により予め前記冗長関節の必要回転角度を演算し、
(B) 前記必要回転角度による各関節、各アーム及びハンドの移動予測点が前記進入禁止領域に入らない場合には、前記必要回転角度を各関節の指示値として、前記別の姿勢に前記ロボットアームを移行させ、
(C) 前記移動予測点が前記進入禁止領域に入る場合には、あらかじめ設定された回避動作を実行する、ことを特徴とするロボットアームの干渉回避方法が提供される。
前記アーム先端の姿勢のみを維持したまま、前記冗長関節間のアームが進入禁止領域から離れる方向に冗長関節の修正回転角度を再演算し、
前記修正回転角度による各関節、各アーム及びハンドの移動予測点が前記進入禁止領域に入らない場合には、前記修正回転角度を各関節の指示値として、前記別の姿勢に前記ロボットアームを移行させる。
従って、移動予測点が進入禁止領域に入る場合には、あらかじめ設定された回避動作を実行し、例えば冗長関節の必要回転角度の総和を維持したまま、冗長関節間のアームが進入禁止領域から離れる方向に冗長関節の回転角度を修正する。
これにより、教示した動作をロボットアームに実行させる場合、各関節に干渉が起こらないような関節位置を算出し教示すること無く、ロボットアームの干渉回避を行える。
このうち図5(A)は、図3に示す任意の姿勢から基準姿勢へ移行する中間ステップを示し、図5(B)は、図4のステップにおいて、アーム先端(この場合、ハンド18の一部)の移動予測点が進入禁止領域に入った場合を示し、図5(C)は図5(A)のステップにおいて、アーム先端(ハンド18)の移動予測点が進入禁止領域から退避した状態を示している。
複数(この例で3つ)の冗長関節12,14,16は、互いに平行な軸J2,J3,J4を中心に回転可能に構成されている。
複数(この例で4本)のアーム11,13,15,17は、本体10に冗長関節12,14,16を介して順次連結されている。
ハンド18は、最終端のアーム17に取り付けられている。
また、第1アーム11は、本体10上に原点Oを有する3次元座標軸(X−Y−Z軸)において、末端が原点Oの固定され、Z軸方向に伸び、Z軸を中心に回転可能な第1軸J1を有する。
第2アーム13は、第1冗長関節12から外方に伸びる。第2冗長関節14は、第2アーム13の先端と第3アーム15の末端を連結し、第3アーム15を第2軸J2に平行な第3軸J3を中心に回転可能に構成されている。
第3アーム15は、第2冗長関節14から外方に伸びる。第3冗長関節16は、第3アーム15の先端と第4アーム17の末端を連結し、第4アーム17を第3軸J3に平行な第4軸J4を中心に回転可能に構成されている。
第4アーム17は、第3冗長関節16から外方に伸びる。第4アーム17の先端には、ハンド18が取り付けられている。ハンド18は第4アーム17の軸線(第5軸J5)を中心に回転可能に構成されている。
また、この図において、破線は進入禁止領域20であり、ロボットアームを構成する冗長関節12,14,16、アーム11,13,15,17、及びハンド18が進入することを禁止されている領域である。この進入禁止領域20は、予め設定され、制御装置の記憶装置(図示せず)に記憶されている。
なお、禁止領域は図4のように本体を含有するものに限らず、本体と離れた場所に存在してもよいし、分散して存在してもよい。
ステップS2において、ロボットアームを現在の姿勢から別の姿勢に移行させる際に、制御装置により予め冗長関節12,14,16の必要回転角度を演算する。
ステップS3において、演算した必要回転角度による各関節、各アーム及びハンドの移動予測点を予測する。この関節には、冗長関節12,14,16とそれ以外の関節を含む。それ以外の関節は、必須ではない。
ステップS4において、移動予測点が進入禁止領域20に入るか否か、すなわち、進入禁止領域20との干渉をチェックする。
この場合、基準姿勢へ移行中の通常制御による各軸の制御を中止し、進入禁止領域の回避ステップを行う。
この回避ステップは、図5(B)に示すように第2軸J2、第3軸J3、第4軸J4を図の矢印方向(通常制御に対しJ3,J4は逆方向)に回転指令を与え、アーム先端(ハンド18)の移動予測点を進入禁止領域から退避させる。
このとき、この回避制御より第2軸J2、第3軸J3、第4軸J4が冗長であるため、一部の軸が基準姿勢の目標角度に近づく。
アーム先端の姿勢の維持は、例えば、冗長関節12,14,16の必要回転角度の総和を維持することで達成できる。
進入禁止領域から退避した状態において、基準姿勢に移行するため通常制御を再開する。
再開した通常制御では、再度アーム先端の移動予測点が進入禁止領域に進入する場合があるが、回避制御によって一部の軸は基準姿勢に近づいているため、以前進入禁止領域に入ったときと比較してアームの基準姿勢への移行は進んでいる。
以上より、通常制御、進入禁止領域からの回避制御を繰返しながら基準姿勢へ移行する。
従って、移動予測点が進入禁止領域20に入る場合には、あらかじめ設定された回避動作を実行し、例えば冗長関節12,14,16の必要回転角度の総和を維持したまま、冗長関節12,14,16の間のアームが進入禁止領域20から離れる方向に冗長関節12,14,16の回転角度を修正する。
これにより、教示した動作をロボットアームに実行させる場合、各関節に干渉が起こらないような関節位置を算出し教示すること無く、ロボットアームの干渉回避を行える。
11,13,15,17 アーム、
12,14,16 冗長関節、
18 ハンド、
20 進入禁止領域
Claims (2)
- 互いに平行な軸を中心に回転可能な複数の冗長関節と、
本体に前記冗長関節を介して順次連結された複数のアームと、
前記最終端のアームに取り付けられたハンドとを有する多関節のロボットアームの干渉回避方法であって、
前記ロボットアームの作動領域内に進入禁止領域を予め設定し、
(A) 前記ロボットアームを現在の姿勢から別の姿勢に移行させる際に、制御装置により予め前記冗長関節の必要回転角度を演算し、
(B) 前記必要回転角度による各関節、各アーム及びハンドの移動予測点が前記進入禁止領域に入らない場合には、前記必要回転角度を各関節の指示値として、前記別の姿勢に前記ロボットアームを移行させ、
(C) 前記移動予測点が前記進入禁止領域に入る場合には、あらかじめ設定された回避動作を実行する、ことを特徴とするロボットアームの干渉回避方法。 - 前記回避動作において、
前記アーム先端の姿勢のみを維持したまま、前記冗長関節間のアームが進入禁止領域から離れる方向に冗長関節の修正回転角度を再演算し、
前記修正回転角度による各関節、各アーム及びハンドの移動予測点が前記進入禁止領域に入らない場合には、前記修正回転角度を各関節の指示値として、前記別の姿勢に前記ロボットアームを移行させる、ことを特徴とする請求項1に記載のロボットアームの干渉回避方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009292824A JP5464998B2 (ja) | 2009-12-24 | 2009-12-24 | ロボットアームの干渉回避方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009292824A JP5464998B2 (ja) | 2009-12-24 | 2009-12-24 | ロボットアームの干渉回避方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011131326A true JP2011131326A (ja) | 2011-07-07 |
JP5464998B2 JP5464998B2 (ja) | 2014-04-09 |
Family
ID=44344612
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2009292824A Active JP5464998B2 (ja) | 2009-12-24 | 2009-12-24 | ロボットアームの干渉回避方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5464998B2 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9827675B2 (en) | 2014-12-09 | 2017-11-28 | Toyota Jidosha Kabushiki Kaisha | Collision avoidance method, control device, and program |
CN107635730A (zh) * | 2015-06-30 | 2018-01-26 | 株式会社安川电机 | 机器人系统 |
WO2021260898A1 (ja) * | 2020-06-25 | 2021-12-30 | 株式会社日立ハイテク | ロボット教示装置及び作業教示方法 |
WO2023037437A1 (ja) * | 2021-09-08 | 2023-03-16 | 東京ロボティクス株式会社 | 無人飛行機、飛行体及び飛行ロボット |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107505841B (zh) * | 2017-08-31 | 2021-02-05 | 电子科技大学 | 一种基于干扰估计器的机械臂姿态鲁棒控制方法 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6174005A (ja) * | 1984-09-19 | 1986-04-16 | Hitachi Ltd | 多関節形ロボツトの動作制御装置 |
JPS63251901A (ja) * | 1987-04-08 | 1988-10-19 | Sony Corp | 記録装置 |
JPH05204428A (ja) * | 1992-01-28 | 1993-08-13 | Fanuc Ltd | 複数ロボット制御方式 |
JPH05345291A (ja) * | 1992-06-15 | 1993-12-27 | Fanuc Ltd | ロボットの動作範囲制限方式 |
JPH09314487A (ja) * | 1996-05-31 | 1997-12-09 | Mitsubishi Heavy Ind Ltd | 冗長軸を有するマニピュレータの制御方法 |
JPH11333780A (ja) * | 1998-05-22 | 1999-12-07 | Mitsubishi Electric Corp | マニピュレータの制御装置 |
JP2002073130A (ja) * | 2000-06-13 | 2002-03-12 | Yaskawa Electric Corp | ロボットの大域動作経路計画方法とその制御装置 |
JP2002210684A (ja) * | 2000-11-14 | 2002-07-30 | Daihen Corp | トランスファロボット |
JP2003162776A (ja) * | 2001-11-27 | 2003-06-06 | National Institute Of Advanced Industrial & Technology | 空間マーキング装置 |
JP2005014108A (ja) * | 2003-06-23 | 2005-01-20 | Honda Motor Co Ltd | 多関節ロボットの干渉回避方法 |
JP2006043862A (ja) * | 2004-08-09 | 2006-02-16 | Honda Motor Co Ltd | マン・マシン作業システム |
JP2009125893A (ja) * | 2007-11-27 | 2009-06-11 | Yaskawa Electric Corp | ロボット装置 |
JP2009125892A (ja) * | 2007-11-27 | 2009-06-11 | Yaskawa Electric Corp | ロボットシステム |
-
2009
- 2009-12-24 JP JP2009292824A patent/JP5464998B2/ja active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6174005A (ja) * | 1984-09-19 | 1986-04-16 | Hitachi Ltd | 多関節形ロボツトの動作制御装置 |
JPS63251901A (ja) * | 1987-04-08 | 1988-10-19 | Sony Corp | 記録装置 |
JPH05204428A (ja) * | 1992-01-28 | 1993-08-13 | Fanuc Ltd | 複数ロボット制御方式 |
JPH05345291A (ja) * | 1992-06-15 | 1993-12-27 | Fanuc Ltd | ロボットの動作範囲制限方式 |
JPH09314487A (ja) * | 1996-05-31 | 1997-12-09 | Mitsubishi Heavy Ind Ltd | 冗長軸を有するマニピュレータの制御方法 |
JPH11333780A (ja) * | 1998-05-22 | 1999-12-07 | Mitsubishi Electric Corp | マニピュレータの制御装置 |
JP2002073130A (ja) * | 2000-06-13 | 2002-03-12 | Yaskawa Electric Corp | ロボットの大域動作経路計画方法とその制御装置 |
JP2002210684A (ja) * | 2000-11-14 | 2002-07-30 | Daihen Corp | トランスファロボット |
JP2003162776A (ja) * | 2001-11-27 | 2003-06-06 | National Institute Of Advanced Industrial & Technology | 空間マーキング装置 |
JP2005014108A (ja) * | 2003-06-23 | 2005-01-20 | Honda Motor Co Ltd | 多関節ロボットの干渉回避方法 |
JP2006043862A (ja) * | 2004-08-09 | 2006-02-16 | Honda Motor Co Ltd | マン・マシン作業システム |
JP2009125893A (ja) * | 2007-11-27 | 2009-06-11 | Yaskawa Electric Corp | ロボット装置 |
JP2009125892A (ja) * | 2007-11-27 | 2009-06-11 | Yaskawa Electric Corp | ロボットシステム |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9827675B2 (en) | 2014-12-09 | 2017-11-28 | Toyota Jidosha Kabushiki Kaisha | Collision avoidance method, control device, and program |
CN107635730A (zh) * | 2015-06-30 | 2018-01-26 | 株式会社安川电机 | 机器人系统 |
WO2021260898A1 (ja) * | 2020-06-25 | 2021-12-30 | 株式会社日立ハイテク | ロボット教示装置及び作業教示方法 |
JP7454046B2 (ja) | 2020-06-25 | 2024-03-21 | 株式会社日立ハイテク | ロボット教示装置及び作業教示方法 |
WO2023037437A1 (ja) * | 2021-09-08 | 2023-03-16 | 東京ロボティクス株式会社 | 無人飛行機、飛行体及び飛行ロボット |
Also Published As
Publication number | Publication date |
---|---|
JP5464998B2 (ja) | 2014-04-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5114019B2 (ja) | エフェクタの軌道を制御するための方法 | |
JP5528095B2 (ja) | ロボットシステム、その制御装置及び方法 | |
JP5458769B2 (ja) | ロボットの制御装置 | |
EP2660014B1 (en) | Control device and teaching method for seven-shaft multi-joint robot | |
JP5872894B2 (ja) | ロボット動作教示支援装置及び方法 | |
US9248572B2 (en) | Axis angle determination method for six-axis robot and control apparatus for six-axis robot | |
JP5464998B2 (ja) | ロボットアームの干渉回避方法 | |
US9120223B2 (en) | Method of controlling seven-axis articulated robot, control program, and robot control device | |
JP5896003B1 (ja) | 加工装置、教示方法、ワークの生産方法、コントローラ及び制御方法 | |
EP2547490A1 (en) | Calibration of a base coordinate system for an industrial robot | |
KR20210125459A (ko) | 캘리브레이션 장치 및 캘리브레이션 방법 | |
JP2010201592A (ja) | ロボットの動作経路生成方法 | |
JP2007168053A (ja) | 垂直多関節型ロボットのティーチング方法および産業用ロボット装置 | |
JP7091777B2 (ja) | ロボットシステム及び制御方法 | |
JP2009045714A (ja) | ロボットアームの姿勢教示方法および姿勢教示装置 | |
JP5505155B2 (ja) | ロボットシステムおよびロボット制御方法 | |
JP7144754B2 (ja) | 多関節ロボットおよび多関節ロボットシステム | |
JP2008254097A (ja) | 複数ロボット間の相対位置計算方法 | |
JP2019093487A (ja) | ロボットの制御装置及びロボットの逆変換処理方法 | |
JP5433304B2 (ja) | ロボット制御装置及び方法 | |
JP6273783B2 (ja) | ツール先端点情報補正プログラム、ツール先端点情報補正装置、及び、ツール先端点情報補正方法 | |
JP2009050949A (ja) | ロボットアームの軌道教示方法および軌道教示装置 | |
JP2019093486A (ja) | ロボットの制御装置及びロボットの逆変換処理方法 | |
JP2012069169A (ja) | ロボットの動作制御装置及びその動作制御方法 | |
JP2010036293A (ja) | 多関節ロボット |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120713 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130531 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130626 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130718 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130904 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20131101 |
|
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: 20140107 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20140121 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5464998 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
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 |