JPH09190207A - 多関節ロボットの可動範囲制限装置 - Google Patents
多関節ロボットの可動範囲制限装置Info
- Publication number
- JPH09190207A JPH09190207A JP610996A JP610996A JPH09190207A JP H09190207 A JPH09190207 A JP H09190207A JP 610996 A JP610996 A JP 610996A JP 610996 A JP610996 A JP 610996A JP H09190207 A JPH09190207 A JP H09190207A
- Authority
- JP
- Japan
- Prior art keywords
- joint
- movable range
- angle
- joints
- range
- 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
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
ても干渉が生じないようにする。 【解決手段】 基台1上に、第1アーム2、第2アーム
3が備えられ、第1、第2アーム2、3を6つの関節に
て図に示す矢印方向に回転させる多関節ロボットにおい
て、各関節の可動範囲を予め定めた広角の限界値に制限
するとともに、第2、第3関節5、6の角度指令値
θ2 、θ3 が所定の角度関係を満たすか否かを判定し
て、基台1と第2アーム3が干渉しないように可動範囲
を制限した。
Description
各関節の可動範囲を所定角度範囲に制限するようにした
多関節ロボットの可動範囲制限装置に関する。
す。この多関節ロボットは、基台(ベース)1と、第1
アーム2と、第2アーム3と、ハンド取付部4とを有
し、これらを6つの関節にて図に示す矢印方向に回転さ
せるようにしている。図中には、第2、第3関節を符号
5、6で示している。なお、ハンド取付部4には、ツー
ルとしてのハンドが取り付けられる。
者がティーチング(位置の教示)を行う場合、各関節の
可動範囲は、他の関節角度がいかなる場合であってもア
ームとアーム、アームとベースが干渉しないように制限
されている。このような関節の可動範囲を制限するもの
として、特開平3ー79294号公報に示すものがあ
る。このものでは、多関節ロボットの各関節の可動範囲
を所定の角度範囲にソフト的に制限している。
は、メカ的にも各関節の可動範囲を制限している。例え
ば、図7に示すように、第2関節5の可動範囲を可動範
囲制限ボルト7により制限している。このような多関節
ロボットにおいては、図8に示すように、P点(仮想の
ハンド位置)の動作範囲がに制限される。
たソフト的およびメカ的な可動範囲の制限により、可動
範囲を広くすることができないという問題がある。可動
範囲を広くするためには、ソフト的な可動範囲の制限を
緩く(すなわち可動範囲を制限する限界角度を大きく)
し、かつ上記した可動範囲制限ボルト7をなくせばよ
い。
すると、アームとベースが干渉してしまうことが判明し
た。例えば、第1アーム2の軸方向を基準とし左回りを
正の角度、右回りを負の角度として、第2関節5の可動
範囲を、それまでの−55°から−85°に広くした場
合、P点の動作範囲が+に拡大する。しかし、その
ようにした場合、図9に示すように、第2アーム3とベ
ース1とが干渉する場合があることが判明した。
囲を広くしても干渉が生じないようにすることを目的と
する。
め、請求項1に記載の発明においては、少なくとも2つ
の関節の角度指令値(θ2 、θ3 )間の角度関係を用い
て、基台とアームあるいはアーム間に干渉が生じるか否
かを判定する判定手段(104)を設け、各関節の可動
範囲を干渉が生じない範囲に制限するようにしたことを
特徴としている。
も2つの関節の角度指令値(θ2 、θ3 )間の角度関係
による判定を用いて、基台とアームあるいはアーム間の
干渉が生じないようにすることができる。また、請求項
2に記載の発明においては、上記した判定手段(10
4)により干渉が生じることが判定された時であって
も、2つの関節の角度指令値(θ2 、θ3 )が、それぞ
れの関節の現在角度との関係により動作可能方向にある
ことを判定して、各関節を可動させる手段(107、1
08)を設けたことを特徴としている。
てしまった場合でも、次の指令値が動作可能方向にあれ
ば、各関節を可動させて、干渉が生じない範囲に脱出さ
せることができる。
について説明する。なお、以下に示す実施形態では、図
1に示す多関節ロボットにおいて、上記したように、ソ
フト的な可動範囲の制限を緩くし、かつ可動範囲制限ボ
ルト7をなくして、可動範囲を広くしている。
置のブロック構成を示す。回転角センサ10は6つの関
節の角度を検出する。この角度検出はエンコーダを用い
て行うことができる。制御装置20は、ティーチング時
に回転角センサ10にて検出された各関節角度、あるい
は図示しない入力装置にて設定入力された各関節角度に
より、各関節の動作角度の指令値(θ1 〜θ6 )を作成
し、その指令値が適正な角度を示しているか否かをチェ
ックする。このチェックにより指令値が適正であると判
定した場合には、その指令値に基づいて、各関節の駆動
を行う駆動装置40を動作させる。
角度を示していないと判定した場合には、表示装置30
によりエラー表示を行わせるとともに、駆動装置40の
動作を停止させる。 (第1の制御例)上記した動作を行う制御装置20の具
体的作動について、図3に示すフローチャートを基に説
明する。
θ6 )を作成する(ステップ101)。この指令値は、
上記したように、回転角センサ10にて検出された各関
節角度、あるいは図示しない入力装置にて設定入力され
た各関節角度から作成される。次に、各関節の動作角度
の指令値(θ1 〜θ6 )のそれぞれが、それぞれに対し
て設定された可動範囲内(上限値と下限値の間)に入っ
ているか否かをチェックする(ステップ102)。すな
わち、P点の動作範囲が図8に示す+の範囲内にな
るように、それぞれの関節に対して設定された可動範囲
内に入っているか否かをチェックする。
30にエラー表示させるとともに駆動装置40の動作を
停止させる(ステップ103)。また、指令値が可動範
囲内にある時は、第3関節6の角度指令値θ3 と第2関
節5の角度指令値θ2 とが数式1を満たすか否かを判定
する(ステップ104)。
干渉が起きないようにするためのものであり、その関係
式は、図4に示す実験結果に基づいて設定されている。
すなわち、図4に示す斜線領域において干渉が起こるこ
とが実験により確認されており、この実験結果から一次
近似式を求めて数式1を作成している。従って、数式1
の角度関係を満たすことにより、第2アーム3とベース
1との干渉を防止することができる。
角度関係にあると判定されると、ステップ103でエラ
ー表示およびロボットの停止処理を行うが、干渉を起こ
す角度関係にないと判定されると、指令値を出力する
(ステップ105)。この出力された指令値に基づき、
干渉を起こさないように各関節の駆動を行うことができ
る。
のの範囲であるため、上記ステップ104による角度
関係の判定を加えることにより、P点の動作範囲を図5
に示す+−とし、従来のものよりも広く、かつ干
渉を起こさない可動範囲とすることができる。 (第2の制御例)上記した第1の制御例では、数式1の
角度関係を満たさない範囲を動作禁止範囲としている。
この動作禁止範囲は、(1)実際にロボットに干渉する
部分と、(2)本来動作可能な関節角度であるが、第2
アーム3とベース1とがぶつからないように安全に停止
できるように動作禁止している部分から定義されてい
る。
場合、(2)の部分に入る手前で停止させるようにして
いるが、動作禁止範囲付近でエラーが発生した場合に
は、惰性で(2)の部分に入ってしまうことがある。こ
の時、安全な方向に制御装置から動作指令値が出力され
たとしても、その指令値は動作禁止範囲内にあるため、
この時にはエラーを出力して現在位置で停止したままと
なり、その位置から動作できなくなってしまうという問
題がある。
3関節6の角度指令値θ3 と第2関節5の角度指令値θ
2 とが数式1を満たさずに動作禁止範囲に入った場合で
も、後述する所定の関係を満たす場合には動作可能とし
て、動作禁止範囲からの脱出を可能としている。この制
御例における制御装置20の具体的作動について、図6
に示すフローチャートを基に説明する。この制御例で
は、図3のステップ101〜105に加え、新たにステ
ップ106〜108を設けている。
度指令値θ2 と第3関節6の角度指令値θ3 とが干渉を
起こす角度関係にあると判定されると、第2関節5と第
3関節6のそれぞれの現在角度(回転角センサ10にて
検出された第2、第3関節角度)により、動作禁止範囲
にあるか否かを判定する(ステップ106)。具体的に
は、数式1を用い、角度指令値θ2 とθ3 の代わりにそ
れぞれの現在角度を当てはめ、数式1の角度関係を満た
さない時に動作禁止範囲にあるとする。
指令値θ2 が、2軸の現在角度以上か否か判定する(ス
テップ107)。この判定がYESの時には、2軸の次
の指令値θ2 が動作可能方向にあるとし、さらに第3関
節6(すなわち3軸)の次の指令値θ3 が、3軸の現在
角度以上か否か判定する(ステップ108)。この判定
がYESの時には、3軸の次の指令値θ3 が動作可能方
向であるとする。
は、動作方向がロボットの本体とアームが干渉する部分
から離れていく方向である。従って、動作禁止範囲付近
でエラーが発生し、惰性で動作禁止範囲に入ってしまっ
た場合でも、2軸と3軸の次の指令値がそれぞれの現在
角度以上であれば、2軸と3軸とも動作可能方向にある
として、それぞれの指令値を出力する(ステップ10
5)。その結果、動作禁止範囲からの移動を行うことが
できる。
ボット以外の他の多関節ロボットにおいても適用でき、
その場合に、基台とアーム以外に、アームとアームとの
干渉が生じないように、少なくとも2つの関節の角度指
令値間の角度関係を用いてその判定を行うようにするこ
ともできる。また、その場合、2つに限らずより多くの
関節の角度指令値間の角度関係を用いるようにしてもよ
い。
動範囲制限装置のブロック構成を示す図である。
ローチャートである。
θ3 と第2関節5の角度θ2 との角度関係を設定するた
めの実験結果を示す図である。
点の動作範囲を説明するための図である。
ートである。
可動範囲を可動範囲制限ボルト7により制限している状
態を示す図である。
するための図である。
す図である。
ド取付部、5…第2関節、6…第3関節。
Claims (2)
- 【請求項1】 基台(1)上に備えられた複数のアーム
(2、3)を複数の関節(5、6)にて回転させる多関
節ロボットに適用し、前記各関節の可動範囲を所定角度
範囲に制限するようにした多関節ロボットの可動範囲制
限装置において、 少なくとも2つの関節の角度指令値(θ2 、θ3 )間の
角度関係を用いて前記基台とアームあるいはアーム間に
干渉が生じるか否かを判定する判定手段(104)を設
け、前記各関節の可動範囲を前記干渉が生じない範囲に
制限するようにしたことを特徴とする多関節ロボットの
可動範囲制限装置。 - 【請求項2】 前記判定手段にて干渉が生じることが判
定された時に、前記2つの関節の角度指令値が、それぞ
れの関節の現在角度との関係により動作可能方向にある
ことを判定して、前記各関節を可動させる手段(10
7、108)を設けたことを特徴とする請求項1に記載
の多関節ロボットの可動範囲制限装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP00610996A JP3355902B2 (ja) | 1995-11-08 | 1996-01-17 | 多関節ロボットの可動範囲制限装置 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7-289965 | 1995-11-08 | ||
JP28996595 | 1995-11-08 | ||
JP00610996A JP3355902B2 (ja) | 1995-11-08 | 1996-01-17 | 多関節ロボットの可動範囲制限装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH09190207A true JPH09190207A (ja) | 1997-07-22 |
JP3355902B2 JP3355902B2 (ja) | 2002-12-09 |
Family
ID=26340188
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP00610996A Expired - Lifetime JP3355902B2 (ja) | 1995-11-08 | 1996-01-17 | 多関節ロボットの可動範囲制限装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3355902B2 (ja) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1754448A1 (de) | 2005-08-16 | 2007-02-21 | BrainLAB AG | Anthropomorpher medizintechnischer Roboterarm mit Bewegungseinschränkung |
US8160743B2 (en) | 2005-08-16 | 2012-04-17 | Brainlab Ag | Anthropomorphic medical robot arm with movement restrictions |
CN105881526A (zh) * | 2016-05-28 | 2016-08-24 | 东莞市联洲知识产权运营管理有限公司 | 一种设有延伸臂的轻型六轴通用机器人 |
CN105881516A (zh) * | 2016-05-28 | 2016-08-24 | 东莞市联洲知识产权运营管理有限公司 | 一种设有一对小臂的轻型六轴通用机器人 |
JP2019198914A (ja) * | 2018-05-15 | 2019-11-21 | オムロン株式会社 | 多関節ロボットの干渉判定装置、多関節ロボットの干渉判定方法、多関節ロボットの干渉判定プログラム、及び経路計画生成装置 |
JP2023548953A (ja) * | 2020-12-07 | 2023-11-21 | サ-コス コーポレイション | センサ出力データを組み合わせて外骨格の安全でない動作を防止する |
US11924023B1 (en) | 2022-11-17 | 2024-03-05 | Sarcos Corp. | Systems and methods for redundant network communication in a robot |
US11926044B2 (en) | 2016-11-11 | 2024-03-12 | Sarcos Corp. | Clutched joint modules having a quasi-passive elastic actuator for a robotic assembly |
US11981027B2 (en) | 2016-11-11 | 2024-05-14 | Sarcos Corp. | Tunable actuator joint modules having energy recovering quasi-passive elastic actuators with internal valve arrangements |
-
1996
- 1996-01-17 JP JP00610996A patent/JP3355902B2/ja not_active Expired - Lifetime
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1754448A1 (de) | 2005-08-16 | 2007-02-21 | BrainLAB AG | Anthropomorpher medizintechnischer Roboterarm mit Bewegungseinschränkung |
US8160743B2 (en) | 2005-08-16 | 2012-04-17 | Brainlab Ag | Anthropomorphic medical robot arm with movement restrictions |
CN105881526A (zh) * | 2016-05-28 | 2016-08-24 | 东莞市联洲知识产权运营管理有限公司 | 一种设有延伸臂的轻型六轴通用机器人 |
CN105881516A (zh) * | 2016-05-28 | 2016-08-24 | 东莞市联洲知识产权运营管理有限公司 | 一种设有一对小臂的轻型六轴通用机器人 |
US11926044B2 (en) | 2016-11-11 | 2024-03-12 | Sarcos Corp. | Clutched joint modules having a quasi-passive elastic actuator for a robotic assembly |
US11981027B2 (en) | 2016-11-11 | 2024-05-14 | Sarcos Corp. | Tunable actuator joint modules having energy recovering quasi-passive elastic actuators with internal valve arrangements |
JP2019198914A (ja) * | 2018-05-15 | 2019-11-21 | オムロン株式会社 | 多関節ロボットの干渉判定装置、多関節ロボットの干渉判定方法、多関節ロボットの干渉判定プログラム、及び経路計画生成装置 |
JP2023548953A (ja) * | 2020-12-07 | 2023-11-21 | サ-コス コーポレイション | センサ出力データを組み合わせて外骨格の安全でない動作を防止する |
US11924023B1 (en) | 2022-11-17 | 2024-03-05 | Sarcos Corp. | Systems and methods for redundant network communication in a robot |
Also Published As
Publication number | Publication date |
---|---|
JP3355902B2 (ja) | 2002-12-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2895672B2 (ja) | 複数ロボット制御方法 | |
US6845295B2 (en) | Method of controlling a robot through a singularity | |
EP2660014B1 (en) | Control device and teaching method for seven-shaft multi-joint robot | |
EP0519081B1 (en) | Method of correcting deflection of robot | |
JP4440072B2 (ja) | ロボットの制御方法 | |
JPH09190207A (ja) | 多関節ロボットの可動範囲制限装置 | |
JPH11277468A (ja) | ロボットの制御装置 | |
US11213952B2 (en) | Articulated robot and articulated robot system | |
JPH07271415A (ja) | 協調ロボット制御方法 | |
JPS5878205A (ja) | 工業用ロボツトのテイ−チング方法 | |
JP2014054722A (ja) | 速度制御ロボット機構におけるワークスペース制限の応用 | |
WO2021249379A1 (zh) | 一种提升安全控制性能的工业机器人及其控制方法 | |
JP2011245614A5 (ja) | ||
JP4289219B2 (ja) | 人間介入型ロボットの制御装置 | |
JP2656180B2 (ja) | ツール先端位置調整方法 | |
JP2649463B2 (ja) | 回転外部軸を有する産業用ロボットの教示方法およびそれに用いる教示装置 | |
TWI809817B (zh) | 機器人控制器、控制方法以及控制程式 | |
Shardyko et al. | Implementation of impedance trajectory control on a 6-DoF manipulator | |
US20230286146A1 (en) | Control apparatus | |
JP7259487B2 (ja) | 制御方法およびロボットシステム | |
KR0176589B1 (ko) | 목표 위치 까지의 이동 시간 단축을 위한 로봇의 회전 각도 보정 방법 | |
JP3666928B2 (ja) | ロボット制御方法及びその装置 | |
JP4798552B2 (ja) | ロボットの領域監視方法および制御装置 | |
KR0155281B1 (ko) | 다관절 로보트의 직선보간방법 | |
JPS62189504A (ja) | ロボツトの制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081004 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091004 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101004 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111004 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111004 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121004 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121004 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121004 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131004 Year of fee payment: 11 |
|
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 |
|
EXPY | Cancellation because of completion of term |