JP7290472B2 - ロボットシステム - Google Patents
ロボットシステム Download PDFInfo
- Publication number
- JP7290472B2 JP7290472B2 JP2019100293A JP2019100293A JP7290472B2 JP 7290472 B2 JP7290472 B2 JP 7290472B2 JP 2019100293 A JP2019100293 A JP 2019100293A JP 2019100293 A JP2019100293 A JP 2019100293A JP 7290472 B2 JP7290472 B2 JP 7290472B2
- Authority
- JP
- Japan
- Prior art keywords
- external force
- torque
- upper limit
- robot
- limit 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.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Program-controlled manipulators
- B25J9/16—Program controls
- B25J9/1602—Program controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Program-controlled manipulators
- B25J9/16—Program controls
- B25J9/1602—Program controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Program-controlled manipulators
- B25J9/16—Program controls
- B25J9/1628—Program controls characterised by the control loop
- B25J9/1633—Program 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—Program-controlled manipulators
- B25J9/16—Program controls
- B25J9/1628—Program controls characterised by the control loop
- B25J9/1651—Program controls characterised by the control loop acceleration, rate control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Program-controlled manipulators
- B25J9/16—Program controls
- B25J9/1674—Program controls characterised by safety, monitoring, diagnostic
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Program-controlled manipulators
- B25J9/16—Program controls
- B25J9/1674—Program controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Program-controlled manipulators
- B25J9/16—Program controls
- B25J9/1628—Program controls characterised by the control loop
-
- 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—Program-control systems
- G05B19/02—Program-control systems electric
- G05B19/04—Program control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Program control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0426—Programming the control sequence
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Description
協働ロボットのように、人と協働して作業するロボットの場合に、ロボットと人とが接触することにより、ロボットから人に与えることが許容される力(許容接触力)の大きさは、ISO/TS15066に規定されている。
本実施形態に係るロボットシステム1は、図1に示されるように、ロボット2と、ロボット2を制御する制御装置3とを備えている。
手首ユニット8は、第2アーム7の長手方向に延びるJ4軸線D回りに第2アーム7に回転可能に支持された第1手首要素9を備えている。また、手首ユニット8は、J4軸線Dに直交するJ5軸線E回りに第1手首要素9に回転可能に支持された第2手首要素10を備えている。さらに、手首ユニット8は、J5軸線Eに直交し、J4軸線DとJ5軸線Eとの交点を通過するJ6軸線F回りに第2手首要素10に回転可能に支持された第3手首要素11を備えている。
すなわち、差分トルク算出部17により差分トルクが存在する場合には、差分トルクが存在する軸について、ロボット2の表面のいずれかの場所に外力Pが作用していることがわかる。
ISO/TS15066には、ロボット2と作業者とが接触することにより、作業者が損傷を受けずに耐え得る生体力学的な負荷の閾値が、接触する身体の部位ごとに設定されている。制御部15は、これらの閾値の内の最も小さい値を閾値として記憶しておき、算出された外力上限値Paが閾値よりも大きいか否かを判断する。
ここで、Paは合成された外力上限値、P1はJ1軸線A回りの外力上限値、P2はJ2軸線B回りの外力上限値である。
そして、ロボット2の第1アーム6に、図4に示されるように、水平面内における外力成分F1および、図5に示されるように、垂直面内における外力成分F2の外力が作用した場合を想定する。
また、上記においては、J1軸線A回りのトルクとJ2軸線B回りのトルクとを検出する場合を例示したが、これに限定されるものではない。
J4軸線DとJ5軸線Eとは、相互に直交する平面に沿って延びている。
したがって、この場合にも、図9に示されるように、式(1)に示される外力上限値P1,P2の2乗和の平方根により、合成された外力上限値Paを算出することができる。
ロボット2の動作制限としては、動作速度を所定の速度以下に低下させることにしてもよい。また、トルクセンサ12,13,14によってトルクを検出することが困難な外力Pの方向へロボット2を移動させないことにしてもよい。
また、本実施形態においては、トルクを検出するトルク検出部としてトルクセンサ12,13,14を例示したが、これに代えて、各部を駆動するモータの電流を検出してトルクを推定してもよい。
また、セカンダリエンコーダを備える場合には、セカンダリエンコーダにより検出された角度情報に基づいてトルクを推定してもよい。
2,20 ロボット
3 制御装置
4 ベース(第3部材)
5 旋回胴(第1部材)
6 第1アーム(第2部材)
7 第2アーム(第4部材)
12 トルクセンサ(第2トルク検出部)
13 トルクセンサ(第1トルク検出部)
14 トルクセンサ(第3トルク検出部)
18 外力上限値推定部
A,A1 J1軸線(第2軸線)
B,B1 J2軸線(第1軸線)
C,C1 J3軸線(第3軸線)
P 外力
Pa 外力上限値
P1 外力上限値(第2外力上限値)
P2 外力上限値(第1外力上限値)
P3 外力上限値(第3外力上限値)
Claims (9)
- ロボットと、該ロボットを制御する制御装置とを備え、
前記ロボットが、第1部材と、該第1部材に対して所定の第1軸線回りに回転駆動させられる第2部材と、前記第1軸線回りのトルクを検出する第1トルク検出部とを備え、
前記制御装置が、前記第1トルク検出部により検出された前記トルクに基づいて前記第2部材に作用した外力の想定し得る上限値である外力上限値を推定する外力上限値推定部を備え、
該外力上限値推定部が、前記第1トルク検出部により検出された前記トルクと、前記ロボットの姿勢および動作から算出した算出トルクとの差分トルクの絶対値を、前記第2部材の回転方向の両端部となる表面上に、物理的に接触可能な位置の前記第1軸線からの最小半径で除算した値を前記外力上限値として推定し、推定された前記外力上限値が、所定の閾値よりも大きい場合に、前記外力の増加を回避するよう前記ロボットを制御するロボットシステム。 - ロボットと、該ロボットを制御する制御装置とを備え、
前記ロボットが、第1部材と、該第1部材に対して所定の第1軸線回りに回転駆動させられる第2部材と、前記第1軸線回りのトルクを検出する第1トルク検出部とを備え、
前記制御装置が、前記第1トルク検出部により検出された前記トルクに基づいて前記第2部材に作用した外力の想定し得る上限値である外力上限値を推定する外力上限値推定部を備え、
該外力上限値推定部が、前記第1トルク検出部により検出された前記トルクと、前記ロボットの姿勢および動作から算出した算出トルクとの差分トルクの絶対値を、前記第2部材の回転方向の両端部となる表面上に、前記ロボットの設置環境上、接触可能な位置の前記第1軸線からの最小半径で除算した値を前記外力上限値として推定し、推定された前記外力上限値が、所定の閾値よりも大きい場合に、前記外力の増加を回避するよう前記ロボットを制御するロボットシステム。 - 前記ロボットが、前記第1軸線に直交する平面内に配置される所定の第2軸線回りに前記第1部材に対して相対的に回転駆動される第3部材と、前記第2軸線回りのトルクを検出する第2トルク検出部とを備え、
前記外力上限値推定部が、前記第1トルク検出部により検出された前記トルクに基づいて算出した第1外力上限値と、前記第2トルク検出部により検出された前記トルクに基づいて算出した第2外力上限値とを用いて前記外力上限値を推定する請求項1または請求項2に記載のロボットシステム。 - 前記外力上限値推定部が、前記第1外力上限値と、前記第2外力上限値との2乗和の平方根により前記外力上限値を推定する請求項3に記載のロボットシステム。
- 前記ロボットが、前記第1軸線に平行な第3軸線回りに前記第2部材に対して回転駆動される第4部材と、前記第3軸線回りのトルクを検出する第3トルク検出部とを備え、
前記外力上限値推定部が、前記第1トルク検出部により検出された前記トルクに基づいて算出した前記第1外力上限値と、前記第3トルク検出部により検出された前記トルクに基づいて算出した第3外力上限値とを用いて前記外力上限値を推定する請求項3または請求項4に記載のロボットシステム。 - 前記ロボットが、前記第1軸線に平行な第3軸線回りに前記第2部材に対して回転駆動される第4部材と、前記第3軸線回りのトルクを検出する第3トルク検出部とを備え、
前記外力上限値推定部が、前記第1トルク検出部により検出された前記トルクに基づいて算出した前記第1外力上限値と、前記第3トルク検出部により検出された前記トルクに基づいて算出した第3外力上限値とを比較して、いずれか小さい方のみを用いて前記外力上限値を推定する請求項3または請求項4に記載のロボットシステム。 - 前記制御装置は、前記ロボットが、前記ロボットに備えられた全ての前記トルク検出部により前記トルクを検出困難な外力が加わる接触の可能性がある特定姿勢であるか否かを判定し、前記特定姿勢であると判定される場合には前記ロボットの動作を制限する請求項3から請求項6のいずれかに記載のロボットシステム。
- 前記制御装置は、前記ロボットが前記特定姿勢であると判定される場合には、前記ロボットの動作速度を低下させる請求項7に記載のロボットシステム。
- 前記制御装置は、前記ロボットが前記特定姿勢であると判定される場合には、前記トルクを検出困難な前記外力の方向への前記ロボットの動作を制限する請求項7に記載のロボットシステム。
Priority Applications (4)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019100293A JP7290472B2 (ja) | 2019-05-29 | 2019-05-29 | ロボットシステム |
| US16/856,548 US11389959B2 (en) | 2019-05-29 | 2020-04-23 | Robot system |
| DE102020113686.2A DE102020113686A1 (de) | 2019-05-29 | 2020-05-20 | Robotersystem |
| CN202010453757.1A CN112008715B (zh) | 2019-05-29 | 2020-05-26 | 机器人系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019100293A JP7290472B2 (ja) | 2019-05-29 | 2019-05-29 | ロボットシステム |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2020192652A JP2020192652A (ja) | 2020-12-03 |
| JP7290472B2 true JP7290472B2 (ja) | 2023-06-13 |
Family
ID=73507010
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2019100293A Active JP7290472B2 (ja) | 2019-05-29 | 2019-05-29 | ロボットシステム |
Country Status (4)
| Country | Link |
|---|---|
| US (1) | US11389959B2 (ja) |
| JP (1) | JP7290472B2 (ja) |
| CN (1) | CN112008715B (ja) |
| DE (1) | DE102020113686A1 (ja) |
Families Citing this family (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113276118B (zh) * | 2021-05-24 | 2022-10-25 | 华南理工大学 | 一种机器人低速运动非线性动力学特性分析与建模方法 |
| DE112021008023T5 (de) | 2021-10-14 | 2024-05-08 | Fanuc Corporation | Steuervorrichtung zum steuern eines roboters, der mehrere aufbauelemente aufweist, robotervorrichtung, die mit der steuervorrichtung versehen ist, und betätigungsvorrichtung zum festlegen von parametern |
| JPWO2023195146A1 (ja) * | 2022-04-08 | 2023-10-12 | ||
| CN115488896B (zh) * | 2022-10-20 | 2024-11-26 | 北京航空航天大学杭州创新研究院 | 一种基于残余动态学习的机械臂未知外力识别与估计方法 |
| CN116572216A (zh) * | 2023-06-05 | 2023-08-11 | 广州达意隆包装机械股份有限公司 | 一种自立袋夹具控制系统、控制方法、装置及存储介质 |
| JP7829543B2 (ja) * | 2023-12-22 | 2026-03-13 | 株式会社安川電機 | ロボットシステム及び制御方法 |
| JP2026049442A (ja) * | 2024-09-06 | 2026-03-18 | 川崎重工業株式会社 | ロボットシステムおよびロボットシステムの制御方法 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2016117141A (ja) | 2014-12-22 | 2016-06-30 | ファナック株式会社 | 人との接触力を検出してロボットを停止させるロボット制御装置 |
| WO2017073052A1 (ja) | 2015-10-30 | 2017-05-04 | 川崎重工業株式会社 | ロボットシステムの監視装置 |
Family Cites Families (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CH623256A5 (ja) | 1977-10-19 | 1981-05-29 | Fischer Ag Georg | |
| JP4524729B2 (ja) | 2001-07-25 | 2010-08-18 | 株式会社安川電機 | 遠隔操縦ロボットの制御装置 |
| JP2006021287A (ja) | 2004-07-09 | 2006-01-26 | Univ Waseda | ロボットの接触力検出装置 |
| JP5930754B2 (ja) * | 2012-02-13 | 2016-06-08 | キヤノン株式会社 | ロボット装置の制御方法及びロボット装置 |
| CA2896381C (en) * | 2013-03-15 | 2017-01-10 | Synaptive Medical (Barbados) Inc. | Intelligent positioning system and methods therefore |
| JP6100727B2 (ja) | 2014-04-09 | 2017-03-22 | ファナック株式会社 | リードスルー機能を有する人協調型産業用ロボット |
| JP6140114B2 (ja) | 2014-07-31 | 2017-05-31 | ファナック株式会社 | 移動式人協調型ロボット |
| US10201901B2 (en) * | 2015-01-29 | 2019-02-12 | Canon Kabushiki Kaisha | Robot apparatus, method for controlling robot, program, and recording medium |
| JP6996177B2 (ja) * | 2017-09-11 | 2022-01-17 | セイコーエプソン株式会社 | ロボット、力センサーのオフセット補正装置、及び、ロボットの制御方法 |
| GB2575113B (en) * | 2018-06-29 | 2022-06-08 | Cmr Surgical Ltd | Detecting collisions of robot arms |
| WO2020017370A1 (ja) * | 2018-07-17 | 2020-01-23 | ソニー株式会社 | 制御装置、制御方法、及び制御システム |
| JP7015267B2 (ja) * | 2019-03-29 | 2022-02-02 | ファナック株式会社 | ロボット制御装置及びロボットシステム |
-
2019
- 2019-05-29 JP JP2019100293A patent/JP7290472B2/ja active Active
-
2020
- 2020-04-23 US US16/856,548 patent/US11389959B2/en active Active
- 2020-05-20 DE DE102020113686.2A patent/DE102020113686A1/de active Pending
- 2020-05-26 CN CN202010453757.1A patent/CN112008715B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2016117141A (ja) | 2014-12-22 | 2016-06-30 | ファナック株式会社 | 人との接触力を検出してロボットを停止させるロボット制御装置 |
| WO2017073052A1 (ja) | 2015-10-30 | 2017-05-04 | 川崎重工業株式会社 | ロボットシステムの監視装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| US20200376660A1 (en) | 2020-12-03 |
| US11389959B2 (en) | 2022-07-19 |
| DE102020113686A1 (de) | 2020-12-24 |
| CN112008715B (zh) | 2024-09-13 |
| CN112008715A (zh) | 2020-12-01 |
| JP2020192652A (ja) | 2020-12-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7290472B2 (ja) | ロボットシステム | |
| US8812157B2 (en) | Robot system having error detection function of robot and control method thereof | |
| CN104908047B (zh) | 感知与外部环境的接触的机器人控制装置 | |
| JP4508164B2 (ja) | 多関節ロボット及びその制御プログラム | |
| US10434646B2 (en) | Robot control apparatus, robot, and robot system | |
| JP2016007645A (ja) | アームの退避機能を有する多関節ロボット | |
| US10213916B2 (en) | Control apparatus and robot system | |
| CN105583826A (zh) | 工业机器人和用于控制工业机器人的方法 | |
| CN108367437A (zh) | 识别机器人臂与物体相撞的方法和具有机器人臂的机器人 | |
| US10377043B2 (en) | Robot control apparatus, robot, and robot system | |
| JP6633587B2 (ja) | ロボットの構成部材の速度を制限する制御装置 | |
| JP6841802B2 (ja) | ロボットおよびロボットシステム | |
| JP2012051042A (ja) | ロボットシステム及びロボット制御装置 | |
| WO2013175553A1 (ja) | ロボット | |
| JP2018144136A (ja) | ロボットシステム | |
| JP2019188514A (ja) | ロボットを用いた負荷の重量及び重心位置を推定するための装置、方法及びプログラム | |
| CN112440274B (zh) | 机器人系统 | |
| CN107363851A (zh) | 控制装置以及机器人系统 | |
| Shirinzadeh et al. | A hybrid contact state analysis methodology for robotic-based adjustment of cylindrical pair | |
| JP7057316B2 (ja) | ロボット | |
| JP7436241B2 (ja) | ロボットシステム | |
| KR102855324B1 (ko) | 로봇 제어 시스템 및 방법 | |
| JP2006116635A5 (ja) | ||
| CN115379931A (zh) | 协同机器人 | |
| JP2024164671A (ja) | 協働ロボットシステム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220114 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20221122 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20221129 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230120 |
|
| 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: 20230502 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230601 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7290472 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |