JP2006102889A - 減速機の異常判定装置及び減速機の異常判定方法 - Google Patents
減速機の異常判定装置及び減速機の異常判定方法 Download PDFInfo
- Publication number
- JP2006102889A JP2006102889A JP2004293974A JP2004293974A JP2006102889A JP 2006102889 A JP2006102889 A JP 2006102889A JP 2004293974 A JP2004293974 A JP 2004293974A JP 2004293974 A JP2004293974 A JP 2004293974A JP 2006102889 A JP2006102889 A JP 2006102889A
- Authority
- JP
- Japan
- Prior art keywords
- torque
- speed
- motor
- speed reducer
- detection value
- 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
Images
Landscapes
- Manipulator (AREA)
Abstract
【解決手段】モータへ指令される速度指令、モータから検出された速度検出値及びトルク検出値を入力して減速機の異常判定処理をする異常判定部21を有し、異常判定部21は、以下の条件のうち少なくとも1つを満たすとき、減速機14が異常であると判断する。
モータ12が定常速度Vcのときの
(1)トルク最大値T1>トルク上限閾値Tu
(2)トルク最小値T2<トルク下限閾値Td
(3)トルク最大値T1−トルク最小値T2>トルク変動幅閾値Th
【選択図】図2
Description
(1)トルク検出値の量大値>トルク上限閾値
(2)トルク検出値の最小値<トルク下限閾値
(3)トルク検出値の最大値−トルク検出値最小値>トルク変動幅閾値
ことを特徴とする。
(1)減速機駆動装置を除く他の減速機駆動装置の動作を一時的に停止させ、
(2)所定の減速機駆動装置だけに所定の位置指令を与えて所定の動作をさせ、
(3)その所定の動作をしている期間内にトルク検出値を基準値と比較して減速機の異常を判定することを特徴とする。
(1)トルク検出値の量大値>トルク上限閾値
(2)トルク検出慎の最小値<トルク下限閾値
(3)トルク検出値の最大値−トルク検出値最小値>トルク変動幅
ので、簡単な構成で且つ高い信用度で減速機の異常を判定することができる。
(1)減速機駆動装置を除く他の減速機駆動装置の動作を一時的に停止させ、
(2)所定の減速機駆動装置だけに所定の位置指令を与えて所定の動作をさせ、
(3)その所定の動作をしている期間内にトルク検出値を基準値と比較して減速機の異常を判定するので、簡単な構成の装置で実現することができるとともに、高い信用度で減速機の異常を判定することができる。
(1)定常速度Vc(図3(b)のb−c間)で、予め設定されたトルク上限閾値Tu或いはトルク下限閾値Tdのいずれか一方をトルク信号Tfが超えたとき、または、
(2)定常速度Vc(図3(b)のb−c間)で、トルク信号Tfが予め設定されたトルク変動幅Thを越えたとき異常と判定する。
(1)最大値T1>トルク上限Tu
(2)最小値T2<トルク下限Td
(3)差分T3>トルク変動幅Th
の何れか1つの条件を満たした時に異常と判定する。なお、ここでトルク変動幅Thは、トルク変動幅Th=トルク上限Tu−トルク下限Tdをいうものではなく、トルク変動幅Thは、トルク上限Tuやトルク下限Tdに関係ない所定幅の値である。また、トルクの最大値T1やトルクの最小値T2は、周囲温度の変化や、モータ自身の発熱による粘性の変化により変動が生じる。この時T1が上昇すればT2も上昇し、T1が下降すればT2も下降する。したがってT2は、一定値を保つため、温度変化に対する影響を受けにくくなっている。
特に産業用ロボットの場合、自由度が高くあらゆる姿勢を取ることができるが、実際の生産現場においては、周辺治具との干渉によりSIN0近傍でしか動作不可能な場合も多くハイパスフィルタは特に有効である。
2 速度制御部
3 トルク制御部(トルク制御部)
4 速度変換部
12 モータ
13 位置検出器(検出器)
14 減速機
15 負荷
20 異常判定装置
21,31 異常判定部
22,32 警報部
33 ハイパスフィルタ
Claims (2)
- アームを駆動するモータと、
前記アームと前記モータの間の関節に設けられ回転数を落として前記モータのトルクを前記アームに伝達する減速機と、
前記モータの回転を検出する検出器と、
ロボットコントローラの位置指令と前記検出器が出力する位置検出値を受けて前記モータの位置を制御する位置制御部と当該位置制御部が出力する速度指令と前記位置検出値から求められた速度検出値を受けて前記モータの速度を制御する速度制御部と当該速度制御部が出力するトルク指令と前記モータの電流から求められたトルク検出値を受けて前記モータのトルクを制御する電流アンプ部とを備えたモータドライバと
からなる減速機駆動装置が、ロボットコントローラから位置指令を受けると前記アームの位置を制御する多関節型ロボットにおいて、
前記モータドライバに電気的に接続して設けられ、
前記速度指令と前記速度検出値と前記トルク検出値を入力して前記減速機の異常判定処理をする異常判定部を有し、
前記異常判定部は、前記速度指令が一定値になった後に速度偏差が所定値内に入ってから前記速度指令が前記一定値でなくなるまでの期間内において、以下の3つの条件のうち少なくとも1つを満たせば前記減速機が異常であると判断する
(1)トルク検出値の量大値>トルク上限閾値
(2)トルク検出値の最小値<トルク下限閾値
(3)トルク検出値の最大値−トルク検出値最小値>トルク変動幅閾値
ことを特徴とする減速機の異常判定装置。 - アームを駆動するモータと、
前記アームと前記モータの間の関節に設けられ回転数を落として前記モータのトルクを前記アームに伝達する減速機と、
前記モータの回転を検出する検出器と、
ロボットコントローラの位置指令と前記検出器が出力する位置検出値を受けて前記モータの位置を制御する位置制御部と当該位置制御部が出力する速度指令と前記位置検出値から求められた速度検出値を受けて前記モータの速度を制御する速度制御部と当該速度制御部が出力するトルク指令と前記モータの電流から求められたトルク検出値を受けて前記モータのトルクを制御する電流アンプ部とを備えたモータドライバと
からなる減速機駆動装置が複数設けられて、ロボットコントローラから位置指令を受けると前記アームの位置を制御する多関節型ロボットにおいて、
所定の前記減速機駆動装置にある前記減速機の異常を判定するときは、
(1)当該減速機駆動装置を除く他の前記減速機駆動装置の動作を一時的に停止させ、
(2)所定の前記減速機駆動装置だけに所定の位置指令を与えて所定の動作をさせ、
(3)その所定の動作をしている期間内に前記トルク検出値を基準値と比較して当該減速機の異常を判定する
ことを特徴とする減速機の異常判定方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004293974A JP4391381B2 (ja) | 2004-10-06 | 2004-10-06 | 多関節ロボットの減速機の異常判定装置及び多関節ロボットの減速機の異常判定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004293974A JP4391381B2 (ja) | 2004-10-06 | 2004-10-06 | 多関節ロボットの減速機の異常判定装置及び多関節ロボットの減速機の異常判定方法 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2009144484A Division JP2009202335A (ja) | 2009-06-17 | 2009-06-17 | 減速機の異常判定装置及び減速機の異常判定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2006102889A true JP2006102889A (ja) | 2006-04-20 |
JP4391381B2 JP4391381B2 (ja) | 2009-12-24 |
Family
ID=36373171
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004293974A Expired - Fee Related JP4391381B2 (ja) | 2004-10-06 | 2004-10-06 | 多関節ロボットの減速機の異常判定装置及び多関節ロボットの減速機の異常判定方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4391381B2 (ja) |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011110630A (ja) * | 2009-11-24 | 2011-06-09 | Yaskawa Electric Corp | ロボット制御装置 |
JP2011224727A (ja) * | 2010-04-20 | 2011-11-10 | Fanuc Ltd | ロボットシステム |
US20120065781A1 (en) * | 2010-09-15 | 2012-03-15 | Kabushiki Kaisha Yaskawa Denki | Reducer abnormality determination method, abnormality determination device, and robot system |
JP2013033459A (ja) * | 2011-06-29 | 2013-02-14 | Jfe Steel Corp | 異常監視システムおよび異常監視方法 |
CN104070539A (zh) * | 2013-03-29 | 2014-10-01 | 发那科株式会社 | 具备气弹簧的多关节机器人、及推断气弹簧的内压的方法 |
EP2842731A1 (en) | 2013-09-03 | 2015-03-04 | Kabushiki Kaisha Isowa | Single facer |
EP2952869A1 (en) * | 2014-05-28 | 2015-12-09 | Fanuc Corporation | Gear transmission and usage measuring device for measuring usage of gear transmission |
JP2016179527A (ja) * | 2015-03-24 | 2016-10-13 | ファナック株式会社 | ロボットの異常診断を行う機能を有するロボット制御装置 |
JP2016203273A (ja) * | 2015-04-16 | 2016-12-08 | 富士通株式会社 | ロボット制御プログラム及びロボット |
US20170297199A1 (en) * | 2016-04-18 | 2017-10-19 | Toyota Jidosha Kabushiki Kaisha | Abnormality determining device and abnormality determining method |
JP2017213639A (ja) * | 2016-05-31 | 2017-12-07 | 川崎重工業株式会社 | ロボット減速機の状態監視装置および方法 |
CN111819042A (zh) * | 2018-02-28 | 2020-10-23 | 日产自动车株式会社 | 异常检测装置及异常检测方法 |
JPWO2019215909A1 (ja) * | 2018-05-11 | 2021-05-27 | 日産自動車株式会社 | 異常検出装置及び異常検出方法 |
CN113686569A (zh) * | 2021-08-19 | 2021-11-23 | 深圳市汇川技术股份有限公司 | 传动机构力矩检测方法、装置、设备及存储介质 |
CN114051584A (zh) * | 2019-06-28 | 2022-02-15 | 川崎重工业株式会社 | 减速机的故障诊断装置及故障诊断方法 |
CN114161481A (zh) * | 2021-10-12 | 2022-03-11 | 上海非夕机器人科技有限公司 | 安全***、关节组件及机器人 |
CN114659688A (zh) * | 2020-12-22 | 2022-06-24 | 达明机器人股份有限公司 | 双回路力矩感知***及其感知方法 |
DE112021004831T5 (de) | 2020-11-12 | 2023-09-28 | Fanuc Corporation | Anomaliedetektionsvorrichtung, die anomalien in einem leistungsübertragungsmechanismus zum übertragen einer durch einen motor ausgegebenen drehkraft detektiert |
WO2023193627A1 (zh) * | 2022-04-06 | 2023-10-12 | 瑞龙诺赋(上海)医疗科技有限公司 | 器械驱动控制***及方法 |
-
2004
- 2004-10-06 JP JP2004293974A patent/JP4391381B2/ja not_active Expired - Fee Related
Cited By (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011110630A (ja) * | 2009-11-24 | 2011-06-09 | Yaskawa Electric Corp | ロボット制御装置 |
JP2011224727A (ja) * | 2010-04-20 | 2011-11-10 | Fanuc Ltd | ロボットシステム |
US8355817B2 (en) | 2010-04-20 | 2013-01-15 | Fanuc Corporation | Robot system |
US9321177B2 (en) | 2010-09-15 | 2016-04-26 | Kabushiki Kaisha Yaskawa Denki | Reducer abnormality determination method, abnormality determination device, and robot system |
US20120065781A1 (en) * | 2010-09-15 | 2012-03-15 | Kabushiki Kaisha Yaskawa Denki | Reducer abnormality determination method, abnormality determination device, and robot system |
JP2012061535A (ja) * | 2010-09-15 | 2012-03-29 | Yaskawa Electric Corp | 減速機の異常判定方法、異常判定装置、ロボット及びロボットシステム |
CN102431043A (zh) * | 2010-09-15 | 2012-05-02 | 株式会社安川电机 | 减速器的异常判定方法、装置和机器人及机器人*** |
EP2431137A3 (en) * | 2010-09-15 | 2014-08-06 | Kabushiki Kaisha Yaskawa Denki | Reducer abnormality determination method, abnormality determination device, and robot system |
KR101495949B1 (ko) * | 2010-09-15 | 2015-02-25 | 가부시키가이샤 야스카와덴키 | 감속기의 이상 판정 방법, 이상 판정 장치 및 로봇 시스템 |
JP2013033459A (ja) * | 2011-06-29 | 2013-02-14 | Jfe Steel Corp | 異常監視システムおよび異常監視方法 |
CN104070539A (zh) * | 2013-03-29 | 2014-10-01 | 发那科株式会社 | 具备气弹簧的多关节机器人、及推断气弹簧的内压的方法 |
CN104070539B (zh) * | 2013-03-29 | 2015-09-09 | 发那科株式会社 | 具备气弹簧的多关节机器人、及推断气弹簧的内压的方法 |
EP2842731A1 (en) | 2013-09-03 | 2015-03-04 | Kabushiki Kaisha Isowa | Single facer |
EP2952869A1 (en) * | 2014-05-28 | 2015-12-09 | Fanuc Corporation | Gear transmission and usage measuring device for measuring usage of gear transmission |
CN105276163A (zh) * | 2014-05-28 | 2016-01-27 | 发那科株式会社 | 齿轮传动装置以及测定该装置的使用度的使用度测定装置 |
CN105276163B (zh) * | 2014-05-28 | 2018-09-28 | 发那科株式会社 | 齿轮传动装置以及测定该装置的使用度的使用度测定装置 |
US9915337B2 (en) | 2014-05-28 | 2018-03-13 | Fanuc Corporation | Gear transmission and usage measuring device for measuring usage of gear transmission |
JP2016179527A (ja) * | 2015-03-24 | 2016-10-13 | ファナック株式会社 | ロボットの異常診断を行う機能を有するロボット制御装置 |
JP2016203273A (ja) * | 2015-04-16 | 2016-12-08 | 富士通株式会社 | ロボット制御プログラム及びロボット |
JP2017192990A (ja) * | 2016-04-18 | 2017-10-26 | トヨタ自動車株式会社 | 異常判定装置及び異常判定方法 |
CN107449958A (zh) * | 2016-04-18 | 2017-12-08 | 丰田自动车株式会社 | 异常判定装置和异常判定方法 |
US20170297199A1 (en) * | 2016-04-18 | 2017-10-19 | Toyota Jidosha Kabushiki Kaisha | Abnormality determining device and abnormality determining method |
US10335948B2 (en) * | 2016-04-18 | 2019-07-02 | Toyota Jidosha Kabushiki Kaisha | Abnormality determining device and abnormality determining method |
CN107449958B (zh) * | 2016-04-18 | 2020-03-24 | 丰田自动车株式会社 | 异常判定装置和异常判定方法 |
JP2017213639A (ja) * | 2016-05-31 | 2017-12-07 | 川崎重工業株式会社 | ロボット減速機の状態監視装置および方法 |
CN111819042A (zh) * | 2018-02-28 | 2020-10-23 | 日产自动车株式会社 | 异常检测装置及异常检测方法 |
JPWO2019215909A1 (ja) * | 2018-05-11 | 2021-05-27 | 日産自動車株式会社 | 異常検出装置及び異常検出方法 |
JP7056733B2 (ja) | 2018-05-11 | 2022-04-19 | 日産自動車株式会社 | 異常検出装置及び異常検出方法 |
CN114051584A (zh) * | 2019-06-28 | 2022-02-15 | 川崎重工业株式会社 | 减速机的故障诊断装置及故障诊断方法 |
CN114051584B (zh) * | 2019-06-28 | 2024-04-09 | 川崎重工业株式会社 | 减速机的故障诊断装置及故障诊断方法 |
DE112021004831T5 (de) | 2020-11-12 | 2023-09-28 | Fanuc Corporation | Anomaliedetektionsvorrichtung, die anomalien in einem leistungsübertragungsmechanismus zum übertragen einer durch einen motor ausgegebenen drehkraft detektiert |
CN114659688A (zh) * | 2020-12-22 | 2022-06-24 | 达明机器人股份有限公司 | 双回路力矩感知***及其感知方法 |
CN114659688B (zh) * | 2020-12-22 | 2024-05-28 | 达明机器人股份有限公司 | 双回路力矩感知***及其感知方法 |
CN113686569A (zh) * | 2021-08-19 | 2021-11-23 | 深圳市汇川技术股份有限公司 | 传动机构力矩检测方法、装置、设备及存储介质 |
CN114161481A (zh) * | 2021-10-12 | 2022-03-11 | 上海非夕机器人科技有限公司 | 安全***、关节组件及机器人 |
WO2023193627A1 (zh) * | 2022-04-06 | 2023-10-12 | 瑞龙诺赋(上海)医疗科技有限公司 | 器械驱动控制***及方法 |
Also Published As
Publication number | Publication date |
---|---|
JP4391381B2 (ja) | 2009-12-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4391381B2 (ja) | 多関節ロボットの減速機の異常判定装置及び多関節ロボットの減速機の異常判定方法 | |
KR101495949B1 (ko) | 감속기의 이상 판정 방법, 이상 판정 장치 및 로봇 시스템 | |
JP6512790B2 (ja) | ロボット制御方法、ロボット装置、プログラム、記録媒体及び物品の製造方法 | |
US10105807B2 (en) | Abnormality diagnosis device for machine tool, and abnormality diagnosis method | |
JP6898079B2 (ja) | 工作機械およびその制御方法 | |
JP4955791B2 (ja) | ロボットシステム | |
JP5905443B2 (ja) | 人協調型産業用ロボットの外力判定方法および外力判定装置 | |
JP6484287B2 (ja) | リニアガイドの損傷検知装置及び損傷検知方法 | |
JP5181954B2 (ja) | ロボットシステムの異常検出方法、ロボットシステム、ステージシステムの異常検出方法、ステージシステム、および、半導体製造装置 | |
JP2009202335A (ja) | 減速機の異常判定装置及び減速機の異常判定方法 | |
US20110222980A1 (en) | Module for on-line vibration detection and adjustment and machining center using the same | |
JP5849451B2 (ja) | ロボットの故障検出方法、制御装置およびロボット | |
JP5765686B2 (ja) | ロボット接触検知装置 | |
JP4261470B2 (ja) | 制御装置 | |
KR20130116916A (ko) | 로봇 및 로봇의 노이즈 제거 방법 | |
JPWO2006001479A1 (ja) | 異常検出方法およびモータ制御装置 | |
JP2019141967A (ja) | 振動解析装置および振動解析方法 | |
JP2019181611A (ja) | ロボットの制御装置 | |
JP2019144809A (ja) | サーボ制御装置 | |
JP2013144325A (ja) | ロボット装置、故障検出方法 | |
JP7377684B2 (ja) | ロボットシステム | |
JP2018106279A (ja) | 数値制御装置 | |
JP7021656B2 (ja) | 情報処理装置、情報処理方法、及び情報処理プログラム | |
JP3855629B2 (ja) | ロボットの干渉検出装置 | |
JP2020138305A (ja) | ロボットの制御方法、制御装置、プログラム、記憶媒体、ロボットシステム、製造方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070914 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090415 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090421 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090617 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090818 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090904 |
|
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: 20090929 |
|
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: 20091007 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121016 Year of fee payment: 3 |
|
R150 | Certificate of patent (=grant) or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131016 Year of fee payment: 4 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |