JP6846717B2 - ロボットのジョイントの異常検出装置及び異常検出方法 - Google Patents
ロボットのジョイントの異常検出装置及び異常検出方法 Download PDFInfo
- Publication number
- JP6846717B2 JP6846717B2 JP2018024055A JP2018024055A JP6846717B2 JP 6846717 B2 JP6846717 B2 JP 6846717B2 JP 2018024055 A JP2018024055 A JP 2018024055A JP 2018024055 A JP2018024055 A JP 2018024055A JP 6846717 B2 JP6846717 B2 JP 6846717B2
- Authority
- JP
- Japan
- Prior art keywords
- robot
- motion
- kinematic pair
- value
- kinematic
- 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.)
- Active
Links
- 230000005856 abnormality Effects 0.000 title claims description 50
- 238000001514 detection method Methods 0.000 title claims description 39
- 230000033001 locomotion Effects 0.000 claims description 116
- 230000002159 abnormal effect Effects 0.000 claims description 37
- 238000004364 calculation method Methods 0.000 claims description 13
- 238000004088 simulation Methods 0.000 claims description 10
- 238000005259 measurement Methods 0.000 claims description 7
- 230000007423 decrease Effects 0.000 claims description 5
- 238000000034 method Methods 0.000 description 12
- 230000008859 change Effects 0.000 description 10
- 238000012545 processing Methods 0.000 description 9
- 238000005457 optimization Methods 0.000 description 5
- 239000012636 effector Substances 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 230000006399 behavior Effects 0.000 description 3
- 230000006866 deterioration Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000003860 storage Methods 0.000 description 3
- 239000003638 chemical reducing agent Substances 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000002547 anomalous effect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000002783 friction material Substances 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000000644 propagated effect Effects 0.000 description 1
- 239000011347 resin Substances 0.000 description 1
- 229920005989 resin Polymers 0.000 description 1
- 230000000284 resting effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
- B25J17/02—Wrist joints
- B25J17/0258—Two-dimensional joints
- B25J17/0266—Two-dimensional joints comprising more than two actuating or connecting rods
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
- B25J17/02—Wrist joints
- B25J17/0258—Two-dimensional joints
- B25J17/0275—Universal joints, e.g. Hooke, Cardan, ball joints
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/06—Safety devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/003—Programme-controlled manipulators having parallel kinematics
- B25J9/0045—Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base
- B25J9/0051—Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base with kinematics chains of the type rotary-universal-universal or rotary-spherical-spherical, e.g. Delta type manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/1623—Parallel manipulator, Stewart platform, links are attached to a common base and to a common platform, plate which is moved parallel to the base
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/406—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by monitoring or safety
- G05B19/4065—Monitoring tool breakage, life or condition
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39096—Self-collision, internal collison, collision between links of one robot
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
Description
12 基礎部
14 可動部
16a リンク部
18a モータ
20a 駆動リンク
22a 受動リンク
24a、26a ボールジョイント(球面軸受)
28 ボール
30 ハウジング
32 ライナー
34a 拘束プレート
36 制御装置
38 異常検出装置
40 スコア計算部
42 動作生成部
44 計測部
46 指標値算出部
48 判定部
50 記憶部
52 表示部
64、66 仮想球対偶
68 仮想リンク
70 仮想円
80 平行リンク型ロボット
86 5節リンク型ロボット
Claims (4)
- モータによって駆動する駆動リンクと、
前記駆動リンクの動作に伴って従動する複数の受動リンクと、
前記複数の受動リンクにそれぞれ連結される複数の対偶と、を有するロボットにおいて、前記受動リンクに連結された対偶が有する対偶素の間の異常なすき間を検出する異常検出装置であって、
前記ロボットを予め定めた複数の動作軌道の各々に沿って動作させるシミュレーションを行うとともに、前記複数の対偶の中から指定された、異常なすき間の有無を判定すべき対象対偶において対偶素同士の衝突が発生すると高くなり、かつ前記対象対偶以外の対偶において対偶素同士の衝突が発生すると低くなるスコアを、前記複数の動作軌道の各々について計算するスコア計算部と、
前記複数の動作軌道のうち、前記スコアが予め定めた閾値以上の動作軌道に沿ってロボットを移動させるためのロボット動作を生成する動作生成部と、
前記ロボット動作に従って前記ロボットが移動したときの、前記モータの駆動トルク又は電流値を計測する計測部と、
前記計測部が計測した駆動トルク又は電流値に関する値の変動の大きさに基づいた指標値を算出する指標値算出部と、
前記指標値の大きさに基づいて、前記対象対偶の対偶素間における異常なすき間の有無を判定する判定部と、を有し、
前記動作生成部は、前記複数の動作軌道を、それぞれのスコアと前記閾値との大小関係に基づいて第1及び第2のグループに分類し、前記閾値以上のスコアを有する第1のグループに属する動作軌道のうち、前記閾値未満のスコアを有する第2のグループに属する動作軌道から最も距離が離れた動作軌道、又は前記第2のグループに属する動作軌道から所定の距離以上離れた動作軌道に対応するロボット動作を生成する、異常検出装置。 - 前記指標値算出部は、前記駆動トルクの時間微分値の変動の大きさ、又は前記電流値の時間微分値の変動の大きさに基づいた指標値を算出する、請求項1に記載の異常検出装置。
- 前記駆動リンク及び前記受動リンクは、少なくとも1つの閉ループ型リンクを構成する、請求項1又は2に記載の異常検出装置。
- モータによって駆動する駆動リンクと、
前記駆動リンクの動作に伴って従動する複数の受動リンクと、
前記複数の受動リンクにそれぞれ連結される複数の対偶と、を有するロボットにおいて、前記受動リンクに連結された対偶が有する対偶素の間の異常なすき間を検出する異常検出方法であって、
前記ロボットを予め定めた複数の動作軌道の各々に沿って動作させるシミュレーションを行うとともに、前記複数の対偶の中から指定された、異常なすき間の有無を判定すべき対象対偶において対偶素同士の衝突が発生すると高くなり、かつ前記対象対偶以外の対偶において対偶素同士の衝突が発生すると低くなるスコアを、前記複数の動作軌道の各々について計算することと、
前記複数の動作軌道のうち、前記スコアが予め定めた閾値以上の動作軌道に沿ってロボットを移動させるためのロボット動作を生成することと、
前記ロボット動作に従って前記ロボットが移動したときの、前記モータの駆動トルク又は電流値を計測することと、
計測された駆動トルク又は電流値に関する値の変動の大きさに基づいた指標値を算出することと、
前記指標値の大きさに基づいて、前記対象対偶の対偶素間における異常なすき間の有無を判定することと、を含み、
前記ロボット動作を生成することは、前記複数の動作軌道を、それぞれのスコアと前記閾値との大小関係に基づいて第1及び第2のグループに分類し、前記閾値以上のスコアを有する第1のグループに属する動作軌道のうち、前記閾値未満のスコアを有する第2のグループに属する動作軌道から最も距離が離れた動作軌道、又は前記第2のグループに属する動作軌道から所定の距離以上離れた動作軌道に対応するロボット動作を生成することを含む、異常検出方法。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018024055A JP6846717B2 (ja) | 2018-02-14 | 2018-02-14 | ロボットのジョイントの異常検出装置及び異常検出方法 |
DE102019000889.8A DE102019000889A1 (de) | 2018-02-14 | 2019-02-07 | Vorrichtung und Verfahren zum Erkennen einer Abnormalität eines Robotergelenks |
US16/269,568 US10919143B2 (en) | 2018-02-14 | 2019-02-07 | Device and method for detecting abnormality of joint of robot |
CN201910111734.XA CN110154089A (zh) | 2018-02-14 | 2019-02-12 | 机器人的关节的异常检测装置以及异常检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018024055A JP6846717B2 (ja) | 2018-02-14 | 2018-02-14 | ロボットのジョイントの異常検出装置及び異常検出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019136838A JP2019136838A (ja) | 2019-08-22 |
JP6846717B2 true JP6846717B2 (ja) | 2021-03-24 |
Family
ID=67400139
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018024055A Active JP6846717B2 (ja) | 2018-02-14 | 2018-02-14 | ロボットのジョイントの異常検出装置及び異常検出方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US10919143B2 (ja) |
JP (1) | JP6846717B2 (ja) |
CN (1) | CN110154089A (ja) |
DE (1) | DE102019000889A1 (ja) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110977972B (zh) * | 2019-12-03 | 2021-02-12 | 珠海格力电器股份有限公司 | 一种多关节机器人碰撞检测方法、计算机可读存储介质及机器人 |
CN111015636B (zh) * | 2020-01-10 | 2022-08-02 | 福州大学 | 六自由度可展并联机构 |
JP7029681B2 (ja) * | 2020-03-18 | 2022-03-04 | 株式会社安川電機 | ロボット制御装置、ロボット制御システム、及びロボット制御方法 |
CN111604901B (zh) * | 2020-05-18 | 2022-06-24 | 哈尔滨工业大学 | 一种适用于机械手在手操作的目标旋转检测方法 |
KR102377428B1 (ko) * | 2020-05-21 | 2022-03-23 | 한국기계연구원 | 로봇용 툴 시스템 |
CN112273054B (zh) * | 2020-11-30 | 2022-06-17 | 南宁学院 | 一种三指柔性百香果采摘机械手 |
CN114619482A (zh) * | 2020-12-10 | 2022-06-14 | 合肥欣奕华智能机器股份有限公司 | 机器人故障预测方法、故障预测***及故障预测设备 |
JP7475615B2 (ja) | 2021-01-18 | 2024-04-30 | ファナック株式会社 | ロボットのジョイントのすき間検出装置及びすき間検出方法 |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SE513328C2 (sv) | 1998-11-11 | 2000-08-28 | Abb Ab | Manipulator och förfarande vid framställning av en manipulator |
JP3997201B2 (ja) | 2003-12-25 | 2007-10-24 | 株式会社不二越 | 産業用ロボットおよびその異常判断方法 |
JP2006281421A (ja) | 2005-04-05 | 2006-10-19 | Yaskawa Electric Corp | ロボットおよびロボットの異常検出方法 |
JP4335286B2 (ja) * | 2008-02-08 | 2009-09-30 | ファナック株式会社 | 部品保護機能を備えたロボット制御装置及びロボット制御方法 |
JP4588773B2 (ja) * | 2008-03-13 | 2010-12-01 | 三菱電機株式会社 | エレベータの異常検出装置 |
JP4850863B2 (ja) * | 2008-04-10 | 2012-01-11 | 村田機械株式会社 | パラレルメカニズム |
JP5149416B2 (ja) * | 2011-04-06 | 2013-02-20 | ファナック株式会社 | ロボットの異常検出機能を有するロボットシステム及びその制御方法 |
JP5408211B2 (ja) * | 2011-09-06 | 2014-02-05 | 株式会社安川電機 | パラレルリンクロボット、パラレルリンクロボットシステムおよびパラレルリンクロボットの制御方法 |
JP5912683B2 (ja) * | 2012-03-07 | 2016-04-27 | 株式会社神戸製鋼所 | モータ駆動構造を備えたシステム、モータ駆動構造のシステムに用いられるプログラム、および溶接物製造方法 |
JP5674734B2 (ja) * | 2012-08-31 | 2015-02-25 | ファナック株式会社 | ボールジョイントにより接続されたパラレルリンクロボット |
WO2014064926A1 (ja) * | 2012-10-25 | 2014-05-01 | パナソニック株式会社 | ロボットの異常表示方法 |
JP5905443B2 (ja) * | 2013-12-25 | 2016-04-20 | ファナック株式会社 | 人協調型産業用ロボットの外力判定方法および外力判定装置 |
JP6659238B2 (ja) * | 2015-05-28 | 2020-03-04 | ライフロボティクス株式会社 | ロボット装置及びステッピングモータ制御装置 |
JP6502194B2 (ja) | 2015-06-30 | 2019-04-17 | ヤマハ発動機株式会社 | 産業用ロボット |
JP2017056507A (ja) | 2015-09-15 | 2017-03-23 | 川崎重工業株式会社 | パラレルメカニズム |
JP6374439B2 (ja) * | 2016-06-03 | 2018-08-15 | ファナック株式会社 | パラレルリンクロボットの関節部の異常検出装置及び異常検出方法 |
-
2018
- 2018-02-14 JP JP2018024055A patent/JP6846717B2/ja active Active
-
2019
- 2019-02-07 US US16/269,568 patent/US10919143B2/en active Active
- 2019-02-07 DE DE102019000889.8A patent/DE102019000889A1/de active Pending
- 2019-02-12 CN CN201910111734.XA patent/CN110154089A/zh active Pending
Also Published As
Publication number | Publication date |
---|---|
DE102019000889A9 (de) | 2019-09-26 |
JP2019136838A (ja) | 2019-08-22 |
DE102019000889A1 (de) | 2019-08-14 |
US20190247998A1 (en) | 2019-08-15 |
US10919143B2 (en) | 2021-02-16 |
CN110154089A (zh) | 2019-08-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6846717B2 (ja) | ロボットのジョイントの異常検出装置及び異常検出方法 | |
JP6374439B2 (ja) | パラレルリンクロボットの関節部の異常検出装置及び異常検出方法 | |
JP6418782B2 (ja) | ロボットシステムの制御方法、プログラム、記録媒体、ロボットシステム、及び診断装置 | |
US10155312B2 (en) | Method for determining values influencing the movement of a robot | |
US11298822B2 (en) | Robot, method of controlling robot, and robot control device | |
US9421687B2 (en) | Robot control apparatus and robot control method | |
JP6711854B2 (ja) | 故障予測装置及び機械学習装置 | |
JP7463777B2 (ja) | 制御装置、学習装置、ロボットシステム、および方法 | |
JP7117697B2 (ja) | ロボットのジョイントの異常検出装置及び異常検出方法 | |
JP7262847B2 (ja) | 安全重視用途に関する産業ロボット動力学のシステム識別 | |
CN114051444B (zh) | 借助于至少一个机器人执行应用 | |
JP2020101541A (ja) | トルク推定のための方法および装置 | |
US10962957B2 (en) | Collision position estimation device and machine learning device | |
Van Vliet et al. | Experimental validation of contact dynamics simulation of constrained robotic tasks | |
WO2022172812A1 (ja) | ロボットモデルの学習装置、ロボットモデルの機械学習方法、ロボットモデルの機械学習プログラム、ロボット制御装置、ロボット制御方法、及びロボット制御プログラム | |
Paska et al. | Methodology of arm design for mobile robot manipulator using topological optimization | |
KR102003126B1 (ko) | 로봇의 안전성 평가 방법 | |
CN111331594A (zh) | 用于检查机器人装置的检查方法、控制装置和存储介质 | |
WO2022154021A1 (ja) | ロボットのジョイントのすき間検出装置及びすき間検出方法 | |
JP7278803B2 (ja) | 情報処理方法、情報処理装置、ロボットシステム、ロボットシステムの制御方法、ロボットシステムを用いた物品の製造方法、プログラム及び記録媒体 | |
Trojanová et al. | Validation of the dynamic model of the planar robotic arm with using gravity test | |
JP7267725B2 (ja) | ロボットの制御方法、プログラム、記録媒体、ロボットシステム、物品の製造方法 | |
US20240149450A1 (en) | Method of Handling Manipulator, Control System and Industrial Robot | |
Rinderknecht et al. | Fault-Tolerant Physical Human-Robot Interaction via Stiffness Adaptation of Elastic Actuators | |
JP2020059122A (ja) | 制御方法、制御プログラム、記録媒体、ロボットシステム、物品の製造方法、回転駆動装置の制御方法、およびロボット装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20191118 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20201030 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20201110 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20201225 |
|
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: 20210119 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20210216 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6846717 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |