JP2005103674A - ロボット制御装置及び制御方法 - Google Patents
ロボット制御装置及び制御方法 Download PDFInfo
- Publication number
- JP2005103674A JP2005103674A JP2003337076A JP2003337076A JP2005103674A JP 2005103674 A JP2005103674 A JP 2005103674A JP 2003337076 A JP2003337076 A JP 2003337076A JP 2003337076 A JP2003337076 A JP 2003337076A JP 2005103674 A JP2005103674 A JP 2005103674A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- collision
- robots
- command
- robot control
- 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
- 238000000034 method Methods 0.000 title claims abstract description 18
- 238000001514 detection method Methods 0.000 claims abstract description 23
- 230000001360 synchronised effect Effects 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 3
- 230000002452 interceptive effect Effects 0.000 description 3
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
Abstract
【解決手段】位置指令に基づいて速度指令を算出する位置制御部10と、速度指令に基づいてトルク指令を算出する速度制御部11と、トルク指令に基づいてモータ12を駆動してロボットを制御するロボット制御装置において、トルク指令とモータ12の位置に基づいて外乱を推定するモデル制御部14と、外乱と予め設定した基準値とを比較して衝突を検出する衝突検出部16と、衝突検出部16を有効または無効とする衝突検出選択部15とを備える。
【選択図】図1
Description
衝突の検出手段としては、モータの加速トルクと速度維持トルクを加算して求めたモータの運動に必要な仮想トルク指令と、実際のトルク指令との差を求め、これが予め設定した値を超えると、あるいは、制御系の位置ループ及び速度ループの特性を模擬してモータの速度を予測する制御モデルと、モータの検出器より得られた速度信号との差が基準値を超えたときに速度異常として衝突が発生したと判断していた(特許文献1)。
また、複数ロボット動作時にあるロボットの動作軌道変更により他ロボットとの干渉が発生した場合も簡単にロボットを再起動することができなかった。
上記の問題に鑑みて、本発明は、衝突の誤検出発生時、軌道修正後の干渉発生時などでは、干渉や衝突検出を無効とし、それ以外の時は、衝突検出機能を有効できる安全性の高いロボット制御装置及び制御方法を提供することを目的するものである。
本発明の請求項2記載のロボット制御装置は、前記衝突検出選択部は、外部から信号または前記ロボット制御装置に接続された教示装置からの設定されることを特徴とするものである。
本発明の請求項4記載のロボット制御方法は、前記複数のロボットは、予め優先度が設定され、前記ロボットのアーム同士が衝突した場合には、前記優先度が低いロボットを停止させることを特徴とするものである。
本発明の請求項5記載のロボット制御方法は、前記複数のロボットのうち少なくとも2台以上のロボットが協調同期運転を行っている場合は、協調同期運転を行っている全てのロボットを停止することを特徴とするものである。
図1に本発明の構成図を示す。モータ12は、ロボットの関節の駆動する。エンコーダ13は、モータ12の位置を検出する。モータ12への位置指令とエンコーダ13の位置フィードバックにより、位置制御部10に入力される。位置制御部10では、速度指令が出力される。またエンコーダ13の位置の差分に基づいて速度算出部20にて速度フィードバックが算出される。位置制御部10から出力された速度指令と速度フィードバックに基づいて速度制御部11は、モータ12に対してトルク指令を出力する。
衝突検出選択部15は、ロボット制御装置5に接続されている教示装置や外部からの入力信号により、衝突検出部16を有効または無効を選択する。衝突検出選択部15において、無効が設定された場合には、衝突検出部16の処理は実行されない。つまり、ロボット制御装置5内のCPUは、衝突検出部16の処理へ実行ステップを移行しない。
(ステップ21)
産業用ロボット2が干渉物1に衝突する。
(ステップ22)
衝突したことを検出しロボット2の動作を停止させて教示装置4にアラームが発生したことを通知する。教示装置には衝突発生の表示を行う。
(ステップ23)
外部出力装置6からの信号により衝突を検出する機能を無効とする。
(ステップ24)
衝突を検出する機能を無効としたことを教示装置4に通知する。
(ステップ25)
ロボット2を手動で動作させ干渉物1との干渉を回避する。
外部出力装置6からの信号により衝突を検出する機能を有効とする。
(ステップ27)
(ステップ24)で通知した表示を消去する。
(ステップ28)
通常の動作を再開する。
(ステップ31)
あらかじめ複数の産業用ロボット2の優先順位を教示装置4に設定する。
(ステップ32)
複数の産業用ロボット2のロボットアーム同士が干渉する。
(ステップ33)
干渉したことを検出すると(ステップ31)に設定した優先順位の低いロボットの動作を停止させる。干渉したロボットが協調同期運転を行っている場合は協調同期運転を行っている全てのロボットを停止する。
停止後、教示装置4にアラームが発生したことを通知する。教示装置には干渉発生と干渉したロボットの番号、停止したロボットの番号の表示を行う。
(ステップ35)
外部出力装置6からの信号、または命令実行により停止したロボットの移動を許可する。
(ステップ36)
干渉アラーム発生中、かつロボット移動許可中であることを教示装置に通知する。
(ステップ37)
ロボット2を手動で動作させロボットアーム同士の干渉を回避する。
(ステップ38)
外部出力装置6からの信号または命令実行によりロボットの移動を不許可とする。
(ステップ39)
(ステップ34)で通知した表示を消去する。
(ステップ40)
通常の動作を再開する。
2:産業用ロボット
3:アーム
4:プログラミングペンダント
5:ロボット制御装置
6:外部出力装置
10:位置制御部
11:速度制御部
12:モータ
13:エンコーダ
14:モデル制御部
15:衝突検出選択部
16:衝突検出部
Claims (5)
- 位置指令に基づいて速度指令を算出する位置制御部と、前記速度指令に基づいてトルク指令を算出する速度制御部と、前記トルク指令に基づいてモータを駆動してロボットを制御するロボット制御装置において、
前記トルク指令と前記モータの位置に基づいて外乱を推定するモデル制御部と、
前記外乱と予め設定した基準値とを比較して衝突を検出する衝突検出部と、
前記衝突検出部を有効または無効とする衝突検出選択部とを備えることを特徴とするロボット制御装置。 - 前記衝突検出選択部は、外部から信号または前記ロボット制御装置に接続された教示装置から設定されることを特徴とする請求項1記載のロボット制御装置。
- 複数のロボットのアーム同士の干渉を検出し、前記複数のロボットを停止するロボット制御方法において、
外部からの信号または前記ロボットを動作させる命令に基づいて、ロボットの移動を許可または不許可とすることを特徴とするロボットの制御方法。 - 前記複数のロボットは、予め優先度が設定され、前記ロボットのアーム同士が衝突した場合には、前記優先度が低いロボットを停止させることを特徴とする請求項4記載のロボットの制御方法。
- 前記複数のロボットのうち少なくとも2台以上のロボットが協調同期運転を行っている場合は、協調同期運転を行っている全てのロボットを停止することを特徴とする請求項4乃至5記載のロボット制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003337076A JP4258718B2 (ja) | 2003-09-29 | 2003-09-29 | ロボット制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003337076A JP4258718B2 (ja) | 2003-09-29 | 2003-09-29 | ロボット制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2005103674A true JP2005103674A (ja) | 2005-04-21 |
JP4258718B2 JP4258718B2 (ja) | 2009-04-30 |
Family
ID=34532996
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003337076A Expired - Fee Related JP4258718B2 (ja) | 2003-09-29 | 2003-09-29 | ロボット制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4258718B2 (ja) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104972473A (zh) * | 2014-04-09 | 2015-10-14 | 发那科株式会社 | 具有引入功能的人协调型工业用机器人 |
CN110216682A (zh) * | 2018-03-02 | 2019-09-10 | 欧姆龙株式会社 | 机器人系统 |
WO2019189198A1 (ja) * | 2018-03-28 | 2019-10-03 | Ntn株式会社 | リンク作動装置を用いた複合作業装置 |
JP2019171507A (ja) * | 2018-03-28 | 2019-10-10 | Ntn株式会社 | 複合作業装置 |
KR102105626B1 (ko) * | 2019-10-30 | 2020-04-28 | 주식회사 뉴로메카 | 협동 로봇의 충돌 민감도 자동 설정 방법 |
CN111745685A (zh) * | 2019-03-29 | 2020-10-09 | 湖南三德科技股份有限公司 | 一种制样机器人碰撞检测方法、系统及制样系统 |
KR102226122B1 (ko) * | 2020-04-22 | 2021-03-11 | 주식회사 뉴로메카 | 협동 로봇의 충돌 민감도 자동 설정 방법 |
WO2021086103A1 (ko) * | 2019-10-30 | 2021-05-06 | 주식회사 뉴로메카 | 협동 로봇의 충돌 민감도 자동 설정 방법 |
CN114715146A (zh) * | 2022-05-09 | 2022-07-08 | 吉林大学 | 一种潜在碰撞事故严重程度预测方法 |
EP4438247A1 (en) | 2023-03-31 | 2024-10-02 | Denso Wave Incorporated | Sensor unit and industrial robot equipped with the sensor unit |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63256384A (ja) * | 1987-04-13 | 1988-10-24 | 富士通株式会社 | 複腕協調ロボツト作業システムにおける干渉チエツク方式 |
JPH048484A (ja) * | 1990-04-26 | 1992-01-13 | Hitachi Ltd | 複数ロボットの協調動作制御方法および制御装置 |
JP2002052485A (ja) * | 2000-08-14 | 2002-02-19 | Yaskawa Electric Corp | ロボットの制御装置 |
JP2002283276A (ja) * | 2001-03-21 | 2002-10-03 | Daihen Corp | 多関節ロボットにおける衝突検出・停止制御法 |
JP2003025272A (ja) * | 2001-05-08 | 2003-01-29 | Mitsubishi Electric Corp | ロボット制御装置 |
-
2003
- 2003-09-29 JP JP2003337076A patent/JP4258718B2/ja not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS63256384A (ja) * | 1987-04-13 | 1988-10-24 | 富士通株式会社 | 複腕協調ロボツト作業システムにおける干渉チエツク方式 |
JPH048484A (ja) * | 1990-04-26 | 1992-01-13 | Hitachi Ltd | 複数ロボットの協調動作制御方法および制御装置 |
JP2002052485A (ja) * | 2000-08-14 | 2002-02-19 | Yaskawa Electric Corp | ロボットの制御装置 |
JP2002283276A (ja) * | 2001-03-21 | 2002-10-03 | Daihen Corp | 多関節ロボットにおける衝突検出・停止制御法 |
JP2003025272A (ja) * | 2001-05-08 | 2003-01-29 | Mitsubishi Electric Corp | ロボット制御装置 |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104972473A (zh) * | 2014-04-09 | 2015-10-14 | 发那科株式会社 | 具有引入功能的人协调型工业用机器人 |
JP2015199174A (ja) * | 2014-04-09 | 2015-11-12 | ファナック株式会社 | リードスルー機能を有する人協調型産業用ロボット |
CN110216682A (zh) * | 2018-03-02 | 2019-09-10 | 欧姆龙株式会社 | 机器人系统 |
JP2019150919A (ja) * | 2018-03-02 | 2019-09-12 | オムロン株式会社 | ロボットシステム |
WO2019189198A1 (ja) * | 2018-03-28 | 2019-10-03 | Ntn株式会社 | リンク作動装置を用いた複合作業装置 |
JP2019171507A (ja) * | 2018-03-28 | 2019-10-10 | Ntn株式会社 | 複合作業装置 |
CN111745685A (zh) * | 2019-03-29 | 2020-10-09 | 湖南三德科技股份有限公司 | 一种制样机器人碰撞检测方法、系统及制样系统 |
KR102105626B1 (ko) * | 2019-10-30 | 2020-04-28 | 주식회사 뉴로메카 | 협동 로봇의 충돌 민감도 자동 설정 방법 |
WO2021086103A1 (ko) * | 2019-10-30 | 2021-05-06 | 주식회사 뉴로메카 | 협동 로봇의 충돌 민감도 자동 설정 방법 |
KR102226122B1 (ko) * | 2020-04-22 | 2021-03-11 | 주식회사 뉴로메카 | 협동 로봇의 충돌 민감도 자동 설정 방법 |
CN114715146A (zh) * | 2022-05-09 | 2022-07-08 | 吉林大学 | 一种潜在碰撞事故严重程度预测方法 |
EP4438247A1 (en) | 2023-03-31 | 2024-10-02 | Denso Wave Incorporated | Sensor unit and industrial robot equipped with the sensor unit |
Also Published As
Publication number | Publication date |
---|---|
JP4258718B2 (ja) | 2009-04-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10856945B2 (en) | Industrial robot and method of operating the same | |
JP3923053B2 (ja) | ロボット教示装置 | |
US9782898B2 (en) | Robot controller for avoiding problem regarding robot at the time of emergency stop | |
US8271131B2 (en) | Robot with learning control function | |
JP4550849B2 (ja) | アーム搭載移動ロボット | |
JP2009050958A (ja) | 停止監視機能を備えたロボット制御装置 | |
JP2008188722A (ja) | ロボット制御装置 | |
CN110919627B (zh) | 机器人的控制方法及控制装置 | |
KR102418451B1 (ko) | 로봇 제어 시스템 | |
JP4258718B2 (ja) | ロボット制御装置 | |
JP2008183680A (ja) | 負荷機械の制御装置とその衝突検出しきい値更新方法 | |
JP2016159367A (ja) | ロボットの動作モードを自動的に切替えるロボット制御装置 | |
JP5271499B2 (ja) | ロボットシステム | |
JP2018062026A (ja) | ロボットの速度や加速度を制限する機能を備えたロボット制御装置 | |
JP2017127964A (ja) | 学習機能を備えたロボット装置 | |
US11927936B2 (en) | Safe operation of a multi-axis kinematic system | |
JP2016196069A (ja) | 産業用ロボットの回避軌道生成装置および回避軌道生成方法 | |
JP2007249524A (ja) | ロボット制御装置 | |
JP2018176398A (ja) | ロボットシステム | |
JPH1177580A (ja) | ロボットの制御装置 | |
CN112476428A (zh) | 机器人控制装置 | |
CN110914019A (zh) | 机器人停止距离模拟方法 | |
KR20130009316A (ko) | 충격 센서가 내장된 로봇 제어 장치 및 이를 이용한 로봇 제어 방법 | |
KR101882565B1 (ko) | 오버라이드를 토대로 하는 예견적인 속도 규제 | |
JP3327205B2 (ja) | ロボットの制御方法および装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060817 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080207 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080226 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080424 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081007 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20081105 |
|
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: 20090115 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090128 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120220 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4258718 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120220 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130220 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140220 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150220 Year of fee payment: 6 |
|
LAPS | Cancellation because of no payment of annual fees |