JP2001117618A - 駆動制御方法および駆動制御装置 - Google Patents
駆動制御方法および駆動制御装置Info
- Publication number
- JP2001117618A JP2001117618A JP30037799A JP30037799A JP2001117618A JP 2001117618 A JP2001117618 A JP 2001117618A JP 30037799 A JP30037799 A JP 30037799A JP 30037799 A JP30037799 A JP 30037799A JP 2001117618 A JP2001117618 A JP 2001117618A
- Authority
- JP
- Japan
- Prior art keywords
- collision
- drive control
- current value
- driving
- driven member
- 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
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/1674—Programme 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—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
-
- 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
-
- 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/37—Measurements
- G05B2219/37285—Load, current taken by motor
-
- 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/37—Measurements
- G05B2219/37632—By measuring current, load of motor
-
- 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/40476—Collision, planning for collision free path
-
- 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/40497—Collision monitor controls planner in real time to replan if collision
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)
- Manipulator (AREA)
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】
【課題】 ロボットなどの駆動手段により駆動される被
駆動部材の障害物との衝突を精度良く検出するととも
に、衝突によって発生する各部材の損傷を最小限に留め
ることができる駆動制御方法および駆動制御装置を提供
する。 【解決手段】 駆動手段により駆動される被駆動部材の
障害物との衝突を検出する衝突検出手段と、前記駆動手
段により駆動される被駆動部材の経路を記憶する経路記
憶手段と、前記衝突検出手段により衝突が検出されたと
きに前記経路記憶手段に記憶された前記衝突までの経路
に基づいて、前記被駆動部材が前記障害物から所定距離
離れるように前記駆動手段を制御する制御手段とを備え
てなるもので、駆動手段により駆動される被駆動部材の
障害物との衝突が検出されたとき、前記被駆動部材を前
記障害物から所定距離離すように前記駆動手段を制御す
るものである。
駆動部材の障害物との衝突を精度良く検出するととも
に、衝突によって発生する各部材の損傷を最小限に留め
ることができる駆動制御方法および駆動制御装置を提供
する。 【解決手段】 駆動手段により駆動される被駆動部材の
障害物との衝突を検出する衝突検出手段と、前記駆動手
段により駆動される被駆動部材の経路を記憶する経路記
憶手段と、前記衝突検出手段により衝突が検出されたと
きに前記経路記憶手段に記憶された前記衝突までの経路
に基づいて、前記被駆動部材が前記障害物から所定距離
離れるように前記駆動手段を制御する制御手段とを備え
てなるもので、駆動手段により駆動される被駆動部材の
障害物との衝突が検出されたとき、前記被駆動部材を前
記障害物から所定距離離すように前記駆動手段を制御す
るものである。
Description
【０００１】
【発明の属する技術分野】本発明は駆動制御方法および
駆動制御装置に関する。さらに詳しくは、駆動手段とし
てのロボットのアームに取付けられたハンドや各種ツー
ルなどの被駆動部材の障害物との衝突を検出して、この
衝突により発生する各部材の損傷を最小限に留めるよう
に制御する駆動制御方法および駆動制御装置に関する。
駆動制御装置に関する。さらに詳しくは、駆動手段とし
てのロボットのアームに取付けられたハンドや各種ツー
ルなどの被駆動部材の障害物との衝突を検出して、この
衝突により発生する各部材の損傷を最小限に留めるよう
に制御する駆動制御方法および駆動制御装置に関する。
【０００２】
【従来の技術】従来より、産業用ロボットが作業を行う
際のロボットの可動部分と障害物との衝突を検出する技
術に関し、さまざまな提案がなされている。例えば、特
開平５−２０８３９４号公報では、ロボットのアームを
駆動するモータに取付けたトルクセンサの信号の乱れか
ら衝突を検出する方法が提案されており、特開平８−６
６８９３号公報および特開平１１−７０４９０号公報で
は、オブザーバによってロボットアームを駆動するサー
ボモータが受ける外乱トルクを推定し、この推定された
外乱トルクに基づいて障害物との衝突を検出する方法が
提案されている。また、特開平８−２２９８６４号公報
では、ロボットコントローラから指令される可動部分の
位置と実際の位置との偏差に基づいて衝突を検出する方
法に関し、ロボットの制御系の遅れ時間に基づいて理論
上の位置偏差を算出し、この理論上の位置偏差と実際の
位置偏差との比較結果から衝突を検出する方法が提案さ
れている。
際のロボットの可動部分と障害物との衝突を検出する技
術に関し、さまざまな提案がなされている。例えば、特
開平５−２０８３９４号公報では、ロボットのアームを
駆動するモータに取付けたトルクセンサの信号の乱れか
ら衝突を検出する方法が提案されており、特開平８−６
６８９３号公報および特開平１１−７０４９０号公報で
は、オブザーバによってロボットアームを駆動するサー
ボモータが受ける外乱トルクを推定し、この推定された
外乱トルクに基づいて障害物との衝突を検出する方法が
提案されている。また、特開平８−２２９８６４号公報
では、ロボットコントローラから指令される可動部分の
位置と実際の位置との偏差に基づいて衝突を検出する方
法に関し、ロボットの制御系の遅れ時間に基づいて理論
上の位置偏差を算出し、この理論上の位置偏差と実際の
位置偏差との比較結果から衝突を検出する方法が提案さ
れている。
【０００３】一方、衝突が検出された後の処置に関して
は、特開平７−１４３７８０号公報が、衝突が検出され
たときにモータに対して駆動方向と逆向きのトルクを加
えることによって、衝突検出からロボットの衝突部分が
停止するまでの時間を短縮する方法を提案している。
は、特開平７−１４３７８０号公報が、衝突が検出され
たときにモータに対して駆動方向と逆向きのトルクを加
えることによって、衝突検出からロボットの衝突部分が
停止するまでの時間を短縮する方法を提案している。
【０００４】このように、従来より、ロボットの可動部
分と障害物との衝突を検出する技術および衝突検出後に
ロボットの衝突部分を停止させる技術に関し、さまざま
な提案がなされているが、これら従来技術においてもな
お衝突により発生する各部材の損傷の程度を抑制する点
に関し充分に考慮されているとはいえない。というの
は、衝突を検出してロボットを停止させるだけでは、ロ
ボットの可動部分が障害物に押付けられた状態が一定時
間維持されるため、衝突の衝撃を緩和することができ
ず、衝突によって発生する各部材の損傷を最小限のもの
に抑制することは困難であるからである。
分と障害物との衝突を検出する技術および衝突検出後に
ロボットの衝突部分を停止させる技術に関し、さまざま
な提案がなされているが、これら従来技術においてもな
お衝突により発生する各部材の損傷の程度を抑制する点
に関し充分に考慮されているとはいえない。というの
は、衝突を検出してロボットを停止させるだけでは、ロ
ボットの可動部分が障害物に押付けられた状態が一定時
間維持されるため、衝突の衝撃を緩和することができ
ず、衝突によって発生する各部材の損傷を最小限のもの
に抑制することは困難であるからである。
【０００５】
【発明が解決しようとする課題】本発明はかかる従来技
術の課題に鑑みなされたものであって、ロボットなどの
駆動手段により駆動される被駆動部材の障害物との衝突
を精度良く検出するとともに、衝突によって発生する各
部材の損傷を最小限に留めることができる駆動制御方法
および駆動制御装置を提供することを目的としている。
術の課題に鑑みなされたものであって、ロボットなどの
駆動手段により駆動される被駆動部材の障害物との衝突
を精度良く検出するとともに、衝突によって発生する各
部材の損傷を最小限に留めることができる駆動制御方法
および駆動制御装置を提供することを目的としている。
【０００６】
【課題を解決するための手段】本発明の駆動制御方法
は、駆動手段により駆動される被駆動部材の障害物との
衝突が検出されたとき、前記衝突までの経路に基づいて
前記被駆動部材を前記障害物から所定距離離すように前
記駆動手段を制御することを特徴とする。
は、駆動手段により駆動される被駆動部材の障害物との
衝突が検出されたとき、前記衝突までの経路に基づいて
前記被駆動部材を前記障害物から所定距離離すように前
記駆動手段を制御することを特徴とする。
【０００７】本発明の駆動制御方法においては、例え
ば、前記被駆動部材の障害物との衝突を検出する基準値
は、前記被駆動部材を実際に駆動させて得られた前記駆
動手段の各動作毎のデータに基づいて設定される。
ば、前記被駆動部材の障害物との衝突を検出する基準値
は、前記被駆動部材を実際に駆動させて得られた前記駆
動手段の各動作毎のデータに基づいて設定される。
【０００８】本発明の駆動制御方法は、具体的には、前
記被駆動部材がロボットのアームとされ、前記アームを
駆動しているサーボモータの電流値が基準値を超えた場
合、衝突が検出されたものとされたり、あるいは前記ア
ームを駆動しているサーボモータの電流値の変化率が基
準値を超えた場合、衝突が検出されたものとされる。
記被駆動部材がロボットのアームとされ、前記アームを
駆動しているサーボモータの電流値が基準値を超えた場
合、衝突が検出されたものとされたり、あるいは前記ア
ームを駆動しているサーボモータの電流値の変化率が基
準値を超えた場合、衝突が検出されたものとされる。
【０００９】この場合、前記アームが複数の軸からなっ
ているときには、サーボモータの理論電流値から実電流
値を差し引いた値が理論電流値と異符号になっている軸
については、従前の駆動方向と反対方向に駆動する後退
処理をなし、サーボモータの理論電流値から実電流値を
差し引いた値が理論電流値と同符号になっている軸につ
いては、従前の駆動方向と同方向に駆動する前進処理を
なすのが好ましい。
ているときには、サーボモータの理論電流値から実電流
値を差し引いた値が理論電流値と異符号になっている軸
については、従前の駆動方向と反対方向に駆動する後退
処理をなし、サーボモータの理論電流値から実電流値を
差し引いた値が理論電流値と同符号になっている軸につ
いては、従前の駆動方向と同方向に駆動する前進処理を
なすのが好ましい。
【００１０】また、前記後退処理は、例えば、衝突発生
までの所定区間の経路を記憶する経路記憶処理と、前記
所定区間を逆に辿って障害物から所定距離離れる逃げ動
作処理とからなるものとされる。この場合、前記所定距
離が衝突前の被駆動部の速度に関係なく一定とされるの
が好ましい。
までの所定区間の経路を記憶する経路記憶処理と、前記
所定区間を逆に辿って障害物から所定距離離れる逃げ動
作処理とからなるものとされる。この場合、前記所定距
離が衝突前の被駆動部の速度に関係なく一定とされるの
が好ましい。
【００１１】一方、本発明の駆動制御装置は、駆動手段
により駆動される被駆動部材の障害物との衝突を検出す
る衝突検出手段と、前記駆動手段により駆動される被駆
動部材の経路を記憶する経路記憶手段と、前記衝突検出
手段により衝突が検出されたときに前記経路記憶手段に
記憶された前記衝突までの経路に基づいて、前記被駆動
部材が前記障害物から所定距離離れるように前記駆動手
段を制御する制御手段とを備えてなることを特徴とす
る。
により駆動される被駆動部材の障害物との衝突を検出す
る衝突検出手段と、前記駆動手段により駆動される被駆
動部材の経路を記憶する経路記憶手段と、前記衝突検出
手段により衝突が検出されたときに前記経路記憶手段に
記憶された前記衝突までの経路に基づいて、前記被駆動
部材が前記障害物から所定距離離れるように前記駆動手
段を制御する制御手段とを備えてなることを特徴とす
る。
【００１２】本発明の駆動制御装置においては、例え
ば、前記衝突検出手段における前記衝突を検出するため
に用いる基準値は、前記被駆動部材を実際に駆動させて
得られた前記駆動手段の各動作毎のデータに基づいて設
定される。
ば、前記衝突検出手段における前記衝突を検出するため
に用いる基準値は、前記被駆動部材を実際に駆動させて
得られた前記駆動手段の各動作毎のデータに基づいて設
定される。
【００１３】本発明の駆動制御装置は、具体的には、前
記被駆動部材がロボットのアームとされ、前記駆動手段
がサーボモータとされ、そして前記衝突検出手段が、前
記サーボモータの電流値が基準値を超えた場合に衝突を
検出するものとされたり、あるいは前記サーボモータの
電流値の変化率が基準値を超えた場合に衝突を検出する
ものとされる。
記被駆動部材がロボットのアームとされ、前記駆動手段
がサーボモータとされ、そして前記衝突検出手段が、前
記サーボモータの電流値が基準値を超えた場合に衝突を
検出するものとされたり、あるいは前記サーボモータの
電流値の変化率が基準値を超えた場合に衝突を検出する
ものとされる。
【００１４】この場合、前記アームが複数の軸からな
り、また前記駆動手段が前記各軸に装着されたサーボモ
ータとされているときには、前記サーボモータの理論電
流値から実電流値を差し引いた値が理論電流値と異符号
になっている軸については、前記制御手段が従前の駆動
方向と反対方向に駆動する後退処理をなし、前記サーボ
モータの理論電流値から実電流値を差し引いた値が理論
電流値と同符号になっている軸については、前記制御手
段が従前の駆動方向と同方向に駆動する前進処理をなす
のが好ましい。
り、また前記駆動手段が前記各軸に装着されたサーボモ
ータとされているときには、前記サーボモータの理論電
流値から実電流値を差し引いた値が理論電流値と異符号
になっている軸については、前記制御手段が従前の駆動
方向と反対方向に駆動する後退処理をなし、前記サーボ
モータの理論電流値から実電流値を差し引いた値が理論
電流値と同符号になっている軸については、前記制御手
段が従前の駆動方向と同方向に駆動する前進処理をなす
のが好ましい。
【００１５】ここで、前記後退処理は、衝突発生までの
所定区間の経路を記憶する経路記憶処理と、前記所定区
間を逆に辿って障害物から所定距離離れる逃げ動作処理
とからなるものとされ、そして前記所定距離が衝突前の
被駆動部の速度に関係なく一定とされてなるのが好まし
い。
所定区間の経路を記憶する経路記憶処理と、前記所定区
間を逆に辿って障害物から所定距離離れる逃げ動作処理
とからなるものとされ、そして前記所定距離が衝突前の
被駆動部の速度に関係なく一定とされてなるのが好まし
い。
【００１６】しかして、前記駆動制御装置は、例えばロ
ボットに搭載される。
ボットに搭載される。
【００１７】
【作用】本発明は前記の如く構成されているので、被駆
動部材が障害物と衝突し、障害物に押付けられたままの
状態で放置されることがない。そのため、衝突によって
発生する各部材の損傷を最小限に留めることができる。
動部材が障害物と衝突し、障害物に押付けられたままの
状態で放置されることがない。そのため、衝突によって
発生する各部材の損傷を最小限に留めることができる。
【００１８】また、本発明の好ましい形態においては、
前記衝突検出手段により前記衝突を検出するための基準
値を、前記駆動手段に前記被駆動部材を実際に駆動させ
て得た前記駆動手段の各動作毎のデータに基づいて設定
するので、ロボットなどの駆動手段の実際の作動環境に
応じて精度良く衝突検出を行うことができる。
前記衝突検出手段により前記衝突を検出するための基準
値を、前記駆動手段に前記被駆動部材を実際に駆動させ
て得た前記駆動手段の各動作毎のデータに基づいて設定
するので、ロボットなどの駆動手段の実際の作動環境に
応じて精度良く衝突検出を行うことができる。
【００１９】
【発明の実施の形態】以下、添付図面を参照しながら本
発明を実施形態に基づいて説明するが、本発明はかかる
実施形態のみに限定されるものではない。
発明を実施形態に基づいて説明するが、本発明はかかる
実施形態のみに限定されるものではない。
【００２０】図１に本発明の一実施形態に係る駆動制御
方法が適用されている駆動制御装置を有するロボットを
運動機能を表す図記号を用いて模式的に示す。
方法が適用されている駆動制御装置を有するロボットを
運動機能を表す図記号を用いて模式的に示す。
【００２１】この駆動手段としてのロボット１は、回転
軸である第１、第２および第３の軸２、３、４と、旋回
軸である第４、第５および第６の軸５、６、７の６自由
度のアーム８を有する構成とされており、またこのアー
ム８の先端部分にはハンドや溶接ツールなどの被駆動部
材としてのエンドエフェクタ９が装着されている。そし
て、アーム８を構成する各軸２、３、４、５、６、７
は、図示省略するサーボモータを含むサーボ機構により
駆動される構成とされている。
軸である第１、第２および第３の軸２、３、４と、旋回
軸である第４、第５および第６の軸５、６、７の６自由
度のアーム８を有する構成とされており、またこのアー
ム８の先端部分にはハンドや溶接ツールなどの被駆動部
材としてのエンドエフェクタ９が装着されている。そし
て、アーム８を構成する各軸２、３、４、５、６、７
は、図示省略するサーボモータを含むサーボ機構により
駆動される構成とされている。
【００２２】前記サーボ機構には第１〜第６の軸２、
３、４、５、６、７それぞれの時間ｔにおける位置を指
示するために、図示省略するロボットコントローラから
位置指令値θ（ｉ）（ｉ＝１、２、３、４、５、６）が
送出されており、前記サーボ機構は各軸２、３、４、
５、６、７の実際の位置が、前記位置指令値θ（ｉ）に
より示される位置と合致するように各軸２、３、４、
５、６、７を駆動する。
３、４、５、６、７それぞれの時間ｔにおける位置を指
示するために、図示省略するロボットコントローラから
位置指令値θ（ｉ）（ｉ＝１、２、３、４、５、６）が
送出されており、前記サーボ機構は各軸２、３、４、
５、６、７の実際の位置が、前記位置指令値θ（ｉ）に
より示される位置と合致するように各軸２、３、４、
５、６、７を駆動する。
【００２３】次に、図２を参照して、前記エンドエフェ
クタ９のワークや治具などの障害物との衝突を検出する
衝突検出処理を説明する。
クタ９のワークや治具などの障害物との衝突を検出する
衝突検出処理を説明する。
【００２４】一般に、ロボットの運動方程式はロボット
関節の柔軟性を無視すれば下記式（１）で表すことがで
きる。
関節の柔軟性を無視すれば下記式（１）で表すことがで
きる。
【００２５】 Ｊ（θ）・ｄ2θ／ｄｔ2＋Ｃ（ｄθ／ｄｔ，θ）＋Ｐ（θ）＋ Ｄ・ｄθ／ｄｔ＋Ｅ（ｄθ／ｄｔ，θ）＝τ （１）
【００２６】ここで、θはロボットを構成する各軸の時
間ｔにおける位置を表す変数である。またｄθ／ｄｔは
変数θの１階微分値（すなわち、各軸の時間ｔにおける
速度）であり、ｄ2θ／ｄｔ2は２階微分値（すなわち、
各軸の時刻ｔにおける加速度）である。また、τは各軸
で発生するトルク（以下、理論トルクという）を表して
おり、Ｊ（θ）は各軸の慣性力を、Ｃ（ｄθ／ｄｔ，
θ）は遠心力およびコリオリ力を、Ｐ（θ）は各軸にか
かる重力を、Ｄ・ｄθ／ｄｔは粘性摩擦力を、Ｅ（ｄθ
／ｄｔ，θ）は静止・クーロン座標力をそれぞれ表して
いる。
間ｔにおける位置を表す変数である。またｄθ／ｄｔは
変数θの１階微分値（すなわち、各軸の時間ｔにおける
速度）であり、ｄ2θ／ｄｔ2は２階微分値（すなわち、
各軸の時刻ｔにおける加速度）である。また、τは各軸
で発生するトルク（以下、理論トルクという）を表して
おり、Ｊ（θ）は各軸の慣性力を、Ｃ（ｄθ／ｄｔ，
θ）は遠心力およびコリオリ力を、Ｐ（θ）は各軸にか
かる重力を、Ｄ・ｄθ／ｄｔは粘性摩擦力を、Ｅ（ｄθ
／ｄｔ，θ）は静止・クーロン座標力をそれぞれ表して
いる。
【００２７】図２は、前記エンドエフェクタ９の障害物
との衝突を検出する衝突検出処理の手順を示す流れ図で
ある。この処理は前記ロボットコントローラが前記位置
指令値θ（ｉ）を送出する周期ｍｔと同期して、ロボッ
トコントローラの制御により一定時間（例えば、２０ｍ
ｓｅｃ）毎に繰り返し実行される。
との衝突を検出する衝突検出処理の手順を示す流れ図で
ある。この処理は前記ロボットコントローラが前記位置
指令値θ（ｉ）を送出する周期ｍｔと同期して、ロボッ
トコントローラの制御により一定時間（例えば、２０ｍ
ｓｅｃ）毎に繰り返し実行される。
【００２８】先ず、前記式（１）の変数θに前記位置指
令値θ（ｉ）（ここで、ｉは軸番号を示し、ｉ＝１、
２、３、４、５、６とされる。）を代入することによっ
て、時刻ｔにおける第１〜第６の各軸２、３、４、５、
６、７それぞれの理論トルクτ（ｉ）が算出される（ス
テップＳ１）とともに、この算出されたτ（ｉ）値に相
当するトルクを前記サーボモータが発生するのに要する
電流（以下、理論電流値という）Ａ（ｉ）が算出される
（ステップＳ２）。
令値θ（ｉ）（ここで、ｉは軸番号を示し、ｉ＝１、
２、３、４、５、６とされる。）を代入することによっ
て、時刻ｔにおける第１〜第６の各軸２、３、４、５、
６、７それぞれの理論トルクτ（ｉ）が算出される（ス
テップＳ１）とともに、この算出されたτ（ｉ）値に相
当するトルクを前記サーボモータが発生するのに要する
電流（以下、理論電流値という）Ａ（ｉ）が算出される
（ステップＳ２）。
【００２９】次に、各軸（ｉ）を駆動するサーボモータ
に実際に流れている電流（以下、実電流値という）Ａｒ
（ｉ）が検出され、前記Ａ（ｉ）値とＡｒ（ｉ）値との
差の絶対値を表す差分電流値Ａｄ（ｉ）が下記式（２）
により算出される（ステップＳ３）。
に実際に流れている電流（以下、実電流値という）Ａｒ
（ｉ）が検出され、前記Ａ（ｉ）値とＡｒ（ｉ）値との
差の絶対値を表す差分電流値Ａｄ（ｉ）が下記式（２）
により算出される（ステップＳ３）。
【００３０】 Ａｄ（ｉ）＝ａｂｓ（Ａ（ｉ）−Ａｒ（ｉ）） （２）
【００３１】次に、前記差分電流値Ａｄ（ｉ）が各軸
２、３、４、５、６、７毎に設定される第１の基準値Ａ
Ｓ（ｉ）を超えているか否かが判定され（ステップＳ
４）、Ａｄ（ｉ）値がＡＳ（ｉ）値を超えている場合は
衝突が発生したものとして、衝突が検出されたことを値
１で示す衝突検出フラグＦＳＲを値１に設定し（ステッ
プＳ５）た後、応力除去処理（ステップＳ６）を実行
し、本処理を終了する。この応力除去処理では衝突によ
り被駆動部材と障害物と間に生じている応力を取り除く
ための処理が行われるが、その内容は後でさらに詳しく
説明する。
２、３、４、５、６、７毎に設定される第１の基準値Ａ
Ｓ（ｉ）を超えているか否かが判定され（ステップＳ
４）、Ａｄ（ｉ）値がＡＳ（ｉ）値を超えている場合は
衝突が発生したものとして、衝突が検出されたことを値
１で示す衝突検出フラグＦＳＲを値１に設定し（ステッ
プＳ５）た後、応力除去処理（ステップＳ６）を実行
し、本処理を終了する。この応力除去処理では衝突によ
り被駆動部材と障害物と間に生じている応力を取り除く
ための処理が行われるが、その内容は後でさらに詳しく
説明する。
【００３２】一方、Ａｄ（ｉ）値がＡＳ（ｉ）値を超え
ていない場合は、さらに差分電流値Ａｄ（ｉ）の微分値
である微分差分電流値ｄＡｄ（ｉ）／ｄｔ（すなわち、
差分電流値Ａｄ（ｉ）の変化速度）が各軸２、３、４、
５、６、７毎に設定される第２の基準値ＡＤＳ（ｉ）を
超えているか否かが判定される（ステップＳ７）。ｄＡ
ｄ（ｉ）／ｄｔ値がＡＤＳ（ｉ）を超えている場合は衝
突が発生したものとして、前記ステップＳ５以降の処理
に移行する一方、超えていない場合は、衝突が発生して
いないものとしてスタートに戻る。
ていない場合は、さらに差分電流値Ａｄ（ｉ）の微分値
である微分差分電流値ｄＡｄ（ｉ）／ｄｔ（すなわち、
差分電流値Ａｄ（ｉ）の変化速度）が各軸２、３、４、
５、６、７毎に設定される第２の基準値ＡＤＳ（ｉ）を
超えているか否かが判定される（ステップＳ７）。ｄＡ
ｄ（ｉ）／ｄｔ値がＡＤＳ（ｉ）を超えている場合は衝
突が発生したものとして、前記ステップＳ５以降の処理
に移行する一方、超えていない場合は、衝突が発生して
いないものとしてスタートに戻る。
【００３３】このように、本実施形態の駆動制御方法
は、衝突を検出する衝突検出手段が、ロボット１のアー
ム８を構成する各軸２、３、４、５、６、７を駆動する
サーボモータに供給される電流値Ａｒ（ｉ）に基づい
て、エンドエフェクタ９の障害物との衝突を検出するよ
うに構成されているので、衝突検出のためにトルクセン
サやオブザーバを特段に設ける必要がなく、構成を簡素
化できる。
は、衝突を検出する衝突検出手段が、ロボット１のアー
ム８を構成する各軸２、３、４、５、６、７を駆動する
サーボモータに供給される電流値Ａｒ（ｉ）に基づい
て、エンドエフェクタ９の障害物との衝突を検出するよ
うに構成されているので、衝突検出のためにトルクセン
サやオブザーバを特段に設ける必要がなく、構成を簡素
化できる。
【００３４】また、前記差分電流値Ａｄ（ｉ）の変化量
およびその変化速度を表す微分差分電流値ｄＡｄ（ｉ）
／ｄｔのいずれかが、それぞれに対して設定される基準
値ＡＳ（ｉ）またはＡＤＳ（ｉ）を超えたときに衝突が
発生したものと判定されるので、被駆動部材の駆動速度
の大小に拘らず、より迅速かつ正確に衝突を検出するこ
とが可能となる。
およびその変化速度を表す微分差分電流値ｄＡｄ（ｉ）
／ｄｔのいずれかが、それぞれに対して設定される基準
値ＡＳ（ｉ）またはＡＤＳ（ｉ）を超えたときに衝突が
発生したものと判定されるので、被駆動部材の駆動速度
の大小に拘らず、より迅速かつ正確に衝突を検出するこ
とが可能となる。
【００３５】次に、前記第１および第２の基準値ＡＳ
（ｉ）、ＡＤＳ（ｉ）の設定方法を説明する。
（ｉ）、ＡＤＳ（ｉ）の設定方法を説明する。
【００３６】手動による設定 ロボット専用言語に第１および第２の基準値ＡＳ
（ｉ）、ＡＤＳ（ｉ）を設定する命令を付加する。この
場合、各基準値ＡＳ（ｉ）、ＡＤＳ（ｉ）の値を小さく
すれば衝突検出の感度を上げることができるが、各設定
値が小さすぎると電気的ノイズなどによる駆動電流のぶ
れが衝突発生と判断されるなどの誤検出が多くなり、衝
突検出の信頼性が損なわれる。一方、各基準値ＡＳ
（ｉ）、ＡＤＳ（ｉ）の設定値が大きすぎる場合は、衝
突検出の感度が低下して、衝突検出時期を遅らせる結果
となる。したがって、衝突検出を迅速かつ正確に行うた
めには前記各基準値ＡＳ（ｉ）、ＡＤＳ（ｉ）を適切に
設定する必要があるが、さまざまな稼動状態の下で作業
を行うロボットの全ての作業工程において前記各基準値
ＡＳ（ｉ）、ＡＤＳ（ｉ）を手動により適切に設定する
のは困難な場合がある。
（ｉ）、ＡＤＳ（ｉ）を設定する命令を付加する。この
場合、各基準値ＡＳ（ｉ）、ＡＤＳ（ｉ）の値を小さく
すれば衝突検出の感度を上げることができるが、各設定
値が小さすぎると電気的ノイズなどによる駆動電流のぶ
れが衝突発生と判断されるなどの誤検出が多くなり、衝
突検出の信頼性が損なわれる。一方、各基準値ＡＳ
（ｉ）、ＡＤＳ（ｉ）の設定値が大きすぎる場合は、衝
突検出の感度が低下して、衝突検出時期を遅らせる結果
となる。したがって、衝突検出を迅速かつ正確に行うた
めには前記各基準値ＡＳ（ｉ）、ＡＤＳ（ｉ）を適切に
設定する必要があるが、さまざまな稼動状態の下で作業
を行うロボットの全ての作業工程において前記各基準値
ＡＳ（ｉ）、ＡＤＳ（ｉ）を手動により適切に設定する
のは困難な場合がある。
【００３７】自動設定 そこで、本実施形態では、実際にロボットに特定の作業
を行わせ、ロボットの各動作毎に各軸２、３、４、５、
６、７で発生する最大トルクを学習させ、この学習され
た最大トルクに基づいて、各基準値ＡＳ（ｉ）、ＡＤＳ
（ｉ）を設定する命令がロボット専用言語に組込まれて
いる。これによって、ロボットの実際の作動状態に応じ
て適切に各基準値ＡＳ（ｉ）、ＡＤＳ（ｉ）を設定し
て、精度よく衝突検出を行うことが可能となる。
を行わせ、ロボットの各動作毎に各軸２、３、４、５、
６、７で発生する最大トルクを学習させ、この学習され
た最大トルクに基づいて、各基準値ＡＳ（ｉ）、ＡＤＳ
（ｉ）を設定する命令がロボット専用言語に組込まれて
いる。これによって、ロボットの実際の作動状態に応じ
て適切に各基準値ＡＳ（ｉ）、ＡＤＳ（ｉ）を設定し
て、精度よく衝突検出を行うことが可能となる。
【００３８】次に、前記図２のステップＳ６で実行され
る応力除去処理について図３を参照して説明する。
る応力除去処理について図３を参照して説明する。
【００３９】この応力除去処理では、原則として、被駆
動部材を衝突までの経路に沿って後退させる逃げ動作を
実行させるように各軸２、３、４、５、６、７が前記サ
ーボ機構により駆動される。より具体的には、先ず、理
論電流値Ａ（ｉ）から実電流値Ａｒ（ｉ）を減算した値
（Ａ（ｉ）−Ａｒ（ｉ））が正の値であるか負の値であ
るかを判定する（ステップＳ１１）。この減算値（Ａ
（ｉ）−Ａｒ（ｉ））が理論電流値と異符号であれば、
当該軸（ｉ）が衝突時に被駆動部材を障害物の方向に駆
動していたものとして、当該軸（ｉ）による被駆動部材
の駆動方向を反転させる後退処理を実行する（ステップ
Ｓ１２）。この後退処理については後でさらに詳しく説
明する。
動部材を衝突までの経路に沿って後退させる逃げ動作を
実行させるように各軸２、３、４、５、６、７が前記サ
ーボ機構により駆動される。より具体的には、先ず、理
論電流値Ａ（ｉ）から実電流値Ａｒ（ｉ）を減算した値
（Ａ（ｉ）−Ａｒ（ｉ））が正の値であるか負の値であ
るかを判定する（ステップＳ１１）。この減算値（Ａ
（ｉ）−Ａｒ（ｉ））が理論電流値と異符号であれば、
当該軸（ｉ）が衝突時に被駆動部材を障害物の方向に駆
動していたものとして、当該軸（ｉ）による被駆動部材
の駆動方向を反転させる後退処理を実行する（ステップ
Ｓ１２）。この後退処理については後でさらに詳しく説
明する。
【００４０】また、前記減算値（Ａ（ｉ）−Ａｒ
（ｉ））が理論電流値と同符号であれば、当該軸（ｉ）
が衝突発生時に被駆動部材を障害物と反対の方向に駆動
していたものとして、当該軸（ｉ）の駆動方向を反転さ
せることなく、そのままの向きにそのままの速度あるい
は加速された速度で当該軸（ｉ）を駆動する前進処理を
実行する（ステップＳ１３）。
（ｉ））が理論電流値と同符号であれば、当該軸（ｉ）
が衝突発生時に被駆動部材を障害物と反対の方向に駆動
していたものとして、当該軸（ｉ）の駆動方向を反転さ
せることなく、そのままの向きにそのままの速度あるい
は加速された速度で当該軸（ｉ）を駆動する前進処理を
実行する（ステップＳ１３）。
【００４１】すなわち、例えば図４に示すように、エン
ドエフェクタ９を図中矢印Ａの方向に直線的に移動させ
る場合、第５の軸６は図中矢印Ｂの方向に回転される一
方、第６の軸７は図中矢印Ｃの方向に回転される。この
状態でエンドエフェクタ９が障害物１０と衝突した場
合、衝突により第５の軸６には障害物１０から当該軸６
の方向と逆方向に力が加わることになる。これにより、
当該軸６を駆動するサーボモータの負荷が増大して、実
電流値Ａｒ（５）は理論電流値Ａ（５）に比して増大し
ていく（図５参照）。これに対して、第６の軸７では衝
突により当該軸７の運動方向と順方向に障害物１０から
力が加わる。これにより当該軸７を駆動するサーボモー
タの負荷が減少して、実電流値Ａｒ（６）は理論電流値
Ａ（６）に比して減少していく。
ドエフェクタ９を図中矢印Ａの方向に直線的に移動させ
る場合、第５の軸６は図中矢印Ｂの方向に回転される一
方、第６の軸７は図中矢印Ｃの方向に回転される。この
状態でエンドエフェクタ９が障害物１０と衝突した場
合、衝突により第５の軸６には障害物１０から当該軸６
の方向と逆方向に力が加わることになる。これにより、
当該軸６を駆動するサーボモータの負荷が増大して、実
電流値Ａｒ（５）は理論電流値Ａ（５）に比して増大し
ていく（図５参照）。これに対して、第６の軸７では衝
突により当該軸７の運動方向と順方向に障害物１０から
力が加わる。これにより当該軸７を駆動するサーボモー
タの負荷が減少して、実電流値Ａｒ（６）は理論電流値
Ａ（６）に比して減少していく。
【００４２】したがって、実電流値Ａｒ（ｉ）と理論電
流値Ａ（ｉ）との大小関係と理論電流値の符号に基づい
て、衝突発生時に各軸２、３、４、５、６、７が被駆動
部材を障害物の方向に駆動していたかあるいは障害物と
反対の方向に駆動していたかを検出することができる。
このようにして、衝突発生時に被駆動部材を障害物と反
対の方向に駆動していたものとされた軸については、そ
のままの向きにそのままの速度あるいは加速された速度
で被駆動部材を駆動させることによって、当該軸の駆動
方向を反転させた場合に再び被駆動部材を障害物に押付
けるなどして損傷の程度を悪化させる結果となるのを防
止することができる。
流値Ａ（ｉ）との大小関係と理論電流値の符号に基づい
て、衝突発生時に各軸２、３、４、５、６、７が被駆動
部材を障害物の方向に駆動していたかあるいは障害物と
反対の方向に駆動していたかを検出することができる。
このようにして、衝突発生時に被駆動部材を障害物と反
対の方向に駆動していたものとされた軸については、そ
のままの向きにそのままの速度あるいは加速された速度
で被駆動部材を駆動させることによって、当該軸の駆動
方向を反転させた場合に再び被駆動部材を障害物に押付
けるなどして損傷の程度を悪化させる結果となるのを防
止することができる。
【００４３】次に、前記図３のステップＳ１２で実行さ
れる後退処理について図６〜図８を参照して説明する。
なお、この後退処理は、衝突発生までの経路を記憶する
経路記憶処理と、逃げ動作処理とから構成されている。
れる後退処理について図６〜図８を参照して説明する。
なお、この後退処理は、衝突発生までの経路を記憶する
経路記憶処理と、逃げ動作処理とから構成されている。
【００４４】図６は前記経路記憶処理の手順を示す流れ
図である。この処理は、前記ロボットコントローラが前
記サーボ機構に位置指令値θ（ｉ）を送出するのと同期
してロボット１の運転中常時バックグランドで繰り返し
実行される。
図である。この処理は、前記ロボットコントローラが前
記サーボ機構に位置指令値θ（ｉ）を送出するのと同期
してロボット１の運転中常時バックグランドで繰り返し
実行される。
【００４５】先ず、下記式（２）にしたがって、前記ロ
ボットコントローラから送出される位置指令値θ（ｉ）
および被駆動部材の移動速度を記憶していくサンプリン
グ周期ＳＲが算出される（ステップＳ２１）。
ボットコントローラから送出される位置指令値θ（ｉ）
および被駆動部材の移動速度を記憶していくサンプリン
グ周期ＳＲが算出される（ステップＳ２１）。
【００４６】 ＳＲ＝Ｌ／Ｔｖ （３）
【００４７】ここで、Ｌは前記応力除去処理において被
駆動部材を駆動しようとする距離（例えば、５０ｍｍ）
に応じて設定される定数である。Ｔｖは被駆動部材の速
度に比例する変数（以下、ツール速度という）である
が、ここでは前記ロボットコントローラから位置指令値
θ（ｉ）が送出される１周期の間に被駆動部材が移動す
る距離とされている。
駆動部材を駆動しようとする距離（例えば、５０ｍｍ）
に応じて設定される定数である。Ｔｖは被駆動部材の速
度に比例する変数（以下、ツール速度という）である
が、ここでは前記ロボットコントローラから位置指令値
θ（ｉ）が送出される１周期の間に被駆動部材が移動す
る距離とされている。
【００４８】次に、カウント値Ｃｎｔを値１インクリメ
ントし（ステップＳ２２）、このインクリメントされた
カウント値Ｃｎｔが前記サンプリング周期ＳＲと等しく
なったか否かが判定される。等しくない場合はステップ
２２に戻る一方、等しくなった場合には、その時刻ｔに
おける前記位置指令値θ（ｉ）、ツール速度Ｔｖ値およ
びサンプリング周期ＳＲ値が前記ロボットコントローラ
に設けられたメモリ装置（以下、単にメモリということ
もある）に記憶される（図８参照）。ここで、位置指令
値θ（ｉ）およびＴｖ値の各データの記憶方式は、メモ
リ領域を逃げ動作に必要なステップ数ｔsに対応させて
分割するとともに、各分割された領域に各軸２、３、
４、５、６、７と対応する位置指令値θｔj（ｉ）、ツ
ール速度Ｔｖjおよびサンプリング周期ＳＲjを格納して
いくようにされている。ここで、ｊ＝１，２，３，…，
ｔsとされている。なお、ｊ＝ｎが最新データを示す場
合は、ｊ＝ｎ＋１が最古のデータを示す。これはこのメ
モリ領域に対してｊに基づいたリングバッファを適用す
るためである。このとき、次のサンプリングでＪ＋１番
目のバッファに前記θ（ｉ）値、Ｔｖ値およびＳＲ値を
記憶させるためにｊを値１インクリメントしておく。
ントし（ステップＳ２２）、このインクリメントされた
カウント値Ｃｎｔが前記サンプリング周期ＳＲと等しく
なったか否かが判定される。等しくない場合はステップ
２２に戻る一方、等しくなった場合には、その時刻ｔに
おける前記位置指令値θ（ｉ）、ツール速度Ｔｖ値およ
びサンプリング周期ＳＲ値が前記ロボットコントローラ
に設けられたメモリ装置（以下、単にメモリということ
もある）に記憶される（図８参照）。ここで、位置指令
値θ（ｉ）およびＴｖ値の各データの記憶方式は、メモ
リ領域を逃げ動作に必要なステップ数ｔsに対応させて
分割するとともに、各分割された領域に各軸２、３、
４、５、６、７と対応する位置指令値θｔj（ｉ）、ツ
ール速度Ｔｖjおよびサンプリング周期ＳＲjを格納して
いくようにされている。ここで、ｊ＝１，２，３，…，
ｔsとされている。なお、ｊ＝ｎが最新データを示す場
合は、ｊ＝ｎ＋１が最古のデータを示す。これはこのメ
モリ領域に対してｊに基づいたリングバッファを適用す
るためである。このとき、次のサンプリングでＪ＋１番
目のバッファに前記θ（ｉ）値、Ｔｖ値およびＳＲ値を
記憶させるためにｊを値１インクリメントしておく。
【００４９】図６に戻り、前記ステップＳ２４の処理が
終了すると、カウント値Ｃｎｔをリセット（ステップＳ
２５）した後に元に戻る。
終了すると、カウント値Ｃｎｔをリセット（ステップＳ
２５）した後に元に戻る。
【００５０】このように、前記ツール速度Ｔｖに反比例
するように設定されたサンプリング周期ＳＲにより各軸
２、３、４、５、６、７の位置指令値θ（ｉ）をサンプ
リングすることによって、被駆動部材の衝突時の駆動速
度に拘らず前記応力除去動作における被駆動部材の駆動
距離を略一定とすることが可能となる。
するように設定されたサンプリング周期ＳＲにより各軸
２、３、４、５、６、７の位置指令値θ（ｉ）をサンプ
リングすることによって、被駆動部材の衝突時の駆動速
度に拘らず前記応力除去動作における被駆動部材の駆動
距離を略一定とすることが可能となる。
【００５１】次に、図７を参照して逃げ動作処理を説明
する。この処理は、前記ロボットコントローラが前記サ
ーボ機構に位置指令値θ（ｉ）を送出するのと同一の周
期ｍｔで、衝突検知直後から実行される。
する。この処理は、前記ロボットコントローラが前記サ
ーボ機構に位置指令値θ（ｉ）を送出するのと同一の周
期ｍｔで、衝突検知直後から実行される。
【００５２】先ず、衝突検出直前に前記メモリに記憶さ
れた最新のデータ（図８のメモリ領域ｔnに格納されて
いるθｔn（ｉ）値、Ｔｖn値およびＳＲn値）から古い
方向（図中矢印Ｅの方向）に、本処理が実行される毎に
順次データが読み出され、前記サーボ機構に各軸２、
３、４、５、６、７の位置を指令する位置指令値θ
（ｉ）として送出されていく（ステップＳ３１）。一つ
のメモリ領域内のデータの送出が終了すると、前記応力
除去動作において被駆動部材が現時点までに駆動された
距離を示す変数（以下、逃げ動作距離という）Ｄｓに前
記メモリから読み出されたデータにあるＴｖ値とＳＲ値
を乗算した値が加算される（ステップＳ３２）。
れた最新のデータ（図８のメモリ領域ｔnに格納されて
いるθｔn（ｉ）値、Ｔｖn値およびＳＲn値）から古い
方向（図中矢印Ｅの方向）に、本処理が実行される毎に
順次データが読み出され、前記サーボ機構に各軸２、
３、４、５、６、７の位置を指令する位置指令値θ
（ｉ）として送出されていく（ステップＳ３１）。一つ
のメモリ領域内のデータの送出が終了すると、前記応力
除去動作において被駆動部材が現時点までに駆動された
距離を示す変数（以下、逃げ動作距離という）Ｄｓに前
記メモリから読み出されたデータにあるＴｖ値とＳＲ値
を乗算した値が加算される（ステップＳ３２）。
【００５３】このＴｖ値が加算された逃げ動作距離Ｄｓ
が所望の逃げ動作距離（例えば、５０ｍｍ）に応じて設
定される定数（以下、逃げ動作距離判定閾値という）Ａ
Ｄ以上になったか否かが判定される（ステップＳ３
３）。Ｄｓ値がＡＤ値以上になっていない場合は、被駆
動部材が前記所望の逃げ動作距離駆動されていないもの
としてステップＳ３２に戻る一方、Ｄｓ値がＡＤ値以上
である場合は前記応力除去処理が完了したものとして、
各軸２、３、４、５、６、７を駆動しているサーボモー
タを停止させる（ステップＳ３４）とともに、前記Ｄｓ
値をリセットし（ステップＳ３５）、前記フラグＦＳＲ
を値０に設定した後（ステップＳ３６）、本処理を終了
する。
が所望の逃げ動作距離（例えば、５０ｍｍ）に応じて設
定される定数（以下、逃げ動作距離判定閾値という）Ａ
Ｄ以上になったか否かが判定される（ステップＳ３
３）。Ｄｓ値がＡＤ値以上になっていない場合は、被駆
動部材が前記所望の逃げ動作距離駆動されていないもの
としてステップＳ３２に戻る一方、Ｄｓ値がＡＤ値以上
である場合は前記応力除去処理が完了したものとして、
各軸２、３、４、５、６、７を駆動しているサーボモー
タを停止させる（ステップＳ３４）とともに、前記Ｄｓ
値をリセットし（ステップＳ３５）、前記フラグＦＳＲ
を値０に設定した後（ステップＳ３６）、本処理を終了
する。
【００５４】このように、本実施形態では、衝突が検出
されたときに所定の応力除去動作を行ってからロボット
を停止させるので、ロボットの各部材が障害物に押付け
られたままの状態で一定時間放置されることがなく、こ
れによって各部材の損傷を最小限に留めることができ
る。
されたときに所定の応力除去動作を行ってからロボット
を停止させるので、ロボットの各部材が障害物に押付け
られたままの状態で一定時間放置されることがなく、こ
れによって各部材の損傷を最小限に留めることができ
る。
【００５５】また、衝突検出のための各基準値ＡＳ
（ｉ）、ＡＤＳ（ｉ）が実際にロボットに特定の作業を
行わせて、ロボットの各動作毎に得られるデータに基づ
いて設定されるので、ロボットの実際の作動環境に応じ
て正確な衝突検出を行うことが可能となる。
（ｉ）、ＡＤＳ（ｉ）が実際にロボットに特定の作業を
行わせて、ロボットの各動作毎に得られるデータに基づ
いて設定されるので、ロボットの実際の作動環境に応じ
て正確な衝突検出を行うことが可能となる。
【００５６】さらに、衝突発生時に被駆動部材を障害物
と反対の方向に駆動している軸については、そのままの
方向に駆動されるので、このような軸を逆方向に駆動す
ることによって再び被駆動部材を障害物に押付けるなど
して損傷の程度を悪化させることを防止することができ
る。
と反対の方向に駆動している軸については、そのままの
方向に駆動されるので、このような軸を逆方向に駆動す
ることによって再び被駆動部材を障害物に押付けるなど
して損傷の程度を悪化させることを防止することができ
る。
【００５７】以上、本発明を実施形態に基づいて説明し
てきたが、本発明かかる実施形態のみに限定されるもの
ではなく、種々改変が可能である。例えば、実施形態で
はロボットのアームを例に取り説明されているが、本発
明の適用はロボットのアームに限定されるものではな
く、各種の駆動装置に適用できる。
てきたが、本発明かかる実施形態のみに限定されるもの
ではなく、種々改変が可能である。例えば、実施形態で
はロボットのアームを例に取り説明されているが、本発
明の適用はロボットのアームに限定されるものではな
く、各種の駆動装置に適用できる。
【００５８】
【発明の効果】以上説明したように、本発明によれば、
駆動手段により駆動される被駆動部材の障害物との衝突
が検出されたときに、前記被駆動部材を衝突前の経路に
基づいて所定距離離すようにさせているので、衝突によ
り発生する駆動手段などの損傷の程度を最小限のものに
留めることができるという優れた効果が得られる。
駆動手段により駆動される被駆動部材の障害物との衝突
が検出されたときに、前記被駆動部材を衝突前の経路に
基づいて所定距離離すようにさせているので、衝突によ
り発生する駆動手段などの損傷の程度を最小限のものに
留めることができるという優れた効果が得られる。
【００５９】また、本発明の好ましい形態においては、
前記被駆動部材の障害物との衝突を検出するための基準
値を、前記駆動手段に前記被駆動部材を実際に駆動させ
て得た前記駆動手段の各動作毎のデータに基づいて設定
するように構成されているので、駆動手段の実際の作動
状況に応じた適切な前記基準値の設定を行うことができ
るという優れた効果が得られる。これにより、さまざま
な駆動手段の作動状態において正確に衝突を検出するこ
とができるという効果も得られる。
前記被駆動部材の障害物との衝突を検出するための基準
値を、前記駆動手段に前記被駆動部材を実際に駆動させ
て得た前記駆動手段の各動作毎のデータに基づいて設定
するように構成されているので、駆動手段の実際の作動
状況に応じた適切な前記基準値の設定を行うことができ
るという優れた効果が得られる。これにより、さまざま
な駆動手段の作動状態において正確に衝突を検出するこ
とができるという効果も得られる。
【図１】本発明の一実施形態に係るロボットアームの概
略図である。
略図である。
【図２】本発明の一実施形態に係るロボットにおける衝
突検出処理の手順を示す流れ図である。
突検出処理の手順を示す流れ図である。
【図３】本発明の一実施形態に係るロボットアームの各
軸における衝突処理の手順を示す流れ図である。
軸における衝突処理の手順を示す流れ図である。
【図４】本発明の一実施形態に係るロボットアームの各
軸における衝突処理を補足説明するための説明図であ
る。
軸における衝突処理を補足説明するための説明図であ
る。
【図５】本発明の一実施形態に係るロボットアームの各
軸における衝突処理を補足説明するための説明図であ
る。
軸における衝突処理を補足説明するための説明図であ
る。
【図６】本発明の一実施形態に係るロボットにおける経
路記憶処理の手順を示す流れ図である。
路記憶処理の手順を示す流れ図である。
【図７】本発明の一実施形態に係るロボットにおける逃
げ動作処理の手順を示す流れ図である。
げ動作処理の手順を示す流れ図である。
【図８】前記経路記憶処理における記憶データのメモリ
内の格納状態を示すテーブル図である。
内の格納状態を示すテーブル図である。
１ ロボット ２ 第１の軸 ３ 第２の軸 ４ 第３の軸 ５ 第４の軸 ６ 第５の軸 ７ 第６の軸 ８ アーム ９ エンドエフェクタ １０ 障害物
───────────────────────────────────────────────────── フロントページの続き (72)発明者 前原 毅 明石市川崎町１番１号 川崎重工業株式会 社明石工場内 (72)発明者 松本 直之 明石市川崎町１番１号 川崎重工業株式会 社明石工場内 (72)発明者 加賀谷 博昭 千葉県野田市二ツ塚118番地 川崎重工業 株式会社野田工場内 Ｆターム(参考） 3F059 BA02 CA05 CA07 DC01 DD04 FC09 5H269 AB33 BB10 BB14 CC09 GG06 NN07 PP03 5H303 AA10 BB03 BB09 BB15 CC10 DD01 EE03 EE07 JJ05 JJ09 KK35 LL03
Claims (15)
- 【請求項１】 駆動手段により駆動される被駆動部材の
障害物との衝突が検出されたとき、前記衝突までの経路
に基づいて前記被駆動部材を前記障害物から所定距離離
すように前記駆動手段を制御することを特徴とする駆動
制御方法。 - 【請求項２】 前記被駆動部材の障害物との衝突を検出
する基準値が、前記被駆動部材を実際に駆動させて得ら
れた前記駆動手段の各動作毎のデータに基づいて設定さ
れることを特徴とする請求項１記載の駆動制御方法。 - 【請求項３】 前記被駆動部材がロボットのアームとさ
れ、前記アームを駆動しているサーボモータの電流値が
基準値を超えた場合、衝突が検出されたものとすること
を特徴とする請求項１または２記載の駆動制御方法。 - 【請求項４】 前記被駆動部材がロボットのアームとさ
れ、前記アームを駆動しているサーボモータの電流値の
変化率が基準値を超えた場合、衝突が検出されたものと
することを特徴とする請求項１または２記載の駆動制御
方法。 - 【請求項５】 前記アームが複数の軸からなり、サーボ
モータの理論電流値から実電流値を差し引いた値が理論
電流値と異符号になっている軸については、従前の駆動
方向と反対方向に駆動する後退処理をなし、サーボモー
タの理論電流値から実電流値を差し引いた値が理論電流
値と同符号になっている軸については、従前の駆動方向
と同方向に駆動する前進処理をなすことを特徴とする請
求項３または４記載の駆動制御方法。 - 【請求項６】 前記後退処理が、衝突発生までの所定区
間の経路を記憶する経路記憶処理と、前記所定区間を逆
に辿って障害物から所定距離離れる逃げ動作処理とから
なることを特徴とする請求項５記載の駆動制御方法。 - 【請求項７】 前記所定距離が衝突前の被駆動部の速度
に関係なく一定とされてなることを特徴とする請求項６
記載の駆動制御方法。 - 【請求項８】 駆動手段により駆動される被駆動部材の
障害物との衝突を検出する衝突検出手段と、前記駆動手
段により駆動される被駆動部材の経路を記憶する経路記
憶手段と、前記衝突検出手段により衝突が検出されたと
きに前記経路記憶手段に記憶された前記衝突までの経路
に基づいて、前記被駆動部材が前記障害物から所定距離
離れるように前記駆動手段を制御する制御手段とを備え
てなることを特徴とする駆動制御装置。 - 【請求項９】 前記衝突検出手段における前記衝突を検
出するために用いる基準値を、前記被駆動部材を実際に
駆動させて得られた前記駆動手段の各動作毎のデータに
基づいて設定することを特徴とする請求項８記載の駆動
制御装置。 - 【請求項１０】 前記被駆動部材がロボットのアームと
され、前記駆動手段がサーボモータとされ、 前記衝突検出手段が、前記サーボモータの電流値が基準
値を超えた場合に衝突を検出することを特徴とする請求
項８または９記載の駆動制御装置。 - 【請求項１１】 前記被駆動部材がロボットのアームと
され、前記駆動手段がサーボモータとされ、 前記衝突検出手段が、前記サーボモータの電流値の変化
率が基準値を超えた場合に衝突を検出することを特徴と
する請求項８または９記載の駆動制御装置。 - 【請求項１２】 前記アームが複数の軸からなり、前記
駆動手段が前記各軸に装着されたサーボモータとされ、
前記サーボモータの理論電流値から実電流値を差し引い
た値が理論電流値と異符号になっている軸については、
前記制御手段が従前の駆動方向と反対方向に駆動する後
退処理をなし、前記サーボモータの理論電流値から実電
流値を差し引いた値が理論電流値と同符号になっている
軸については、前記制御手段が従前の駆動方向と同方向
に駆動する前進処理をなすことを特徴とする請求項１０
または１１記載の駆動制御装置。 - 【請求項１３】 前記後退処理が、衝突発生までの所定
区間の経路を記憶する経路記憶処理と、前記所定区間を
逆に辿って障害物から所定距離離れる逃げ動作処理とか
らなることを特徴とする請求項１２記載の駆動制御装
置。 - 【請求項１４】 前記所定距離が衝突前の被駆動部の速
度に関係なく一定とされてなることを特徴とする請求項
１３記載の駆動制御装置。 - 【請求項１５】 請求項８ないし請求項１４に記載の駆
動制御装置を備えてなることを特徴とするロボット。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP30037799A JP3459973B2 (ja) | 1999-10-22 | 1999-10-22 | 駆動制御方法および駆動制御装置 |
| GB0025787A GB2355547B (en) | 1999-10-22 | 2000-10-20 | Drive-controlling method and drive-controlling apparatus |
| US09/692,870 US6429617B1 (en) | 1999-10-22 | 2000-10-20 | Drive-controlling method and apparatus and robot having the apparatus |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP30037799A JP3459973B2 (ja) | 1999-10-22 | 1999-10-22 | 駆動制御方法および駆動制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2001117618A true JP2001117618A (ja) | 2001-04-27 |
| JP3459973B2 JP3459973B2 (ja) | 2003-10-27 |
Family
ID=17884058
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP30037799A Expired - Lifetime JP3459973B2 (ja) | 1999-10-22 | 1999-10-22 | 駆動制御方法および駆動制御装置 |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US6429617B1 (ja) |
| JP (1) | JP3459973B2 (ja) |
| GB (1) | GB2355547B (ja) |
Cited By (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002283276A (ja) * | 2001-03-21 | 2002-10-03 | Daihen Corp | 多関節ロボットにおける衝突検出・停止制御法 |
| WO2003068464A1 (en) | 2002-02-18 | 2003-08-21 | Kawasaki Jukogyo Kabushiki Kaisha | Drive control method and drive controller |
| JP2003315205A (ja) * | 2002-04-26 | 2003-11-06 | Fuji Electric Co Ltd | 衝突検知装置及びその方法 |
| JP2007251088A (ja) * | 2006-03-20 | 2007-09-27 | Tokyo Electron Ltd | 縦型熱処理装置及び縦型熱処理装置における移載機構の制御方法 |
| JP2007265028A (ja) * | 2006-03-28 | 2007-10-11 | Kawasaki Heavy Ind Ltd | 駆動体の制御装置および制御方法 |
| CN100410030C (zh) * | 2006-07-07 | 2008-08-13 | 中国科学院力学研究所 | 一种基于虚拟场景的机器人避障路径规划方法 |
| JP2010137312A (ja) * | 2008-12-10 | 2010-06-24 | Yaskawa Electric Corp | ロボットシステムおよび制御方法 |
| JP2011189430A (ja) * | 2010-03-12 | 2011-09-29 | Denso Wave Inc | ロボットシステム |
| JP2014042984A (ja) * | 2013-12-11 | 2014-03-13 | Denso Wave Inc | ロボットシステム |
| DE102016000352A1 (de) | 2015-01-21 | 2016-07-21 | Fanuc Corporation | Robotersteuervorrichtung, die den roboter basierend auf einer auf den roboter ausgeübten externen kraft steuert, sowie robotersystem |
| JP2018202588A (ja) * | 2017-06-09 | 2018-12-27 | セイコーエプソン株式会社 | 制御装置、ロボットおよびロボットシステム |
| JP2019125067A (ja) * | 2018-01-15 | 2019-07-25 | Dmg森精機株式会社 | モータ駆動制御装置およびこれを備えてなる工作機械 |
| WO2019225158A1 (ja) * | 2018-05-22 | 2019-11-28 | ソニー株式会社 | ロボットの制御装置及びロボットの制御方法 |
| CN112123333A (zh) * | 2020-08-18 | 2020-12-25 | 珠海格力电器股份有限公司 | 一种多关节机器人碰撞检测方法及其装置 |
| JP2021500997A (ja) * | 2017-10-30 | 2021-01-14 | エシコン エルエルシーＥｔｈｉｃｏｎ ＬＬＣ | 外科用システムの反応アルゴリズム |
| JP2025518893A (ja) * | 2022-06-21 | 2025-06-19 | ユ－ジーン テクノロジー カンパニー．リミテッド | 基板搬送装置及び基板搬送装置の運用方法 |
| JP7759521B1 (ja) * | 2025-04-04 | 2025-10-23 | ヤマザキマザック株式会社 | 工作機械システム、工作機械システムの動作方法、および、プログラム |
Families Citing this family (29)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1675602A (zh) * | 2002-08-06 | 2005-09-28 | 阿森姆布里昂股份有限公司 | 检测通过驱动系统移动元件的过程中的故障的方法以及适于执行该方法的设备 |
| US7102315B2 (en) * | 2003-07-29 | 2006-09-05 | Matsushita Electric Industrial Co., Ltd. | Robot arm control method and control device |
| US20050263565A1 (en) * | 2003-10-23 | 2005-12-01 | Assembleon N.V. | Method and device for moving an element by means of a drive |
| US7395136B2 (en) * | 2004-02-10 | 2008-07-01 | Sig Doboy Inc. | Robot end effector detachment sensor |
| DE102004026185A1 (de) * | 2004-05-28 | 2005-12-22 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zum Betreiben einer Maschine, wie eines Mehrachs- Industrieroboters |
| JP4027350B2 (ja) * | 2004-06-29 | 2007-12-26 | ファナック株式会社 | ロボットの待機位置復帰プログラム作成装置 |
| DE102008024950A1 (de) * | 2008-05-23 | 2009-11-26 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zur Steuerung eines Manipulators |
| US9246749B1 (en) * | 2012-11-29 | 2016-01-26 | The United States Of America As Represented By Secretary Of The Navy | Method for automatic recovery of lost communications for unmanned ground robots |
| DE102013016019B3 (de) * | 2013-09-25 | 2015-03-19 | Festo Ag & Co. Kg | Verfahren zum Betreiben eines mehrgliedrigen Manipulators |
| US9792434B1 (en) | 2014-01-17 | 2017-10-17 | Knightscope, Inc. | Systems and methods for security data analysis and display |
| US10279488B2 (en) | 2014-01-17 | 2019-05-07 | Knightscope, Inc. | Autonomous data machines and systems |
| US10514837B1 (en) | 2014-01-17 | 2019-12-24 | Knightscope, Inc. | Systems and methods for security data analysis and display |
| US9329597B2 (en) * | 2014-01-17 | 2016-05-03 | Knightscope, Inc. | Autonomous data machines and systems |
| DE102014019187A1 (de) * | 2014-12-19 | 2016-06-23 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zum Steuern einer Antriebsanordnung zum Bewegen eines, insbesondere robotergeführten, Werkzeugs |
| US10329042B2 (en) * | 2015-03-20 | 2019-06-25 | Seiko Epson Corporation | Packing apparatus and packing method |
| JP6055014B2 (ja) | 2015-03-23 | 2016-12-27 | ファナック株式会社 | 物または人との接触を検知する機能を有するロボット制御装置 |
| US10730191B2 (en) * | 2015-10-30 | 2020-08-04 | Kawasaki Jukogyo Kabushiki Kaisha | Monitoring device of robot system |
| JP6450737B2 (ja) | 2016-12-08 | 2019-01-09 | ファナック株式会社 | ロボットシステム |
| CN108959753B (zh) * | 2018-06-26 | 2023-08-08 | 广州视源电子科技股份有限公司 | 碰撞检测方法、系统、可读存储介质及计算机设备 |
| CN110895409B (zh) * | 2018-08-23 | 2020-11-27 | 珠海格力电器股份有限公司 | 避让障碍物的控制方法 |
| CN109079738B (zh) * | 2018-08-24 | 2022-05-06 | 北京密塔网络科技有限公司 | 一种自适应agv机器人及自适应导航方法 |
| CN108748115B (zh) * | 2018-08-24 | 2022-05-06 | 北京密塔网络科技有限公司 | 一种多连杆自检协作机械臂及控制方法 |
| CN110340942B (zh) * | 2019-07-16 | 2021-01-29 | 北京北方华创微电子装备有限公司 | 机械手碰撞参数校准方法及系统 |
| CN110794764B (zh) * | 2019-11-28 | 2020-12-18 | 吉林工程技术师范学院 | 一种机器人的运动控制方法 |
| CN111645070B (zh) * | 2020-05-19 | 2022-06-14 | 华为技术有限公司 | 机器人的安全防护方法、装置与机器人 |
| CN111761596A (zh) * | 2020-06-08 | 2020-10-13 | 北京海益同展信息科技有限公司 | 一种触碰检测方法、装置、电子设备和计算机可读介质 |
| CN118204996A (zh) * | 2022-12-16 | 2024-06-18 | 深圳市海柔创新科技有限公司 | 机械手指的控制方法、装置、系统、设备 |
| CN116690578A (zh) * | 2023-06-30 | 2023-09-05 | 江苏东成工具科技有限公司 | 机器人碰撞检测方法、电子设备及存储介质 |
| CN116713997A (zh) * | 2023-06-30 | 2023-09-08 | 江苏东成工具科技有限公司 | 机器人碰撞检测方法、电子设备及存储介质 |
Family Cites Families (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS61131001A (ja) * | 1984-11-29 | 1986-06-18 | Toyota Motor Corp | ロボツト用制御装置 |
| JPS61143803A (ja) * | 1984-12-17 | 1986-07-01 | Toshiba Corp | ロボツトの制御装置 |
| JPH033687A (ja) * | 1989-05-31 | 1991-01-09 | Fanuc Ltd | サーボモータにより駆動される被駆動体の衝突破損防止方法 |
| JPH05208394A (ja) | 1992-01-28 | 1993-08-20 | Matsushita Electric Ind Co Ltd | ロボットアームの衝突検出装置 |
| JPH06245561A (ja) * | 1993-02-10 | 1994-09-02 | Fanuc Ltd | サーボモータの異常負荷検出制御方法 |
| JP2761454B2 (ja) * | 1993-12-09 | 1998-06-04 | インターナショナル・ビジネス・マシーンズ・コーポレイション | 自律移動機械の誘導方法 |
| JP3494685B2 (ja) | 1993-11-17 | 2004-02-09 | ファナック株式会社 | 非常停止方法及び非常停止装置 |
| JPH07306706A (ja) * | 1994-05-11 | 1995-11-21 | Toyota Autom Loom Works Ltd | ロボットの軌道修正装置及びその軌道修正方法 |
| JP3804994B2 (ja) * | 1994-07-15 | 2006-08-02 | ファナック株式会社 | ロボットの教示方法 |
| JPH0866893A (ja) | 1994-08-24 | 1996-03-12 | Fanuc Ltd | 衝突検出方法 |
| JPH08229864A (ja) | 1995-03-01 | 1996-09-10 | Daikin Ind Ltd | 産業用ロボットの衝突検知方法およびその装置 |
| JPH1170490A (ja) | 1997-06-30 | 1999-03-16 | Nachi Fujikoshi Corp | 産業用ロボットの衝突検出方法 |
| US6049756A (en) * | 1997-11-12 | 2000-04-11 | Lockheed Martin Corporation | System and method for avoiding collision between vector and solid objects |
| JPH11245191A (ja) * | 1998-02-27 | 1999-09-14 | Nachi Fujikoshi Corp | 産業用ロボットの駆動軸制御方法及びその装置 |
-
1999
- 1999-10-22 JP JP30037799A patent/JP3459973B2/ja not_active Expired - Lifetime
-
2000
- 2000-10-20 GB GB0025787A patent/GB2355547B/en not_active Expired - Lifetime
- 2000-10-20 US US09/692,870 patent/US6429617B1/en not_active Expired - Lifetime
Cited By (24)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002283276A (ja) * | 2001-03-21 | 2002-10-03 | Daihen Corp | 多関節ロボットにおける衝突検出・停止制御法 |
| WO2003068464A1 (en) | 2002-02-18 | 2003-08-21 | Kawasaki Jukogyo Kabushiki Kaisha | Drive control method and drive controller |
| JP2003236787A (ja) * | 2002-02-18 | 2003-08-26 | Kawasaki Heavy Ind Ltd | 駆動制御方法および駆動制御装置 |
| US7102311B2 (en) | 2002-02-18 | 2006-09-05 | Kawasaki Jukogyo Kabushiki Kaisha | Drive control method and drive controller |
| JP2003315205A (ja) * | 2002-04-26 | 2003-11-06 | Fuji Electric Co Ltd | 衝突検知装置及びその方法 |
| JP2007251088A (ja) * | 2006-03-20 | 2007-09-27 | Tokyo Electron Ltd | 縦型熱処理装置及び縦型熱処理装置における移載機構の制御方法 |
| JP2007265028A (ja) * | 2006-03-28 | 2007-10-11 | Kawasaki Heavy Ind Ltd | 駆動体の制御装置および制御方法 |
| CN100410030C (zh) * | 2006-07-07 | 2008-08-13 | 中国科学院力学研究所 | 一种基于虚拟场景的机器人避障路径规划方法 |
| JP2010137312A (ja) * | 2008-12-10 | 2010-06-24 | Yaskawa Electric Corp | ロボットシステムおよび制御方法 |
| US8423189B2 (en) | 2008-12-10 | 2013-04-16 | Kabushiki Kaisha Yaskawa Denki | Robot system and control method |
| JP2011189430A (ja) * | 2010-03-12 | 2011-09-29 | Denso Wave Inc | ロボットシステム |
| JP2014042984A (ja) * | 2013-12-11 | 2014-03-13 | Denso Wave Inc | ロボットシステム |
| DE102016000352A1 (de) | 2015-01-21 | 2016-07-21 | Fanuc Corporation | Robotersteuervorrichtung, die den roboter basierend auf einer auf den roboter ausgeübten externen kraft steuert, sowie robotersystem |
| US9737991B2 (en) | 2015-01-21 | 2017-08-22 | Fanuc Corporation | Robot control device controlling robot based on external force applied to robot and robot system |
| DE102016000352B4 (de) | 2015-01-21 | 2022-01-13 | Fanuc Corporation | Robotersteuervorrichtung, die den roboter basierend auf einer auf den roboter ausgeübten externen kraft steuert, sowie robotersystem |
| JP2018202588A (ja) * | 2017-06-09 | 2018-12-27 | セイコーエプソン株式会社 | 制御装置、ロボットおよびロボットシステム |
| JP2021500997A (ja) * | 2017-10-30 | 2021-01-14 | エシコン エルエルシーＥｔｈｉｃｏｎ ＬＬＣ | 外科用システムの反応アルゴリズム |
| JP7286638B2 (ja) | 2017-10-30 | 2023-06-05 | エシコン エルエルシー | 外科用システムの反応アルゴリズム |
| JP2019125067A (ja) * | 2018-01-15 | 2019-07-25 | Dmg森精機株式会社 | モータ駆動制御装置およびこれを備えてなる工作機械 |
| WO2019225158A1 (ja) * | 2018-05-22 | 2019-11-28 | ソニー株式会社 | ロボットの制御装置及びロボットの制御方法 |
| US11820019B2 (en) | 2018-05-22 | 2023-11-21 | Sony Corporation | Robot control apparatus and robot control method |
| CN112123333A (zh) * | 2020-08-18 | 2020-12-25 | 珠海格力电器股份有限公司 | 一种多关节机器人碰撞检测方法及其装置 |
| JP2025518893A (ja) * | 2022-06-21 | 2025-06-19 | ユ－ジーン テクノロジー カンパニー．リミテッド | 基板搬送装置及び基板搬送装置の運用方法 |
| JP7759521B1 (ja) * | 2025-04-04 | 2025-10-23 | ヤマザキマザック株式会社 | 工作機械システム、工作機械システムの動作方法、および、プログラム |
Also Published As
| Publication number | Publication date |
|---|---|
| GB2355547B (en) | 2002-01-16 |
| JP3459973B2 (ja) | 2003-10-27 |
| GB2355547A (en) | 2001-04-25 |
| US6429617B1 (en) | 2002-08-06 |
| GB0025787D0 (en) | 2000-12-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3459973B2 (ja) | 駆動制御方法および駆動制御装置 | |
| EP1477284B1 (en) | Drive control method and drive controller | |
| EP2199037B1 (en) | Robot system and control method | |
| EP3351356B1 (en) | Robot collision detection method | |
| US7212886B2 (en) | Robot control apparatus and method | |
| JP4294646B2 (ja) | ロボットアームの制御方法および制御装置 | |
| KR960005985B1 (ko) | 서어보 모우터에 의해 구동되는 기계 작동부의 충돌 검출 방법 | |
| JP5338297B2 (ja) | ロボットの制御装置 | |
| JP2010228028A (ja) | ロボットアーム、ロボットアームの接触検知方法、及び、ロボットアームを備えた装置 | |
| JP6946057B2 (ja) | ロボットハンド、ロボットハンドの制御方法、ロボット装置 | |
| JP3933158B2 (ja) | ロボットの衝突検出方法 | |
| JP2000052286A (ja) | ロボットの制御装置 | |
| JP3204207B2 (ja) | ロボットの制御装置とその制御方法 | |
| CN108748144A (zh) | 一种人机协作机械臂的碰撞识别方法 | |
| CN107553484B (zh) | 一种机器人作业运动路径规划方法及系统 | |
| JP3328414B2 (ja) | ロボットハンドの姿勢制御装置 | |
| CN109476024B (zh) | 机器人的控制方法以及焊接方法 | |
| JPH01310889A (ja) | 産業用ロボットの制御装置 | |
| JP2001353687A (ja) | ロボットの制御装置とその制御方法 | |
| KR102643316B1 (ko) | 로봇 매니퓰레이터의 충격량을 산출하는 검출장치 및 방법 | |
| JP3855629B2 (ja) | ロボットの干渉検出装置 | |
| JP2020183021A (ja) | 制御方法、制御プログラム、記録媒体、ロボットシステム、ロボット装置、生産システム、物品の製造方法および外部入力装置 | |
| CN114450644B (zh) | 生产机器在无碰撞的轨迹上的停止 | |
| JP2013240858A (ja) | 部品組み立て装置 | |
| JP2020097085A (ja) | ロボット装置の検査方法、プログラム、記録媒体、ロボットシステム、物品の製造方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 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: 20030430 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 3459973 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080815 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090815 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100815 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110815 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110815 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120815 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120815 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130815 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130815 Year of fee payment: 10 |
|
| EXPY | Cancellation because of completion of term |