JP6678034B2 - 動作制御システム及び動作制御方法 - Google Patents
動作制御システム及び動作制御方法 Download PDFInfo
- Publication number
- JP6678034B2 JP6678034B2 JP2016003538A JP2016003538A JP6678034B2 JP 6678034 B2 JP6678034 B2 JP 6678034B2 JP 2016003538 A JP2016003538 A JP 2016003538A JP 2016003538 A JP2016003538 A JP 2016003538A JP 6678034 B2 JP6678034 B2 JP 6678034B2
- Authority
- JP
- Japan
- Prior art keywords
- actuator
- mechanical element
- speed
- mechanical
- machine element
- 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
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
- 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/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40552—Joint limit
Description
第1機械要素を備える可動部材と、
当該可動部材を可変な速度で移動させるアクチュエータと、
前記可動部材とは別個に構成され、かつ、前記第1機械要素と当接可能な位置に固定された第2機械要素と、
前記第1機械要素の位置及び速度を含む動作状態を認識する動作状態認識部と、
前記動作状態認識部により認識された前記第1機械要素の位置及び速度が、位置及び速度により表される2次元座標系で所定の許容範囲を逸脱した場合に、前記アクチュエータの動作を停止させる停止指示を前記アクチュエータに出力するアクチュエータ制御部とを備え、
前記アクチュエータ制御部は、前記第1機械要素の位置及び速度と、衝突時間と、前記第1機械要素又は前記第2機械要素が許容できる力である許容力を示す成分と、前記アクチュエータから前記可動部材にかかる抵抗力を示す成分と、前記第1機械要素にかかる慣性を示す成分とを用いた所定の条件式が成立する場合に、前記第1機械要素の位置及び速度が前記許容範囲に含まれると判定することを特徴とする。
前記第1機械要素と、前記第2機械要素とが接触する第1機械要素の位置である接触位置をゼロとし、前記第1機械要素と前記第2機械要素とが離間した第1機械要素の位置を正とし、前記第1機械要素が前記第2機械要素に向かって移動するときの速度を負の速度とした場合に、位置がゼロまたは正の所定値以上である一定範囲の定義域において値域が負でありかつ一次微分が負となる関数が前記許容範囲の境界の少なくとも一部を形成し、
前記定義域において前記関数の値と同一または当該関数の値よりも小さい速度が前記許容範囲外となることが好ましい。
前記アクチュエータは、前記可動部材を所定の軸回りに回転させるように構成され、
前記アクチュエータ制御部は、衝突時間をΔt、前記許容力を示す成分としての前記第1機械要素が許容できるトルク及び前記第2機械要素が許容できるトルクのうち小さいトルクをτlim、前記位置としての前記所定の軸回りに前記第1機械要素の前記第2機械要素側の面と前記第2機械要素の前記第1機械要素側の面とがなす角をθdiff、前記速度としての前記第2機械要素からみた前記第1機械要素の相対的な角速度をdθdiff、前記抵抗力を示す成分としての前記アクチュエータ停止後に前記アクチュエータから前記可動部材にかかる抵抗トルクをτbrake、前記慣性を示す成分としての前記第1機械要素のイナーシャをIとしたときに、前記所定の条件式としての下記式(1)が成立する場合に、前記第1機械要素の位置及び速度が前記許容範囲に含まれると判定することが好ましい。
τlimは、前記第1機械要素のせん断荷重及び前記第2機械要素のせん断荷重のいずれよりも小さい値であることが好ましい。
前記アクチュエータは、前記可動部材を並進運動させるように構成され、
前記アクチュエータ制御部は、衝突時間をΔt、前記許容力を示す成分としての前記第1機械要素が許容できる力及び前記第2機械要素が許容できる力のうち小さい力をFlim、前記位置としての前記第1機械要素の前記第2機械要素側の面と前記第2機械要素の前記第1機械要素側の面との距離をDdiff、前記速度としての前記第2機械要素からみた前記第1機械要素の相対的な速度をVdiff、前記抵抗力を示す成分としての前記アクチュエータ停止後に前記アクチュエータから前記可動部材にかかる抵抗力をFbrake、前記第1機械要素の質量をmとしたときに、前記所定の条件式としての下記式(2)が成立する場合に、前記第1機械要素の位置及び速度が前記許容範囲に含まれると判定することが好ましい。
次に、図3〜図5Bを参照して、制御部11によって実行される駆動制御処理を説明する。
Δt‥衝突時間、
τlim‥第1アーム側メカニカルストッパ261のせん断荷重及び第2アーム側メカニカルストッパ262のせん断荷重並びにロボット側メカニカルストッパ27のせん断荷重のいずれよりも小さい力、
τbrake‥前記アクチュエータ停止時に前記アクチュエータから前記可動部材にかかる抵抗トルク、
I‥イナーシャ、
θ‥アーム26の角度(図5A参照)、
dθ‥アーム26の角速度(図5A参照)、
θlim1‥第1接触角度、
θlim2‥第2接触角度。
本実施形態によれば、アーム26の角度及び角速度が許容範囲から逸脱した場合に、アクチュエータ25の動作停止指示が出力され、アクチュエータ25の動作が停止する。これにより、アーム26はアクチュエータ25による抵抗力を受けて減速する。
本実施形態では、アクチュエータ制御部112は、アクチュエータ25が可動部材としてのアーム26を回転させる場合についてのアクチュエータ25の動作を制御したが、これに加えてまたは代えて、アクチュエータ制御部が、アクチュエータが可動部材を並進運動させる場合においてのアクチュエータの動作を制御してもよい。
Δt‥衝突時間、
Flim‥アーム側メカニカルストッパが許容できる力及びロボット側メカニカルストッパが許容できる力のうち小さい力、
Ddiff‥アーム側メカニカルストッパのロボット側メカニカルストッパ側の面とロボット側メカニカルストッパのアーム側メカニカルストッパ側の面との距離、
Vdiff‥ロボット側メカニカルストッパからみたアーム側メカニカルストッパの相対的な速度、
Fbrake‥アクチュエータ停止後にアクチュエータから可動部材にかかる抵抗力、
m‥アーム側メカニカルストッパの質量。
Claims (6)
- 第1機械要素を備える可動部材と、
当該可動部材を可変な速度で移動させるアクチュエータと、
前記可動部材とは別個に構成され、かつ、前記第1機械要素と当接可能な位置に固定された第2機械要素と、
前記第1機械要素の位置及び速度を含む動作状態を認識する動作状態認識部と、
前記動作状態認識部により認識された前記第1機械要素の位置及び速度が、位置及び速度により表される2次元座標系で所定の許容範囲を逸脱した場合に、前記アクチュエータの動作を停止させる停止指示を前記アクチュエータに出力するアクチュエータ制御部とを備え、
前記アクチュエータ制御部は、前記第1機械要素の位置及び速度と、衝突時間と、前記第1機械要素又は前記第2機械要素が許容できる力である許容力を示す成分と、前記アクチュエータから前記可動部材にかかる抵抗力を示す成分と、前記第1機械要素にかかる慣性を示す成分とを用いた所定の条件式が成立する場合に、前記第1機械要素の位置及び速度が前記許容範囲に含まれると判定することを特徴とする動作制御システム。 - 請求項1記載の動作制御システムにおいて、
前記第1機械要素と、前記第2機械要素とが接触する第1機械要素の位置である接触位置をゼロとし、前記第1機械要素と前記第2機械要素とが離間した第1機械要素の位置を正とし、前記第1機械要素が前記第2機械要素に向かって移動するときの速度を負の速度とした場合に、位置がゼロまたは正の所定値以上である一定範囲の定義域において値域が負でありかつ一次微分が負となる関数が前記許容範囲の境界の少なくとも一部を形成し、
前記定義域において前記関数の値と同一または当該関数の値よりも小さい速度が前記許容範囲外となることを特徴とする動作制御システム。 - 請求項1又は2記載の動作制御システムにおいて、
前記アクチュエータは、前記可動部材を所定の軸回りに回転させるように構成され、
前記アクチュエータ制御部は、衝突時間をΔt、前記許容力を示す成分としての前記第1機械要素が許容できるトルク及び前記第2機械要素が許容できるトルクのうち小さいトルクをτlim、前記位置としての前記所定の軸回りに前記第1機械要素の前記第2機械要素側の面と前記第2機械要素の前記第1機械要素側の面とがなす角をθdiff、前記速度としての前記第2機械要素からみた前記第1機械要素の相対的な角速度をdθdiff、前記抵抗力を示す成分としての前記アクチュエータ停止後に前記アクチュエータから前記可動部材にかかる抵抗トルクをτbrake、前記慣性を示す成分としての前記第1機械要素のイナーシャをIとしたときに、前記所定の条件式としての下記式(1)が成立する場合に、前記第1機械要素の位置及び速度が前記許容範囲に含まれると判定することを特徴とする動作制御システム。
- 請求項3記載の動作制御システムにおいて、
τlimは、前記第1機械要素のせん断荷重及び前記第2機械要素のせん断荷重のいずれよりも小さい値であることを特徴とする動作制御システム。 - 請求項1又は2記載の動作制御システムにおいて、
前記アクチュエータは、前記可動部材を並進運動させるように構成され、
前記アクチュエータ制御部は、衝突時間をΔt、前記許容力を示す成分としての前記第1機械要素が許容できる力及び前記第2機械要素が許容できる力のうち小さい力をFlim、前記位置としての前記第1機械要素の前記第2機械要素側の面と前記第2機械要素の前記第1機械要素側の面との距離をDdiff、前記速度としての前記第2機械要素からみた前記第1機械要素の相対的な速度をVdiff、前記抵抗力を示す成分としての前記アクチュエータ停止後に前記アクチュエータから前記可動部材にかかる抵抗力をFbrake、前記第1機械要素の質量をmとしたときに、前記所定の条件式としての下記式(2)が成立する場合に、前記第1機械要素の位置及び速度が前記許容範囲に含まれると判定することを特徴とする動作制御システム。
- 第1機械要素を備える可動部材と、
当該可動部材を可変な速度で移動させるアクチュエータと、
前記可動部材とは別個に構成され、かつ、前記第1機械要素と当接可能な位置に固定された第2機械要素とを備えるシステムが実行する方法であって、
前記第1機械要素の位置及び速度を含む動作状態を認識する動作状態認識ステップと、
前記動作状態認識ステップにより認識された前記第1機械要素の位置及び速度が、位置及び速度により表される2次元座標系で所定の許容範囲を逸脱した場合に、前記アクチュエータの動作を停止させる停止指示を前記アクチュエータに出力するアクチュエータ停止制御ステップとを含み、
前記アクチュエータ停止制御ステップは、前記第1機械要素の位置及び速度と、衝突時間と、前記第1機械要素又は前記第2機械要素が許容できる力である許容力を示す成分と、前記アクチュエータから前記可動部材にかかる抵抗力を示す成分と、前記第1機械要素にかかる慣性を示す成分とを用いた所定の条件式が成立する場合に、前記第1機械要素の位置及び速度が前記許容範囲に含まれると判定することを特徴とする動作制御方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016003538A JP6678034B2 (ja) | 2016-01-12 | 2016-01-12 | 動作制御システム及び動作制御方法 |
US15/353,421 US10137571B2 (en) | 2016-01-12 | 2016-11-16 | Operation control system and operation control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016003538A JP6678034B2 (ja) | 2016-01-12 | 2016-01-12 | 動作制御システム及び動作制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017124449A JP2017124449A (ja) | 2017-07-20 |
JP6678034B2 true JP6678034B2 (ja) | 2020-04-08 |
Family
ID=59275344
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016003538A Active JP6678034B2 (ja) | 2016-01-12 | 2016-01-12 | 動作制御システム及び動作制御方法 |
Country Status (2)
Country | Link |
---|---|
US (1) | US10137571B2 (ja) |
JP (1) | JP6678034B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7073620B2 (ja) * | 2016-10-31 | 2022-05-24 | ヤマハ株式会社 | アクチュエータの駆動制御装置 |
WO2020028356A1 (en) * | 2018-07-30 | 2020-02-06 | Intuitive Surgical Operations, Inc. | Hard stop protection system and method |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6377692A (ja) | 1986-09-19 | 1988-04-07 | オムロン株式会社 | 作動範囲可変装置付き産業用ロボツト |
US8757345B2 (en) * | 2009-04-29 | 2014-06-24 | Novellus Systems, Inc. | Magnetic rotational hardstop for robot |
US20120061155A1 (en) * | 2010-04-09 | 2012-03-15 | Willow Garage, Inc. | Humanoid robotics system and methods |
-
2016
- 2016-01-12 JP JP2016003538A patent/JP6678034B2/ja active Active
- 2016-11-16 US US15/353,421 patent/US10137571B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2017124449A (ja) | 2017-07-20 |
US20170197312A1 (en) | 2017-07-13 |
US10137571B2 (en) | 2018-11-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9579798B2 (en) | Human collaborative robot system | |
US10464210B2 (en) | Method and device for open-loop/closed-loop control of a robot manipulator | |
JP6238021B2 (ja) | ロボット、ロボットの制御装置及び制御方法、並びに、ロボット用制御プログラム | |
EP1652634B1 (en) | Robot arm control method and control device | |
CN107813345B (zh) | 机器人碰撞检测方法及装置 | |
EP1477284B1 (en) | Drive control method and drive controller | |
JP7206638B2 (ja) | ロボット、制御装置およびロボットの制御方法 | |
US20130090761A1 (en) | Motor control device, robot hand, robot, and motor control method | |
KR102418451B1 (ko) | 로봇 제어 시스템 | |
KR101784585B1 (ko) | 다축 기계를 작동하기 위한 그리고/또는 감시하기 위한 방법 및 시스템 | |
WO2013027250A1 (ja) | ロボットシステム、ロボット及びロボット制御装置 | |
JP6678034B2 (ja) | 動作制御システム及び動作制御方法 | |
CN111098309A (zh) | 一种机械臂混杂控制方法、装置及系统 | |
CN110730706B (zh) | 机器人的控制 | |
JP2013169609A (ja) | ロボットの衝突検出方法 | |
JP2018062026A (ja) | ロボットの速度や加速度を制限する機能を備えたロボット制御装置 | |
EP3922418A1 (en) | Control device, control method, and recording medium | |
JP6088601B2 (ja) | 走行軸付きロボットにおけるツール先端の振れを抑制するロボット制御装置 | |
US20160288442A1 (en) | Servo press, control method, and a recording medium recording a program | |
JP2006167820A (ja) | ロボットアームの制御方法 | |
US11717961B2 (en) | Robot control method and robot control device | |
CN111890359B (zh) | 机器人避障方法、机械臂式机器人及存储介质 | |
CN111958586B (zh) | 机器人的速度控制方法、机械臂式机器人及存储介质 | |
KR100540588B1 (ko) | 모션 제어의 실시간 응답을 위한 궤적발생방법 및 시스템 | |
JP2017019058A (ja) | ロボット制御装置、ロボットおよびロボットシステム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20181127 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20191120 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20191210 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20200114 |
|
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: 20200310 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200316 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6678034 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |