JPH0699371A - 産業用ロボットの加速度変化を利用した制御方法 - Google Patents
産業用ロボットの加速度変化を利用した制御方法Info
- Publication number
- JPH0699371A JPH0699371A JP27367392A JP27367392A JPH0699371A JP H0699371 A JPH0699371 A JP H0699371A JP 27367392 A JP27367392 A JP 27367392A JP 27367392 A JP27367392 A JP 27367392A JP H0699371 A JPH0699371 A JP H0699371A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- position deviation
- speed
- latest
- procedure
- 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
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
(57)【要約】 （修正有）
【目的】 非常に小さな動作遅れにより、しかも高精度
で駆動されているロボットの異常をすばやく検出できる
産業用ロボットの制御方法を提供する。 【構成】 本発明の制御方法は、所定周期によりロボッ
トの位置を検出する手順と、前記により検出されたロボ
ットの最新位置とその直前の検出位置とによりロボット
の速度を算出する手順と、前記により算出されたロボッ
トの最新の速度とその直前の算出速度とによりロボット
の加速度を算出する手順と、前記算出された加速度に対
応した許容位置偏差を求める手順と、ロボットの最新の
位置と目標位置とにより、ロボットの最新の位置偏差を
求める手順と、最新の位置偏差が前記許容位置偏差内で
あるか否かに応じて、ロボットへの指示を異ならしめる
手順とを含んでいるものである。
で駆動されているロボットの異常をすばやく検出できる
産業用ロボットの制御方法を提供する。 【構成】 本発明の制御方法は、所定周期によりロボッ
トの位置を検出する手順と、前記により検出されたロボ
ットの最新位置とその直前の検出位置とによりロボット
の速度を算出する手順と、前記により算出されたロボッ
トの最新の速度とその直前の算出速度とによりロボット
の加速度を算出する手順と、前記算出された加速度に対
応した許容位置偏差を求める手順と、ロボットの最新の
位置と目標位置とにより、ロボットの最新の位置偏差を
求める手順と、最新の位置偏差が前記許容位置偏差内で
あるか否かに応じて、ロボットへの指示を異ならしめる
手順とを含んでいるものである。
Description
【０００１】
【産業上の利用分野】本発明は産業用ロボットの制御方
法に関する。さらに詳しくは、ロボットの異常を迅速に
検出することができる産業用ロボットの制御方法に関す
る。
法に関する。さらに詳しくは、ロボットの異常を迅速に
検出することができる産業用ロボットの制御方法に関す
る。
【０００２】
【従来の技術】従来より産業用ロボットにおいては、フ
ィードバック制御によりロボットの位置制御がなされて
いる。このフィードバック制御を用いた場合、その制御
特性上、指令値に対して０．１秒程度の動作遅れが生ず
ることになる。そのため、目標位置とロボットの現在位
置とには、前記動作遅れとロボットの移動速度との積か
ら定まる位置偏差が生ずる。この位置偏差はその性格
上、ロボットの速度に比例して大きくなる。位置偏差が
大きくなりすぎると、ロボットによる取付け精度の低下
を生じたり、ロボットが所定の軌道から外れて、軌道脇
に置かれている物品と接触してロボットや物品が損傷す
るという事故につながる危険性もある。かかる事態を回
避するため、位置偏差を監視して、その値が所定値（制
限値）を超えた場合、ロボットを停止させる等の処置が
採られている。現状では、この制限値は、ロボットの最
大速度と動作遅れとに基づいて算出される値とされた
り、ロボットの速度と動作遅れとに基づいて算出される
値とされたりしている（図５参照）。
ィードバック制御によりロボットの位置制御がなされて
いる。このフィードバック制御を用いた場合、その制御
特性上、指令値に対して０．１秒程度の動作遅れが生ず
ることになる。そのため、目標位置とロボットの現在位
置とには、前記動作遅れとロボットの移動速度との積か
ら定まる位置偏差が生ずる。この位置偏差はその性格
上、ロボットの速度に比例して大きくなる。位置偏差が
大きくなりすぎると、ロボットによる取付け精度の低下
を生じたり、ロボットが所定の軌道から外れて、軌道脇
に置かれている物品と接触してロボットや物品が損傷す
るという事故につながる危険性もある。かかる事態を回
避するため、位置偏差を監視して、その値が所定値（制
限値）を超えた場合、ロボットを停止させる等の処置が
採られている。現状では、この制限値は、ロボットの最
大速度と動作遅れとに基づいて算出される値とされた
り、ロボットの速度と動作遅れとに基づいて算出される
値とされたりしている（図５参照）。
【０００３】しかるに、最近のサーボ技術においては、
フィードフォワード、ダイナミックフィードフォワー
ド、現代制御理論等の活用により、非常に小さな動作遅
れ（４ミリ秒程度の遅れ）により、しかも高精度にロボ
ットを駆動できるようになってきている。そのため、従
来の制限値を用いてロボットの位置偏差を監視していた
のでは、その制限値が緩すぎてロボットに異常が生じた
場合に、その異常をすばやく検出することができないと
いう問題が生じてきている。また、速度が定常状態で低
速ならば位置偏差が小さいが、前進から後退に変化する
時など速度の方向が変わる時には、速度が小さいにもか
かわらず、位置偏差が大きくなる。そのため、低速で十
分小さな制限値を設定することが困難である。
フィードフォワード、ダイナミックフィードフォワー
ド、現代制御理論等の活用により、非常に小さな動作遅
れ（４ミリ秒程度の遅れ）により、しかも高精度にロボ
ットを駆動できるようになってきている。そのため、従
来の制限値を用いてロボットの位置偏差を監視していた
のでは、その制限値が緩すぎてロボットに異常が生じた
場合に、その異常をすばやく検出することができないと
いう問題が生じてきている。また、速度が定常状態で低
速ならば位置偏差が小さいが、前進から後退に変化する
時など速度の方向が変わる時には、速度が小さいにもか
かわらず、位置偏差が大きくなる。そのため、低速で十
分小さな制限値を設定することが困難である。
【０００４】
【発明が解決しようとする課題】本発明はかかる従来技
術の問題点に鑑みなされたものであって、非常に小さな
動作遅れにより、しかも高精度で駆動されているロボッ
トの異常をすばやく検出できる産業用ロボットの制御方
法を提供することを目的としている。
術の問題点に鑑みなされたものであって、非常に小さな
動作遅れにより、しかも高精度で駆動されているロボッ
トの異常をすばやく検出できる産業用ロボットの制御方
法を提供することを目的としている。
【０００５】
【課題を解決するための手段】本発明者等は、前記課題
に付き鋭意研究した結果、ロボットが加速あるいは減速
された際に、通常の場合より大きな動作遅れを生ずるこ
とを見出すとともに、この加速度の変化の際に生ずる動
作遅れに基づいてロボットの位置偏差を監視すれば前記
課題も解決できることを見出した。本発明はかかる知見
に基づいてなされたものである。
に付き鋭意研究した結果、ロボットが加速あるいは減速
された際に、通常の場合より大きな動作遅れを生ずるこ
とを見出すとともに、この加速度の変化の際に生ずる動
作遅れに基づいてロボットの位置偏差を監視すれば前記
課題も解決できることを見出した。本発明はかかる知見
に基づいてなされたものである。
【０００６】すなわち、本発明の産業用ロボットの制御
方法は、所定周期によりロボットの位置を検出する手順
と、前記により検出されたロボットの最新位置とその直
前の検出位置とによりロボットの速度を算出する手順
と、前記により算出されたロボットの最新の速度とその
直前の算出速度とによりロボットの加速度を算出する手
順と、前記算出された加速度に対応した許容位置偏差を
求める手順と、ロボットの最新の位置と目標位置とによ
り、ロボットの最新の位置偏差を求める手順と、最新の
位置偏差が前記許容位置偏差内であるか否かに応じて、
ロボットへの指示を異ならしめる手順とを含んでいるこ
とを特徴としている。
方法は、所定周期によりロボットの位置を検出する手順
と、前記により検出されたロボットの最新位置とその直
前の検出位置とによりロボットの速度を算出する手順
と、前記により算出されたロボットの最新の速度とその
直前の算出速度とによりロボットの加速度を算出する手
順と、前記算出された加速度に対応した許容位置偏差を
求める手順と、ロボットの最新の位置と目標位置とによ
り、ロボットの最新の位置偏差を求める手順と、最新の
位置偏差が前記許容位置偏差内であるか否かに応じて、
ロボットへの指示を異ならしめる手順とを含んでいるこ
とを特徴としている。
【０００７】本発明の産業用ロボットの制御方法におい
ては、前記最新の位置偏差が前記許容位置偏差内である
場合、実行中の作業の継続を指示し、そして前記最新の
位置偏差が前記許容位置偏差外である場合、ロボットの
停止を指示するのが好ましい。
ては、前記最新の位置偏差が前記許容位置偏差内である
場合、実行中の作業の継続を指示し、そして前記最新の
位置偏差が前記許容位置偏差外である場合、ロボットの
停止を指示するのが好ましい。
【０００８】
【作用】本発明においては前記手順により産業用ロボッ
トの制御を行っているので、加速度が変化しない定常状
態における制限値を非常に小さくすることができる。そ
のため、過負荷等による位置偏差をすばやく検出するこ
とができる。
トの制御を行っているので、加速度が変化しない定常状
態における制限値を非常に小さくすることができる。そ
のため、過負荷等による位置偏差をすばやく検出するこ
とができる。
【０００９】
【実施例】以下、添付図面を参照しながら本発明を実施
例に基づいて説明するが、本発明はかかる実施例のみに
限定されるものではない。
例に基づいて説明するが、本発明はかかる実施例のみに
限定されるものではない。
【００１０】図１は本発明の制御方法を用いたロボット
の概略図、図２〜３は本発明の制御方法のフローチャー
ト、図４は本発明における制限値と加速度との関係を示
すグラフである。図１において、１は入力装置、２はロ
ボットコントローラ、３はロボット本体、４はセンサを
示す。
の概略図、図２〜３は本発明の制御方法のフローチャー
ト、図４は本発明における制限値と加速度との関係を示
すグラフである。図１において、１は入力装置、２はロ
ボットコントローラ、３はロボット本体、４はセンサを
示す。
【００１１】図１にその概略が示されている本発明が適
用されるロボットは、入力装置１、ロボットコントロー
ラ２、ロボット本体３およびセンサ４を主要構成要素と
している。
用されるロボットは、入力装置１、ロボットコントロー
ラ２、ロボット本体３およびセンサ４を主要構成要素と
している。
【００１２】ロボットコントローラ２は、入出力インタ
ーフェース、ＲＡＭ、ＲＯＭ、クロック、サーボ制御部
を備えている。このＲＯＭには、図２〜３のフローチャ
ートに示す手順を実行するプログラムが格納されてい
る。ロボットコントローラ２に用いられる入出力インタ
ーフェース、ＲＡＭ、ＲＯＭ、クロック、サーボ制御部
の具体的構成についての説明は省略するが、従来よりこ
の種のロボットコントローラに用いられているものが好
適に用いられる。また、ＲＯＭには前記プログラムの他
に、ロボットの制御を行うのに必要なその他のプログラ
ムも格納されている。
ーフェース、ＲＡＭ、ＲＯＭ、クロック、サーボ制御部
を備えている。このＲＯＭには、図２〜３のフローチャ
ートに示す手順を実行するプログラムが格納されてい
る。ロボットコントローラ２に用いられる入出力インタ
ーフェース、ＲＡＭ、ＲＯＭ、クロック、サーボ制御部
の具体的構成についての説明は省略するが、従来よりこ
の種のロボットコントローラに用いられているものが好
適に用いられる。また、ＲＯＭには前記プログラムの他
に、ロボットの制御を行うのに必要なその他のプログラ
ムも格納されている。
【００１３】次に、図２〜３に示すフローチャートにし
たがって、本発明の制御方法の一実施例について説明す
る。
たがって、本発明の制御方法の一実施例について説明す
る。
【００１４】ステップ１：ロボット本体３を起動する。
【００１５】ステップ２：ロボットハンド３の初期位置
をＲＡＭに記憶させる。
をＲＡＭに記憶させる。
【００１６】ステップ３：ロボット本体３に所定作業を
実行させる。
実行させる。
【００１７】ステップ４：センサ４によりロボットハン
ドの位置を検出する。このハンドの位置は、ロボットコ
ントローラ２自身が有するデータに基づいて算出するよ
うにされてもよい。
ドの位置を検出する。このハンドの位置は、ロボットコ
ントローラ２自身が有するデータに基づいて算出するよ
うにされてもよい。
【００１８】ステップ５：ロボットコントローラ２のＲ
ＡＭにロボットハンドの位置を記憶させる。
ＡＭにロボットハンドの位置を記憶させる。
【００１９】ステップ６：前回入力されたロボットハン
ドの位置と今回入力されたロボットハンドの位置との差
からハンドの移動量を算出する。
ドの位置と今回入力されたロボットハンドの位置との差
からハンドの移動量を算出する。
【００２０】ステップ７：前記移動量を所要時間で除し
てロボットハンドの速度を算出し、その値をＲＡＭに記
憶させる。
てロボットハンドの速度を算出し、その値をＲＡＭに記
憶させる。
【００２１】ステップ８：前回算出されたロボットハン
ドの速度と今回算出されたロボットハンドの速度との速
度差を算出する。
ドの速度と今回算出されたロボットハンドの速度との速
度差を算出する。
【００２２】ステップ９：前記速度差を所要時間で除し
て、ロボットハンドの加速度を算出し、その値をＲＡＭ
に記憶させる。
て、ロボットハンドの加速度を算出し、その値をＲＡＭ
に記憶させる。
【００２３】ステップ10：前記加速度に応じた位置偏差
の制限値を算出する。この制限値と加速度との関係は、
例えば図４に示すように、あらかじめＲＯＭに一次関数
の形で与えられている。
の制限値を算出する。この制限値と加速度との関係は、
例えば図４に示すように、あらかじめＲＯＭに一次関数
の形で与えられている。
【００２４】ステップ11：ステップ４により検出された
ロボットハンドの位置と目標位置との差を求めることに
より位置偏差を算出する。
ロボットハンドの位置と目標位置との差を求めることに
より位置偏差を算出する。
【００２５】ステップ12：前記位置偏差と制限値とを比
較する。
較する。
【００２６】ステップ13：位置偏差が制限値を超えてい
なければ、ロボット本体３に実行中の作業の継続を指示
した後、ステップ４に戻る。
なければ、ロボット本体３に実行中の作業の継続を指示
した後、ステップ４に戻る。
【００２７】ステップ14：位置偏差が制限値を超えてい
れば、ロボット本体３の停止を指示する。
れば、ロボット本体３の停止を指示する。
【００２８】以上、ロボットハンドの位置偏差監視方法
を実施例に基づいて説明してきたが、本発明はかかる実
施例のみに限定されるものではない。例えば、検出対象
をロボットハンド位置のかわりに、ロボット各軸の関節
角度位置としてもよい。すなわち、各軸の角加速度に対
して角度偏差の制限値を設けて、本発明の制御方法を同
様に適用することができる。
を実施例に基づいて説明してきたが、本発明はかかる実
施例のみに限定されるものではない。例えば、検出対象
をロボットハンド位置のかわりに、ロボット各軸の関節
角度位置としてもよい。すなわち、各軸の角加速度に対
して角度偏差の制限値を設けて、本発明の制御方法を同
様に適用することができる。
【００２９】
【発明の効果】以上説明したように、本発明の制御方法
によれば、４ミリ秒程度の非常に小さな動作遅れにより
制御されているロボットについても、その位置偏差の異
常をすばやく検出することができる。また、位置偏差の
制限値を従来に比して１０分の１程度にできるので、位
置決め精度の向上を図ることができる。
によれば、４ミリ秒程度の非常に小さな動作遅れにより
制御されているロボットについても、その位置偏差の異
常をすばやく検出することができる。また、位置偏差の
制限値を従来に比して１０分の１程度にできるので、位
置決め精度の向上を図ることができる。
【図１】本発明の制御方法を用いたロボットの概略図で
ある。
ある。
【図２】本発明の制御方法のフローチャートの一部であ
る。
る。
【図３】本発明の制御方法のフローチャートの一部であ
る。
る。
【図４】本発明における制限値と加速度との関係を示す
グラフである。
グラフである。
【図５】従来における制限値と速度との関係を示すグラ
フである。
フである。
１ 入力装置 ２ ロボットコントローラ ３ ロボット本体 ４ センサ
Claims (3)
- 【請求項１】 所定周期によりロボットの位置を検出す
る手順と、前記により検出されたロボットの最新位置と
その直前の検出位置とによりロボットの速度を算出する
手順と、前記により算出されたロボットの最新の速度と
その直前の算出速度とによりロボットの加速度を算出す
る手順と、前記算出された加速度に対応した許容位置偏
差を求める手順と、ロボットの最新の位置と目標位置と
により、ロボットの最新の位置偏差を求める手順と、最
新の位置偏差が前記許容位置偏差内であるか否かに応じ
て、ロボットへの指示を異ならしめる手順とを含んでい
ることを特徴とする産業用ロボットの制御方法。 - 【請求項２】 前記最新の位置偏差が前記許容位置偏差
内である場合、実行中の作業の継続を指示することを特
徴とする請求項１記載の産業用ロボットの制御方法。 - 【請求項３】 前記最新の位置偏差が前記許容位置偏差
外である場合、ロボットの停止を指示することを特徴と
する請求項１記載の産業用ロボットの制御方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP4273673A JP2505394B2 (ja) | 1992-09-17 | 1992-09-17 | 産業用ロボットの加速度変化を利用した制御方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP4273673A JP2505394B2 (ja) | 1992-09-17 | 1992-09-17 | 産業用ロボットの加速度変化を利用した制御方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH0699371A true JPH0699371A (ja) | 1994-04-12 |
| JP2505394B2 JP2505394B2 (ja) | 1996-06-05 |
Family
ID=17530955
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP4273673A Expired - Lifetime JP2505394B2 (ja) | 1992-09-17 | 1992-09-17 | 産業用ロボットの加速度変化を利用した制御方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2505394B2 (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104973420A (zh) * | 2014-04-02 | 2015-10-14 | 现代重工业株式会社 | 基板搬运机器人驱动装置以及利用该装置的基板搬运方法 |
| US10377043B2 (en) | 2016-03-18 | 2019-08-13 | Seiko Epson Corporation | Robot control apparatus, robot, and robot system |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS60205717A (ja) * | 1984-03-30 | 1985-10-17 | Toshiba Seiki Kk | ロボツトの位置決め制御方法 |
| JPH0276673A (ja) * | 1988-09-08 | 1990-03-16 | Hitachi Metals Ltd | はり取りロボット |
-
1992
- 1992-09-17 JP JP4273673A patent/JP2505394B2/ja not_active Expired - Lifetime
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS60205717A (ja) * | 1984-03-30 | 1985-10-17 | Toshiba Seiki Kk | ロボツトの位置決め制御方法 |
| JPH0276673A (ja) * | 1988-09-08 | 1990-03-16 | Hitachi Metals Ltd | はり取りロボット |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104973420A (zh) * | 2014-04-02 | 2015-10-14 | 现代重工业株式会社 | 基板搬运机器人驱动装置以及利用该装置的基板搬运方法 |
| JP2015196242A (ja) * | 2014-04-02 | 2015-11-09 | ヒュンダイ ヘビー インダストリーズ カンパニー リミテッドＨｙｕｎｄａｉ Ｈｅａｖｙ Ｉｎｄｕｓｔｒｉｅｓ Ｃｏ．， Ｌｔｄ． | 基板移送ロボット駆動装置及びこれを用いた基板移送方法 |
| TWI562946B (en) * | 2014-04-02 | 2016-12-21 | Hyun Dai Heavy Ind Co Ltd | Driving device for transferring substrate robot and method for transfreeing substrate |
| US10377043B2 (en) | 2016-03-18 | 2019-08-13 | Seiko Epson Corporation | Robot control apparatus, robot, and robot system |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2505394B2 (ja) | 1996-06-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3288250B2 (ja) | ロボット制御装置 | |
| US5493192A (en) | Abnormal load detection method | |
| EP1667001B1 (en) | Controller | |
| JP3169838B2 (ja) | サーボモータの制御方法 | |
| JP2007257515A (ja) | サーボモータの制御方法 | |
| JPH10180663A (ja) | ロボットアームの制御装置 | |
| JP2786874B2 (ja) | 可動位置制御装置 | |
| JP2505394B2 (ja) | 産業用ロボットの加速度変化を利用した制御方法 | |
| JPS6224305A (ja) | 産業用ロボツトのサ−ボ異常検出方法 | |
| JPH0424198B2 (ja) | ||
| JPH0878506A (ja) | 位置決め制御装置 | |
| JPH0639760A (ja) | ロボットの制御装置 | |
| JPH0739190A (ja) | 自動機械のブレーキ異常検出方法 | |
| JP3556779B2 (ja) | サーボモータのオーバーシュート防止方法 | |
| JPH11245191A (ja) | 産業用ロボットの駆動軸制御方法及びその装置 | |
| JPH0475113A (ja) | 制御装置 | |
| JP2688372B2 (ja) | ロボットの軌跡制御装置 | |
| JP2650464B2 (ja) | 産業用ロボット | |
| JP3997405B2 (ja) | 移動マニピュレータの制御装置および移動マニピュレータ | |
| GB2146801A (en) | Control of robots | |
| JP7182952B2 (ja) | 制御方法、制御プログラム、記録媒体、制御装置、ロボットシステム、および物品の製造方法 | |
| JPS6235918A (ja) | サ−ボ異常検出方式 | |
| JPH03213286A (ja) | ロボットの力制御方式 | |
| JP2024064471A (ja) | ロボットシステムの制御方法およびロボットシステム | |
| JPH0251703A (ja) | 数値制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 19960130 |