JP2732159B2 - 異常負荷検出方法 - Google Patents
異常負荷検出方法Info
- Publication number
- JP2732159B2 JP2732159B2 JP3308214A JP30821491A JP2732159B2 JP 2732159 B2 JP2732159 B2 JP 2732159B2 JP 3308214 A JP3308214 A JP 3308214A JP 30821491 A JP30821491 A JP 30821491A JP 2732159 B2 JP2732159 B2 JP 2732159B2
- Authority
- JP
- Japan
- Prior art keywords
- disturbance torque
- detected
- estimated disturbance
- torque
- estimated
- 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.)
- Expired - Lifetime
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K11/00—Resistance welding; Severing by resistance heating
- B23K11/24—Electric supply or control circuits therefor
- B23K11/25—Monitoring devices
-
- 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
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K11/00—Resistance welding; Severing by resistance heating
- B23K11/24—Electric supply or control circuits therefor
- B23K11/25—Monitoring devices
- B23K11/252—Monitoring devices using digital means
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Description
【０００１】
【産業上の利用分野】この発明は、ロボットや工作機械
等のサーボモータを主動力源とする機械において、可動
部の衝突や溶接ロボット等における溶着を検出する異常
負荷検出方法に関する。
等のサーボモータを主動力源とする機械において、可動
部の衝突や溶接ロボット等における溶着を検出する異常
負荷検出方法に関する。
【０００２】
【従来の技術】工作機械の可動部（テーブル等）やロボ
ットのアーム等が障害物に衝突したとき、これら可動部
やアームを駆動するサーボモータはは移動指令に従って
移動しようとして、大きなトルクを発生する。そのた
め、可動部やアームの機構部を破損させる場合がある。
この衝突等を防止するため、サーボ系の位置偏差を検出
し、この位置偏差が設定値以上になると負荷異常して衝
突を検出したり、また、サーボモータの駆動電流を検出
し、この駆動電流が設定値以上になったとき衝突等が生
じているとして、衝突を検出する方法がある。しかし、
この位置偏差の増大や駆動電流の増大を検出して衝突等
を検出する方法では、衝突を検出した時点ですでにサー
ボモータは大きなトルクを出力している状態であるか
ら、この大きな力で機構部を破損させる可能性がある。
ットのアーム等が障害物に衝突したとき、これら可動部
やアームを駆動するサーボモータはは移動指令に従って
移動しようとして、大きなトルクを発生する。そのた
め、可動部やアームの機構部を破損させる場合がある。
この衝突等を防止するため、サーボ系の位置偏差を検出
し、この位置偏差が設定値以上になると負荷異常して衝
突を検出したり、また、サーボモータの駆動電流を検出
し、この駆動電流が設定値以上になったとき衝突等が生
じているとして、衝突を検出する方法がある。しかし、
この位置偏差の増大や駆動電流の増大を検出して衝突等
を検出する方法では、衝突を検出した時点ですでにサー
ボモータは大きなトルクを出力している状態であるか
ら、この大きな力で機構部を破損させる可能性がある。
【０００３】そこで、本願出願人は、外乱推定オブザー
バによって外乱トルクを推定し、この推定外乱トルクが
設定値以上になったとき、負荷異常して衝突等が生じて
いるものとして検出する方法を提案した（特開平３−１
９６３１３号公報参照）。
バによって外乱トルクを推定し、この推定外乱トルクが
設定値以上になったとき、負荷異常して衝突等が生じて
いるものとして検出する方法を提案した（特開平３−１
９６３１３号公報参照）。
【０００４】
【発明が解決しようとする課題】しかし、上述した外乱
推定オブザーバによって外乱トルクを推定する場合、推
定された外乱トルクには重力項や動摩擦項等を含み、純
粋な外部から衝突等による力を検出しているものではな
い。特に、溶接ロボット等においては、溶接位置によっ
てロボットの姿勢が異なり、その姿勢によって重力の影
響が大きく作用する。すなわち、ロボットがある姿勢を
保持しているときには、その姿勢状態を維持するように
重力に抗する力を駆動源のサーボモータは出力してい
る。
推定オブザーバによって外乱トルクを推定する場合、推
定された外乱トルクには重力項や動摩擦項等を含み、純
粋な外部から衝突等による力を検出しているものではな
い。特に、溶接ロボット等においては、溶接位置によっ
てロボットの姿勢が異なり、その姿勢によって重力の影
響が大きく作用する。すなわち、ロボットがある姿勢を
保持しているときには、その姿勢状態を維持するように
重力に抗する力を駆動源のサーボモータは出力してい
る。
【０００５】溶接ロボットによってスポット溶接を行
い、次の溶接点に移動する場合に、溶着が生じている場
合等において、従来の外乱推定オブサーバによる異常負
荷検出方法では、この溶着による微妙な異常負荷を検出
することが非常に難しい。
い、次の溶接点に移動する場合に、溶着が生じている場
合等において、従来の外乱推定オブサーバによる異常負
荷検出方法では、この溶着による微妙な異常負荷を検出
することが非常に難しい。
【０００６】図７，図８はスポット溶接ロボットでスポ
ット溶接後若干の静止時間後待機状態に戻る動作を行わ
せ、その時移動するロボットアームを駆動する前後軸に
対するトルク指令Ｔｃ及びこの軸にかかる外乱トルクＴ
を１秒間（横軸１目盛り１００ｍｓｅｃ）検出した実験
結果のグラフで、横軸は時間、縦軸はトルクの値を示す
電圧で１目盛り１Ｖである。図７はスポット溶接後スポ
ットガン先端が溶着することなく移動した時のグラフで
あり、図８はガン先端が溶着した時のグラフである。こ
の図７，図８から分かるように、スポットガン先端が移
動開始した時、図７では生じなかった外乱トルクの乱れ
が図８には生じている。そして、図７と図８を比較して
移動直後の推定外乱トルクＴ１の違いは僅かなものであ
り、ロボット静止時の状態によって変化する外乱トルク
Ｔ０に対してこの違いは相対的に非常に小さく、重力等
も入れた全外乱トルク全体で比較する従来の方法でこの
違いを検出することは難しい。
ット溶接後若干の静止時間後待機状態に戻る動作を行わ
せ、その時移動するロボットアームを駆動する前後軸に
対するトルク指令Ｔｃ及びこの軸にかかる外乱トルクＴ
を１秒間（横軸１目盛り１００ｍｓｅｃ）検出した実験
結果のグラフで、横軸は時間、縦軸はトルクの値を示す
電圧で１目盛り１Ｖである。図７はスポット溶接後スポ
ットガン先端が溶着することなく移動した時のグラフで
あり、図８はガン先端が溶着した時のグラフである。こ
の図７，図８から分かるように、スポットガン先端が移
動開始した時、図７では生じなかった外乱トルクの乱れ
が図８には生じている。そして、図７と図８を比較して
移動直後の推定外乱トルクＴ１の違いは僅かなものであ
り、ロボット静止時の状態によって変化する外乱トルク
Ｔ０に対してこの違いは相対的に非常に小さく、重力等
も入れた全外乱トルク全体で比較する従来の方法でこの
違いを検出することは難しい。
【０００７】そこで、本発明の目的は、溶着等の微妙な
異常負荷等も検出できる異常負荷検出方法を提供するこ
とにある。
異常負荷等も検出できる異常負荷検出方法を提供するこ
とにある。
【０００８】
【課題を解決するための手段】本発明は、機械可動部が
動きだす直前の外乱推定オブサーバで検出された推定外
乱トルクを記憶し、機械可動部が移動中もしくは移動を
開始してから設定時間内において、上記外乱推定オブザ
ーバで検出される推定外乱トルクから上記記憶した推定
外乱トルクを差し引いた値が設定値以上になったとき負
荷異常として検出することを特徴とする異常負荷検出方
法。
動きだす直前の外乱推定オブサーバで検出された推定外
乱トルクを記憶し、機械可動部が移動中もしくは移動を
開始してから設定時間内において、上記外乱推定オブザ
ーバで検出される推定外乱トルクから上記記憶した推定
外乱トルクを差し引いた値が設定値以上になったとき負
荷異常として検出することを特徴とする異常負荷検出方
法。
【０００９】
【作用】ロボットアーム等の機械可動部が停止している
状態では、機械可動部を駆動するサーボモータ等はその
停止した状態を維持するように、重力等の外力に対抗し
た力を発生しており、機械可動部が移動開始する直前に
おいて外乱推定オブサーバで検出された推定外乱トルク
は、重力や摩擦力に対抗する値を示している。そこで、
機械可動部が移動開始する直前における上記外乱推定オ
ブザーバで検出する推定外乱トルクを記憶しておき、移
動開始後、外乱推定オブザーバで検出される推定外乱ト
ルクが上記記憶した移動開始前の推定外乱トルクを差し
引けば、この値は重力や動摩擦力を排除した可動部にか
かるトルクと推定することができ、この値が、通常発生
しないような設定値以上のトルクである場合には、負荷
異常として検出する。これにより、スポット溶接等のロ
ボットにおいて、スポットガン先端がワークに溶着して
いるとき等の異常負荷を確実に検出する。
状態では、機械可動部を駆動するサーボモータ等はその
停止した状態を維持するように、重力等の外力に対抗し
た力を発生しており、機械可動部が移動開始する直前に
おいて外乱推定オブサーバで検出された推定外乱トルク
は、重力や摩擦力に対抗する値を示している。そこで、
機械可動部が移動開始する直前における上記外乱推定オ
ブザーバで検出する推定外乱トルクを記憶しておき、移
動開始後、外乱推定オブザーバで検出される推定外乱ト
ルクが上記記憶した移動開始前の推定外乱トルクを差し
引けば、この値は重力や動摩擦力を排除した可動部にか
かるトルクと推定することができ、この値が、通常発生
しないような設定値以上のトルクである場合には、負荷
異常として検出する。これにより、スポット溶接等のロ
ボットにおいて、スポットガン先端がワークに溶着して
いるとき等の異常負荷を確実に検出する。
【００１０】
【実施例】図３は、位置に対し比例（Ｐ）制御を行い、
速度に対し比例，積分（ＰＩ）制御を行うロボット等の
サーボモータ制御系のブロック線図であり、伝達関数１
０のＫP は位置ループにおける比例ゲイン、伝達関数１
１は速度ループにおける前置補償器の伝達関数で、Ｋ1
は積分定数、Ｋ2 は比例定数である。また、伝達関数１
２，１３はモータの伝達関数で、Ｋｔはトルク定数、Ｊ
はイナーシャであり、伝達関数１４は速度ｖを積分して
位置θを算出する伝達関数である。また、ＴL は外乱ト
ルクである。
速度に対し比例，積分（ＰＩ）制御を行うロボット等の
サーボモータ制御系のブロック線図であり、伝達関数１
０のＫP は位置ループにおける比例ゲイン、伝達関数１
１は速度ループにおける前置補償器の伝達関数で、Ｋ1
は積分定数、Ｋ2 は比例定数である。また、伝達関数１
２，１３はモータの伝達関数で、Ｋｔはトルク定数、Ｊ
はイナーシャであり、伝達関数１４は速度ｖを積分して
位置θを算出する伝達関数である。また、ＴL は外乱ト
ルクである。
【００１１】位置指令値θｒから現在位置θのフィード
バック値を減算し、その差の位置偏差ε（＝θｒ−θ）
に比例定数ＫP を乗じ、速度指令値を求め、該速度指令
値と実速度ｖとの差（速度偏差）によってＰＩ制御を行
ってトルク指令値としての電流値Ｉを求め、該電流Ｉを
モータの巻線に流し、モータを駆動する。モータは速度
ｖで回転し、この速度ｖを積分して位置θが求められ
る。
バック値を減算し、その差の位置偏差ε（＝θｒ−θ）
に比例定数ＫP を乗じ、速度指令値を求め、該速度指令
値と実速度ｖとの差（速度偏差）によってＰＩ制御を行
ってトルク指令値としての電流値Ｉを求め、該電流Ｉを
モータの巻線に流し、モータを駆動する。モータは速度
ｖで回転し、この速度ｖを積分して位置θが求められ
る。
【００１２】この図３に示すサーボモータに対し、外乱
推定オブザーバを組む。まず、サーボモータのサーボ制
御をプロセッサで行うデジタルサーボ制御において、従
来から行われている外乱推定オブザーバについて説明す
る。
推定オブザーバを組む。まず、サーボモータのサーボ制
御をプロセッサで行うデジタルサーボ制御において、従
来から行われている外乱推定オブザーバについて説明す
る。
【００１３】図４は、サーボモータにおけるオブザーバ
対象のモデルのブロック図で、記号１２は図３に示すサ
ーボモータのトルク定数Ｋｔの伝達関数、１３ａ，１３
ｂは図３における伝達関数１３を分割し、イナーシャＪ
の伝達関数１３ａと積分項１３ｂに分けたものである。
図４におて、Ｉは入力としてのトルク指令、ｖ，ＴLは
状態変数としての速度，外乱トルクを意味する。
対象のモデルのブロック図で、記号１２は図３に示すサ
ーボモータのトルク定数Ｋｔの伝達関数、１３ａ，１３
ｂは図３における伝達関数１３を分割し、イナーシャＪ
の伝達関数１３ａと積分項１３ｂに分けたものである。
図４におて、Ｉは入力としてのトルク指令、ｖ，ＴLは
状態変数としての速度，外乱トルクを意味する。
【００１４】この図４のモデルにおいて、状態変数ｖ，
ＴL に対する状態方程式は数式１のようになる。
ＴL に対する状態方程式は数式１のようになる。
【００１５】
【数１】 なお、上記数式１においてαは加速度、 ＴL の上に１
ドットを付したものは、外乱トルクの変化度を意味する
が、短い時間では外乱トルクＴL には変化がないとして
この値を０と仮定している。
ドットを付したものは、外乱トルクの変化度を意味する
が、短い時間では外乱トルクＴL には変化がないとして
この値を０と仮定している。
【００１６】数式１で示す方程式より、オブザーバを組
む一般的な手法により、速度ｖ，外乱ＴL を推定する同
一次元オブザーバを組むと図５に符号５０で示すオブザ
ーバとなる。外乱推定オブザーバ５０の項５２，５３の
Ｋ3 ，Ｋ4 は外乱推定オブザーバのパラメータであり、
項５１は実際にサーボモータに出力されるトルク指令と
しての電流値Ｉに乗じるパラメータの値で、モータのト
ルク定数ＫｔをイナーシャＪで除した値である。５４は
積分項である。
む一般的な手法により、速度ｖ，外乱ＴL を推定する同
一次元オブザーバを組むと図５に符号５０で示すオブザ
ーバとなる。外乱推定オブザーバ５０の項５２，５３の
Ｋ3 ，Ｋ4 は外乱推定オブザーバのパラメータであり、
項５１は実際にサーボモータに出力されるトルク指令と
しての電流値Ｉに乗じるパラメータの値で、モータのト
ルク定数ＫｔをイナーシャＪで除した値である。５４は
積分項である。
【００１７】この図５のブロック図を解析すると、 {Ｉ・Ｋt ＋ＴL }（１／Ｊ・Ｓ）＝ｖ …（２） {Ｉ・ (Ｋt ／Ｊ) ＋ (ｖ−ｖａ) Ｋ3 ＋ (ｖ−ｖａ)(Ｋ4 ／Ｓ)} (１／Ｓ) ＝ｖａ …（３） （なお、ｖａは積分項５４の出力で推定速度） 第（２）式より Ｉ＝（ｖ・Ｊ・Ｓ−ＴL ）／Ｋｔ …（４） 第（３）式に第（４）式を代入し整理すると、 （ｖ・Ｊ・Ｓ−ＴL ）／Ｊ＋（ｖ−ｖａ）Ｋ3 ＋（ｖ−ｖａ）（Ｋ4 ／Ｓ）＝ｖａ・Ｓ …（５） Ｓ（ｖ−ｖａ）＋（ｖ−ｖａ）・Ｋ3 ＋（ｖ−ｖａ）（Ｋ4 ／Ｓ）＝ＴL ／Ｊ …（６） 第（６）式より
【００１８】
【数７】 上記数式７より項５３の出力ｘは次の数式８で示され
る。
る。
【００１９】
【数８】 数式８において、パラメータＫ3 ，Ｋ4 を極が安定する
ように選択すると、ｘ＝ＴL ／Ｊと近似することがで
き、該値ｘ（＝ＴL ／Ｊ）に項５６のパラメータＪ・Ｂ
（Ｊはイナーシャ，Ｂは単位系を合わせるための定数）
を乗じれば外乱トルクＴL に略等しい推定外乱トルクＴ
が推定される。
ように選択すると、ｘ＝ＴL ／Ｊと近似することがで
き、該値ｘ（＝ＴL ／Ｊ）に項５６のパラメータＪ・Ｂ
（Ｊはイナーシャ，Ｂは単位系を合わせるための定数）
を乗じれば外乱トルクＴL に略等しい推定外乱トルクＴ
が推定される。
【００２０】そこで、ロボットのアーム（機械の可動
部）が移動開始する直前において、この外乱推定オブザ
ーバ５０で推定される推定外乱トルクＴ（＝Ｔ０）を記
憶しておき、ロボットアーム可動後に同様に推定外乱ト
ルクＴ（＝Ｔ１）を求めこの可動後の推定外乱トルクＴ
１から移動開始直前の推定外乱トルクＴ０を減じると、
この減じた値はのアームが移動する直前のロボット姿勢
による重力や同摩擦等の影響を排除した純粋にロボット
アームにかかる外乱と推定することができる。
部）が移動開始する直前において、この外乱推定オブザ
ーバ５０で推定される推定外乱トルクＴ（＝Ｔ０）を記
憶しておき、ロボットアーム可動後に同様に推定外乱ト
ルクＴ（＝Ｔ１）を求めこの可動後の推定外乱トルクＴ
１から移動開始直前の推定外乱トルクＴ０を減じると、
この減じた値はのアームが移動する直前のロボット姿勢
による重力や同摩擦等の影響を排除した純粋にロボット
アームにかかる外乱と推定することができる。
【００２１】図６は本発明の一実施例を実施するロボッ
ト制御装置の要部ブロック図で、１はロボットを制御す
る制御装置で、該制御装置から移動指令，各種制御信号
が共有メモリ２を介してディジタルサーボ回路３に出力
される。ディジタルサーボ回路３は、プロセッサ，ＲＯ
Ｍ，ＲＡＭ等で構成され、位置、速度等のサーボ制御を
ディジタル的に制御し、トランジスタインバータ等で構
成されるサーボアンプ４に電流指令を出力し各軸のサー
ボモータ５を制御するものである。また、６は位置速度
を検出する位置速度検出器でサーボモータのモータ軸に
取り付けられたパルスコーダ等で構成され、ディジタル
サーボ回路３に位置、速度フィードバック信号を出力し
ている。なお、上記図６には１軸のサーボ系のみを記載
しているが、各軸毎に同様な構成を有しており、これら
の構成は、従来から公知のディジタルサーボ回路の構成
と同一である。
ト制御装置の要部ブロック図で、１はロボットを制御す
る制御装置で、該制御装置から移動指令，各種制御信号
が共有メモリ２を介してディジタルサーボ回路３に出力
される。ディジタルサーボ回路３は、プロセッサ，ＲＯ
Ｍ，ＲＡＭ等で構成され、位置、速度等のサーボ制御を
ディジタル的に制御し、トランジスタインバータ等で構
成されるサーボアンプ４に電流指令を出力し各軸のサー
ボモータ５を制御するものである。また、６は位置速度
を検出する位置速度検出器でサーボモータのモータ軸に
取り付けられたパルスコーダ等で構成され、ディジタル
サーボ回路３に位置、速度フィードバック信号を出力し
ている。なお、上記図６には１軸のサーボ系のみを記載
しているが、各軸毎に同様な構成を有しており、これら
の構成は、従来から公知のディジタルサーボ回路の構成
と同一である。
【００２２】図１は、ディジタルサーボ回路のプロセッ
サが位置，速度ループ処理周期毎実施する第１の実施例
の処理のフローチャートである。まず、制御装置１は教
示された作業動作プログラムに基づいて各軸に移動指令
を分配し、この移動指令を出力開始する毎に共有メモリ
２に設けられたフラグＦ２を「１」にセットし、移動指
令出力開始から設定された微小時間Ａが経過するとこの
フラグＦ２を「０」にリセットする処理を繰り返す。
サが位置，速度ループ処理周期毎実施する第１の実施例
の処理のフローチャートである。まず、制御装置１は教
示された作業動作プログラムに基づいて各軸に移動指令
を分配し、この移動指令を出力開始する毎に共有メモリ
２に設けられたフラグＦ２を「１」にセットし、移動指
令出力開始から設定された微小時間Ａが経過するとこの
フラグＦ２を「０」にリセットする処理を繰り返す。
【００２３】ディジタルサーボ回路３のプロセッサは制
御装置１から出力される移動指令より位置・速度ループ
処理周期毎の移動指令θｒを求め（ステップＳ１）、サ
ーボモータに取付けられた位置・速度検出器６によって
検出される現在位置（位置のフィードバック値）より、
従来と同様に位置ループ処理を行って速度指令を算出す
る（ステップＳ２）。次に、負荷異常を検出したときに
「１」にセットされるフラグＦ１が「１」か否か判断す
る（ステップＳ３）。なお、このフラグＦ１は初期設定
で「０」に設定されており、負荷異常が検出されなけれ
ば「０」の状態を維持している。該フラグＦ１が「１」
でなければ、次ぎに上述したフラグＦ２が「１」か否か
判断し（ステップＳ４）、例えば、移動指令が制御装置
１から出力されておらず、フラグＦ２も「１」にセット
されてなければ、ステップＳ１１に移行し、図５に示す
外乱推定オブザーバ５０の処理を実行し、推定外乱トル
クを求め求められた推定外乱トルクをロボット停止中の
推定外乱トルクＴ０として記憶する。その後速度ループ
処理を行って得られた電流指令（トルク指令）を電流ル
ープに引き渡し（（ステップＳ９，Ｓ１０）、この位置
・速度ループ処理を終了する。
御装置１から出力される移動指令より位置・速度ループ
処理周期毎の移動指令θｒを求め（ステップＳ１）、サ
ーボモータに取付けられた位置・速度検出器６によって
検出される現在位置（位置のフィードバック値）より、
従来と同様に位置ループ処理を行って速度指令を算出す
る（ステップＳ２）。次に、負荷異常を検出したときに
「１」にセットされるフラグＦ１が「１」か否か判断す
る（ステップＳ３）。なお、このフラグＦ１は初期設定
で「０」に設定されており、負荷異常が検出されなけれ
ば「０」の状態を維持している。該フラグＦ１が「１」
でなければ、次ぎに上述したフラグＦ２が「１」か否か
判断し（ステップＳ４）、例えば、移動指令が制御装置
１から出力されておらず、フラグＦ２も「１」にセット
されてなければ、ステップＳ１１に移行し、図５に示す
外乱推定オブザーバ５０の処理を実行し、推定外乱トル
クを求め求められた推定外乱トルクをロボット停止中の
推定外乱トルクＴ０として記憶する。その後速度ループ
処理を行って得られた電流指令（トルク指令）を電流ル
ープに引き渡し（（ステップＳ９，Ｓ１０）、この位置
・速度ループ処理を終了する。
【００２４】以下、制御装置１から移動指令が出力され
ず、フラグＦ２が「１」にセットされないかぎり、ディ
ジタルサーボ回路３のプロセッサはステップＳ１〜Ｓ
４，ステップＳ１１，ステップＳ９，Ｓ１０の処理を実
行し、停止中の推定外乱トルクＴ０を更新記憶する。ま
た、移動指令が出力されていないため、ロボットは停止
状態にあり、ロボットの各軸サーボモータはその時のロ
ボット姿勢に基づく重力，摩擦力等に対抗する力を出力
しており、上記推定外乱トルクＴ０はこの重力，摩擦力
に等しいトルクを示している。
ず、フラグＦ２が「１」にセットされないかぎり、ディ
ジタルサーボ回路３のプロセッサはステップＳ１〜Ｓ
４，ステップＳ１１，ステップＳ９，Ｓ１０の処理を実
行し、停止中の推定外乱トルクＴ０を更新記憶する。ま
た、移動指令が出力されていないため、ロボットは停止
状態にあり、ロボットの各軸サーボモータはその時のロ
ボット姿勢に基づく重力，摩擦力等に対抗する力を出力
しており、上記推定外乱トルクＴ０はこの重力，摩擦力
に等しいトルクを示している。
【００２５】一方、移動指令が制御装置１から出力され
フラグＦ２が「１」にセットされると、プロセッサはス
テップＳ１〜Ｓ４の処理をして、ステップＳ４からステ
ップＳ５に移行し、外乱推定オブザーバの処理を行って
推定外乱トルクＴ１を求める。そして、この求めた推定
外乱トルクＴ１から記憶している移動開始前の推定外乱
トルク（移動直前の推定外乱トルク）Ｔ０を差し引いた
絶対値が設定された負荷異常検出基準値Ｔｓ以上か否か
判断し（ステップＳ６）、以上でなければ、ステップＳ
９に移行し、ステップＳ２で求めた速度指令と位置・速
度検出器６で検出された速度フィードバック信号によ
り、従来と同様に速度ループ処理を行い電流指令を求
め、求めた電流指令を電流ループに引き渡し（ステップ
Ｓ１０）、当該処理周期の処理を終了する。
フラグＦ２が「１」にセットされると、プロセッサはス
テップＳ１〜Ｓ４の処理をして、ステップＳ４からステ
ップＳ５に移行し、外乱推定オブザーバの処理を行って
推定外乱トルクＴ１を求める。そして、この求めた推定
外乱トルクＴ１から記憶している移動開始前の推定外乱
トルク（移動直前の推定外乱トルク）Ｔ０を差し引いた
絶対値が設定された負荷異常検出基準値Ｔｓ以上か否か
判断し（ステップＳ６）、以上でなければ、ステップＳ
９に移行し、ステップＳ２で求めた速度指令と位置・速
度検出器６で検出された速度フィードバック信号によ
り、従来と同様に速度ループ処理を行い電流指令を求
め、求めた電流指令を電流ループに引き渡し（ステップ
Ｓ１０）、当該処理周期の処理を終了する。
【００２６】次の周期以降も、フラグＦ２が「１」でス
テップＳ６で基準値Ｔｓ以上でないと判断された場合に
は、ステップＳ１〜Ｓ６、ステップＳ９，Ｓ１０の処理
を繰り返すことになるが、ステップＳ６で、推定外乱ト
ルクＴ１から記憶している移動開始前の推定外乱トルク
Ｔ０を差し引いた絶対値が設定値Ｔｓを越えていると判
断された場合には、すなわち、重力や摩擦力等（Ｔ０）
以外の負荷が設定値Ｔｓを越えている場合には、スポッ
トガンの溶着や衝突等が生じて負荷異常が生じているも
のとしてアラームを出力しフラグＦ１を「１」にセット
する（ステップＳ７）。そして、ステップＳ２で求めた
速度指令をキャンセルし速度指令を「０」とすると共に
速度ループ処理内の積分器を「０」にセットする（ステ
ップＳ８）。その後ステップＳ９に移行し、速度ループ
処理を行うが速度指令及び速度ループの積分器が「０」
であるので、モータを停止させるような電流が発生す
る。
テップＳ６で基準値Ｔｓ以上でないと判断された場合に
は、ステップＳ１〜Ｓ６、ステップＳ９，Ｓ１０の処理
を繰り返すことになるが、ステップＳ６で、推定外乱ト
ルクＴ１から記憶している移動開始前の推定外乱トルク
Ｔ０を差し引いた絶対値が設定値Ｔｓを越えていると判
断された場合には、すなわち、重力や摩擦力等（Ｔ０）
以外の負荷が設定値Ｔｓを越えている場合には、スポッ
トガンの溶着や衝突等が生じて負荷異常が生じているも
のとしてアラームを出力しフラグＦ１を「１」にセット
する（ステップＳ７）。そして、ステップＳ２で求めた
速度指令をキャンセルし速度指令を「０」とすると共に
速度ループ処理内の積分器を「０」にセットする（ステ
ップＳ８）。その後ステップＳ９に移行し、速度ループ
処理を行うが速度指令及び速度ループの積分器が「０」
であるので、モータを停止させるような電流が発生す
る。
【００２７】次の周期からはフラグＦ１が「１」にセッ
トされているから、ステップＳ３からステップＳ８へ移
行し、速度指令を「０」，速度ループの積分器を「０」
として速度ループ処理を行って電流指令を求め、電流ル
ープに引渡し、ロボットは停止した状態となる。また、
溶着等が生ぜずに、ステップＳ６で推定外乱トルクＴ１
から記憶している移動開始前の推定外乱トルクＴ０を差
し引いた絶対値が設定値Ｔｓより小さく、各周期毎ステ
ップＳ１〜Ｓ６、Ｓ９，Ｓ１０の処理を繰り返し、その
後移動指令開始から設定時間Ａが経過して制御装置１が
フラグＦ２を「０」にリセットすると、ディジタルサー
ボ回路３のプロセッサはステップＳ１〜Ｓ４の処理を実
施した後、ステップＳ１１に移行し、推定外乱トルクＴ
０を求め記憶する処理を実行し、ステップＳ５〜Ｓ８の
処理は実行しない。
トされているから、ステップＳ３からステップＳ８へ移
行し、速度指令を「０」，速度ループの積分器を「０」
として速度ループ処理を行って電流指令を求め、電流ル
ープに引渡し、ロボットは停止した状態となる。また、
溶着等が生ぜずに、ステップＳ６で推定外乱トルクＴ１
から記憶している移動開始前の推定外乱トルクＴ０を差
し引いた絶対値が設定値Ｔｓより小さく、各周期毎ステ
ップＳ１〜Ｓ６、Ｓ９，Ｓ１０の処理を繰り返し、その
後移動指令開始から設定時間Ａが経過して制御装置１が
フラグＦ２を「０」にリセットすると、ディジタルサー
ボ回路３のプロセッサはステップＳ１〜Ｓ４の処理を実
施した後、ステップＳ１１に移行し、推定外乱トルクＴ
０を求め記憶する処理を実行し、ステップＳ５〜Ｓ８の
処理は実行しない。
【００２８】すなわち、移動開始から所定微小時間Ａの
み負荷異常検出処理を実行するもので、溶着等による負
荷異常を検出するには移動開始直後の僅かな時間だけ負
荷異常を検出すれば足りるからである。また、ロボット
の姿勢が変化すれば、重力の影響が変化するため、負荷
異常検出基準値Ｔｓを小さな値に設定しておくと、何等
異常が発生していないにもかかわらず、ロボットの姿勢
により推定外乱トルクＴ１が大きくなり負荷異常として
誤検出する恐れがあるからである。また、上記基準値Ｔ
ｓを大きくすれば、上記所定微小時間以外の負荷異常も
検出できるが、溶着等によって生じる力が弱いときに
は、その溶着を検出できないことになる。そのため、１
回の移動（ロボットの移動停止から次ぎの移動停止ま
で）でロボット姿勢が大きく変化せず、１回の移動で重
力の影響が格別大きくならないような動作のときには、
上記所定時間Ａはロボット移動中の時間（移動指令の開
始から移動指令が「０」になるまでの間）としてもよ
い。
み負荷異常検出処理を実行するもので、溶着等による負
荷異常を検出するには移動開始直後の僅かな時間だけ負
荷異常を検出すれば足りるからである。また、ロボット
の姿勢が変化すれば、重力の影響が変化するため、負荷
異常検出基準値Ｔｓを小さな値に設定しておくと、何等
異常が発生していないにもかかわらず、ロボットの姿勢
により推定外乱トルクＴ１が大きくなり負荷異常として
誤検出する恐れがあるからである。また、上記基準値Ｔ
ｓを大きくすれば、上記所定微小時間以外の負荷異常も
検出できるが、溶着等によって生じる力が弱いときに
は、その溶着を検出できないことになる。そのため、１
回の移動（ロボットの移動停止から次ぎの移動停止ま
で）でロボット姿勢が大きく変化せず、１回の移動で重
力の影響が格別大きくならないような動作のときには、
上記所定時間Ａはロボット移動中の時間（移動指令の開
始から移動指令が「０」になるまでの間）としてもよ
い。
【００２９】なお、所定時間Ａが経過してフラグＦ２が
「０」にリセットされた後、ロボットが移動中にもかか
わらず、ステップＳ１１で推定外乱トルクＴ０を求め記
憶するが、この推定外乱トルクＴ０は順次更新されるた
め、そのうち、ロボットの移動は停止し、再び移動を開
始するときには、その移動開始直前の推定外乱トルクＴ
０を記憶することになるので問題はない。
「０」にリセットされた後、ロボットが移動中にもかか
わらず、ステップＳ１１で推定外乱トルクＴ０を求め記
憶するが、この推定外乱トルクＴ０は順次更新されるた
め、そのうち、ロボットの移動は停止し、再び移動を開
始するときには、その移動開始直前の推定外乱トルクＴ
０を記憶することになるので問題はない。
【００３０】図２は本発明の第２の実施例のディジタル
サーボ回路３のプロセッサが位置・速度ループ処理周期
毎実施する処理フローチャートである。この第２の実施
例と第１の実施例の相違する点は、第１の実施例は、負
荷異常検出処理を行う期間をロボッの制御装置１でセッ
ト／リセットされるフラグで行っていたが、この第２の
実施例では、この負荷異常検出処理区間もディジタルサ
ーボ回路３のプロセッサが判断して行うものである。
サーボ回路３のプロセッサが位置・速度ループ処理周期
毎実施する処理フローチャートである。この第２の実施
例と第１の実施例の相違する点は、第１の実施例は、負
荷異常検出処理を行う期間をロボッの制御装置１でセッ
ト／リセットされるフラグで行っていたが、この第２の
実施例では、この負荷異常検出処理区間もディジタルサ
ーボ回路３のプロセッサが判断して行うものである。
【００３１】ステップＳ２１〜Ｓ２３の処理は第１実施
例におけるステップＳ１〜Ｓ３と同一の処理で、制御装
置１からの移動指令を読み位置ループ処理を行い速度指
令θｒを求め、フラグＦ１が「１」か否か判断し、
「１」でなければ、ステップＳ２４に移行し、外乱推定
オブザーバの処理を実行し、推定外乱トルクＴ１を求め
る。次ぎにステップＳ２１で求めた移動指令θｒが
「０」か否か、すなわち移動指令が出力されているか否
か判断し（ステップＳ２５）、出力されてなければ、タ
イマＲＴを「０」にリセットし（ステップＳ２６）、ス
テップＳ２４で求めた推定外乱トルクＴ１をレジスタＲ
（Ｔ）にセットする（ステップＳ２７）。次ぎに、ステ
ップＳ２４で求めた推定外乱トルクＴ１からレジスタＲ
（Ｔ）に記憶する値を減じた値の絶対値が負荷異常検出
基準値Ｔｓ以上か否か判断し（ステップＳ２８）、この
場合は、「０」であるので、基準値Ｔｓの値を越えてな
いからステップＳ３１に移行して速度ループ処理を行い
求めた電流指令を電流ループに出力する（ステップＳ３
１，Ｓ３２）。移動指令がだされずロボットが停止して
いる間は上記ステップＳ２１〜Ｓ２８、Ｓ３１，Ｓ３２
の処理を各周期毎繰り返すことになる。
例におけるステップＳ１〜Ｓ３と同一の処理で、制御装
置１からの移動指令を読み位置ループ処理を行い速度指
令θｒを求め、フラグＦ１が「１」か否か判断し、
「１」でなければ、ステップＳ２４に移行し、外乱推定
オブザーバの処理を実行し、推定外乱トルクＴ１を求め
る。次ぎにステップＳ２１で求めた移動指令θｒが
「０」か否か、すなわち移動指令が出力されているか否
か判断し（ステップＳ２５）、出力されてなければ、タ
イマＲＴを「０」にリセットし（ステップＳ２６）、ス
テップＳ２４で求めた推定外乱トルクＴ１をレジスタＲ
（Ｔ）にセットする（ステップＳ２７）。次ぎに、ステ
ップＳ２４で求めた推定外乱トルクＴ１からレジスタＲ
（Ｔ）に記憶する値を減じた値の絶対値が負荷異常検出
基準値Ｔｓ以上か否か判断し（ステップＳ２８）、この
場合は、「０」であるので、基準値Ｔｓの値を越えてな
いからステップＳ３１に移行して速度ループ処理を行い
求めた電流指令を電流ループに出力する（ステップＳ３
１，Ｓ３２）。移動指令がだされずロボットが停止して
いる間は上記ステップＳ２１〜Ｓ２８、Ｓ３１，Ｓ３２
の処理を各周期毎繰り返すことになる。
【００３２】移動指令が出力されると、ステップＳ２５
からステップＳ３３に移行し、タイマＲＴに「１」加算
し、該タイマＲＴの値が設定微小時間Ａを越えているか
否か判断し（ステップＳ３４）、越えてなければ、ステ
ップＳ２８に移行する。この場合、レジスタＲ（Ｔ）に
はロボットが移動開始する直前の推定外乱トルク（Ｔ
０）が記憶されている。その結果、ステップＳ２８でス
テップＳ２４で検出された現時点での推定外乱トルクＴ
１からレジスタＲ（Ｔ）に記憶する移動開始直前の推定
外乱トルクをステップＳ２８で減じると、この減じた値
は重力や摩擦力を排除した純粋にロボットアームにかか
る該力を意味し、この値が設定基準値Ｔｓを越えていれ
ば、異常負荷として検出し、越えてなければ、正常とす
る。正常であけば、ステップＳ２８からステップＳ３１
に移行し、速度ループ処理を行い電流指令を求め電流ル
ープに出力する（ステップＳ３１，Ｓ３２）。以下、
（ステップＳ２１〜Ｓ２５、Ｓ３３，Ｓ３４、Ｓ２８、
Ｓ３１，Ｓ３２の処理をタイマＲＴの値が設定値Ａを越
えるまで実行し、越えると、異常負荷か否かの判断であ
るステップＳ２８の処理を行うことなく、ステップＳ３
４からステップＳ３１に移行する。
からステップＳ３３に移行し、タイマＲＴに「１」加算
し、該タイマＲＴの値が設定微小時間Ａを越えているか
否か判断し（ステップＳ３４）、越えてなければ、ステ
ップＳ２８に移行する。この場合、レジスタＲ（Ｔ）に
はロボットが移動開始する直前の推定外乱トルク（Ｔ
０）が記憶されている。その結果、ステップＳ２８でス
テップＳ２４で検出された現時点での推定外乱トルクＴ
１からレジスタＲ（Ｔ）に記憶する移動開始直前の推定
外乱トルクをステップＳ２８で減じると、この減じた値
は重力や摩擦力を排除した純粋にロボットアームにかか
る該力を意味し、この値が設定基準値Ｔｓを越えていれ
ば、異常負荷として検出し、越えてなければ、正常とす
る。正常であけば、ステップＳ２８からステップＳ３１
に移行し、速度ループ処理を行い電流指令を求め電流ル
ープに出力する（ステップＳ３１，Ｓ３２）。以下、
（ステップＳ２１〜Ｓ２５、Ｓ３３，Ｓ３４、Ｓ２８、
Ｓ３１，Ｓ３２の処理をタイマＲＴの値が設定値Ａを越
えるまで実行し、越えると、異常負荷か否かの判断であ
るステップＳ２８の処理を行うことなく、ステップＳ３
４からステップＳ３１に移行する。
【００３３】一方ステップＳ２８で、現時点の推定外乱
トルクＴ１とレジスタＲ（Ｔ）に記憶する移動開始直前
の推定外乱トルクとの差が設定基準値Ｔｓ以上になる
と、負荷異常としてステップＳ２８からステップＳ２９
に移行し、アラームを出力し、フラグＦ１を「１」にセ
ットして速度指令及び速度ループの積分器を「０」にセ
ットする。その結果、サーボモータにはモータを停止さ
せるような電流指令が出され、サーボモータの回転は停
止し、ロボットは停止することになる。そして、以後は
フラグＦ１が「１」にセットされていることになるか
ら、各周期ごとステップＳ２１〜Ｓ２３、Ｓ３０，Ｓ３
１，Ｓ３２の処理を実行することになる。
トルクＴ１とレジスタＲ（Ｔ）に記憶する移動開始直前
の推定外乱トルクとの差が設定基準値Ｔｓ以上になる
と、負荷異常としてステップＳ２８からステップＳ２９
に移行し、アラームを出力し、フラグＦ１を「１」にセ
ットして速度指令及び速度ループの積分器を「０」にセ
ットする。その結果、サーボモータにはモータを停止さ
せるような電流指令が出され、サーボモータの回転は停
止し、ロボットは停止することになる。そして、以後は
フラグＦ１が「１」にセットされていることになるか
ら、各周期ごとステップＳ２１〜Ｓ２３、Ｓ３０，Ｓ３
１，Ｓ３２の処理を実行することになる。
【００３４】なお、この第２実施例においても、所定時
間Ａの区間だけ負荷異常を判断することなく、移動中は
負荷異常を検出するようにしてもよい。この場合には、
ステップＳ２６、Ｓ３３，Ｓ３４の処理は必要なく、ス
テップＳ２５で移動指令θｒが「０」ではないと判断さ
れたときにはステップＳ２８に移行するようにすればよ
い。
間Ａの区間だけ負荷異常を判断することなく、移動中は
負荷異常を検出するようにしてもよい。この場合には、
ステップＳ２６、Ｓ３３，Ｓ３４の処理は必要なく、ス
テップＳ２５で移動指令θｒが「０」ではないと判断さ
れたときにはステップＳ２８に移行するようにすればよ
い。
【００３５】なお、スポット溶接ロボット等において、
溶着等の負荷異常の検出処理を実行する軸は、スポット
溶接終了後にロボットアームを移動させる軸、例えばア
ームを前後に移動させる軸に対してのみ行うようにすれ
ばよい。さらに、ロボットに限らず、工作機械等のサー
ボモータで機械駆動部が駆動されるものに対しても本願
発明は適用できるものである。
溶着等の負荷異常の検出処理を実行する軸は、スポット
溶接終了後にロボットアームを移動させる軸、例えばア
ームを前後に移動させる軸に対してのみ行うようにすれ
ばよい。さらに、ロボットに限らず、工作機械等のサー
ボモータで機械駆動部が駆動されるものに対しても本願
発明は適用できるものである。
【００３６】
【発明の効果】本発明においては、機械可動部が移動中
検出される推定外乱トルクから、機械可動部の移動開始
直前の推定外乱トルクを減じて得られる差によって、重
力や摩擦力を除いた機械可動部にかかる力を推定し、こ
の差が負荷異常検出基準値以上のとき負荷異常として検
出するようにしたから、負荷異常の判断基準となる設定
値を小さくかつ精度高く設定できる。それにより、溶着
によって若しくは障害物に可動部が衝突して生じる可動
部を駆動するサーボモータの出力トルクを逸早く検出し
することができ、機械可動部やワークに損傷を与えるこ
となく正確に溶着、衝突等の負荷異常を検出できる。
検出される推定外乱トルクから、機械可動部の移動開始
直前の推定外乱トルクを減じて得られる差によって、重
力や摩擦力を除いた機械可動部にかかる力を推定し、こ
の差が負荷異常検出基準値以上のとき負荷異常として検
出するようにしたから、負荷異常の判断基準となる設定
値を小さくかつ精度高く設定できる。それにより、溶着
によって若しくは障害物に可動部が衝突して生じる可動
部を駆動するサーボモータの出力トルクを逸早く検出し
することができ、機械可動部やワークに損傷を与えるこ
となく正確に溶着、衝突等の負荷異常を検出できる。
【００３７】また、機械可動部が移動開始してから所定
時間だけ上記負荷異常検出処理を実行することによっ
て、移動開始時の機械可動部が受ける重力、摩擦力が大
きく変化しない期間だけ負荷異常検出を行うようにし
て、上記負荷異常検出基準値を小さく正確に設定できる
から、溶着等の負荷異常を正確に検出でき誤検出をなく
すことができる。
時間だけ上記負荷異常検出処理を実行することによっ
て、移動開始時の機械可動部が受ける重力、摩擦力が大
きく変化しない期間だけ負荷異常検出を行うようにし
て、上記負荷異常検出基準値を小さく正確に設定できる
から、溶着等の負荷異常を正確に検出でき誤検出をなく
すことができる。
【図１】本発明の第１の実施例のフローチャートであ
る。
る。
【図２】本発明の第２の実施例のフローチャートであ
る。
る。
【図３】サーボモータ制御系のブロック図である。
【図４】外乱推定オブザーバを組むモデルのブロック図
である。
である。
【図５】外乱推定オブザーバの一例を示すブロック図で
ある。
ある。
【図６】本発明の実施例を実施するディジタルサーボ系
のブロック図である。
のブロック図である。
【図７】スポット溶接ロボットの前後に移動する軸のス
ポット溶接後に移動した時（スポットガン先端の溶着が
ないとき）の１秒間におけるトルク指令と外乱トルクを
測定したグラフである。
ポット溶接後に移動した時（スポットガン先端の溶着が
ないとき）の１秒間におけるトルク指令と外乱トルクを
測定したグラフである。
【図８】スポット溶接ロボットの前後に移動する軸のス
ポット溶接後に移動した時（スポットガン先端が溶着し
たとき）の１秒間におけるトルク指令と外乱トルクを測
定したグラフである。
ポット溶接後に移動した時（スポットガン先端が溶着し
たとき）の１秒間におけるトルク指令と外乱トルクを測
定したグラフである。
１ ロボットの制御装置 ２ 共有メモリ ３ ディジタルサーボ回路 ４ サーボアンプ ５ サーボモータ ６ 位置・速度検出器 ５０ 外乱推定オブサーバ ＴL 外乱トルク Ｔ 推定外乱トルク Ｔ０ 機械可動部移動開始前の推定外乱トルク Ｔ１ 機械可動部移動開始中の推定外乱トルク Ｔｓ 負荷異常検出基準値
───────────────────────────────────────────────────── フロントページの続き (72)発明者 大塚 和久 山梨県南都留郡忍野村忍草字古馬場3580 番地 ファナック株式会社 商品開発研 究所 内 (72)発明者 加藤 哲朗 山梨県南都留郡忍野村忍草字古馬場3580 番地 ファナック株式会社 商品開発研 究所 内 (72)発明者 杉山 秀樹 山梨県南都留郡忍野村忍草字古馬場3580 番地 ファナック株式会社 商品開発研 究所 内 (56)参考文献 特開 平３−196313（ＪＰ，Ａ) 特開 平２−284899（ＪＰ，Ａ)
Claims (3)
- 【請求項１】 機械可動部が動きだす直前における外乱
推定オブサーバで検出された推定外乱トルクを記憶し、
機械可動部が移動中、上記外乱推定オブザーバで検出さ
れる推定外乱トルクから上記記憶した推定外乱トルクを
差し引いた値が設定値以上になったとき負荷異常として
検出することを特徴とする異常負荷検出方法。 - 【請求項２】 機械可動部が動きだす直前における外乱
推定オブサーバで検出された推定外乱トルクを記憶し、
機械可動部が移動を開始してから設定所定時間内におい
て、上記外乱推定オブザーバで検出される推定外乱トル
クから上記記憶した推定外乱トルクを差し引いた値が設
定値以上になったとき負荷異常として検出することを特
徴とする異常負荷検出方法。 - 【請求項３】 スポット溶接ロボットのアームが動きだ
す直前における外乱推定オブサーバで検出された推定外
乱トルクを記憶し、アームが移動を開始してから設定所
定時間内において、上記外乱推定オブザーバで検出され
る推定外乱トルクから上記記憶した推定外乱トルクを差
し引いた値が設定値以上になったとき負荷異常として検
出することを特徴とする異常負荷検出方法。
Priority Applications (6)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3308214A JP2732159B2 (ja) | 1991-10-29 | 1991-10-29 | 異常負荷検出方法 |
| US08/084,181 US5493192A (en) | 1991-10-29 | 1992-10-10 | Abnormal load detection method |
| KR1019930701147A KR930702110A (ko) | 1991-10-29 | 1992-10-27 | 이상부하 검출방법 |
| PCT/JP1992/001391 WO1993008958A1 (en) | 1991-10-29 | 1992-10-27 | Abnormal load detecting method |
| EP92921818A EP0566741B1 (en) | 1991-10-29 | 1992-10-27 | Abnormal load detecting method |
| DE69224516T DE69224516T2 (de) | 1991-10-29 | 1992-10-27 | Verfahren zur entdeckung einer anormalen belastung |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3308214A JP2732159B2 (ja) | 1991-10-29 | 1991-10-29 | 異常負荷検出方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH05116094A JPH05116094A (ja) | 1993-05-14 |
| JP2732159B2 true JP2732159B2 (ja) | 1998-03-25 |
Family
ID=17978295
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP3308214A Expired - Lifetime JP2732159B2 (ja) | 1991-10-29 | 1991-10-29 | 異常負荷検出方法 |
Country Status (6)
| Country | Link |
|---|---|
| US (1) | US5493192A (ja) |
| EP (1) | EP0566741B1 (ja) |
| JP (1) | JP2732159B2 (ja) |
| KR (1) | KR930702110A (ja) |
| DE (1) | DE69224516T2 (ja) |
| WO (1) | WO1993008958A1 (ja) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US10967514B2 (en) | 2018-08-22 | 2021-04-06 | Abb Schweiz Ag | Apparatus and method to monitor robot mechanical condition |
Families Citing this family (33)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06262492A (ja) * | 1993-03-17 | 1994-09-20 | Fanuc Ltd | 外乱負荷推定による工具の寿命管理方法 |
| JPH079204A (ja) * | 1993-06-29 | 1995-01-13 | Fanuc Ltd | 旋盤のバーフィーダにおける力制御方法 |
| US6122998A (en) * | 1993-06-29 | 2000-09-26 | Fanuc, Ltd. | Force control method for a bar feeder of a lathe |
| EP0640428B1 (en) * | 1993-08-25 | 1997-11-05 | Toyota Jidosha Kabushiki Kaisha | Spot welding control method and apparatus using a servo welding gun |
| JP3077514B2 (ja) * | 1994-06-28 | 2000-08-14 | トヨタ自動車株式会社 | ロボット |
| JPH0866893A (ja) * | 1994-08-24 | 1996-03-12 | Fanuc Ltd | 衝突検出方法 |
| JP3288184B2 (ja) * | 1994-10-05 | 2002-06-04 | 三菱電機株式会社 | 電動機の制御装置 |
| WO1996012277A1 (en) * | 1994-10-18 | 1996-04-25 | Iomega Corporation | Disk cartridge detection methods and apparatus |
| US5854719A (en) * | 1994-10-18 | 1998-12-29 | Iomega Corporation | Methods and apparatus for detecting whether a removable cartridge disk drive is empty |
| US5656908A (en) * | 1995-05-30 | 1997-08-12 | Allen-Bradley Company, Inc. | Negative coefficient filter for use with AC motors |
| JP3655378B2 (ja) * | 1995-11-28 | 2005-06-02 | ファナック株式会社 | サーボモータの外乱負荷推定方法 |
| JP3755843B2 (ja) * | 1996-09-30 | 2006-03-15 | Ｏｂａｒａ株式会社 | 加圧型抵抗溶接機の制御方法 |
| JP3136282B2 (ja) * | 1997-08-13 | 2001-02-19 | ファナック株式会社 | サーボガン軸の異常負荷検出方法及び装置 |
| JP3322826B2 (ja) * | 1997-08-13 | 2002-09-09 | ファナック株式会社 | サーボモータによる加圧制御方法及び装置 |
| JP2000006070A (ja) * | 1998-06-19 | 2000-01-11 | Fanuc Ltd | ロボット制御システム |
| JP2000099157A (ja) * | 1998-09-21 | 2000-04-07 | Olympus Optical Co Ltd | 移送機構の動作異常検知装置 |
| US6671317B1 (en) * | 1998-11-30 | 2003-12-30 | Sony Corporation | Information processing unit, information processing method, and recording medium therewith |
| JP3773686B2 (ja) * | 1999-02-17 | 2006-05-10 | パイオニア株式会社 | サーボ制御装置及びサーボ制御方法 |
| ATE358839T1 (de) * | 2002-08-06 | 2007-04-15 | Assembleon Nv | Verfahren zur erkennung einer funktionsstörung während der bewegung eines teiles durch ein antriebsystem und vorrichtung zur ausführung eines solchen verfahrens |
| DE10258059B4 (de) * | 2002-12-11 | 2006-12-14 | Nimak-Automatisierte-Schweisstechnik Gmbh | Verfahren zum Steuern einer Werkzeug-Anpreßkraft bei Fügevorrichtungen |
| US20050263565A1 (en) * | 2003-10-23 | 2005-12-01 | Assembleon N.V. | Method and device for moving an element by means of a drive |
| JP4897632B2 (ja) * | 2007-09-27 | 2012-03-14 | ファナック株式会社 | 衝突検出機能を有する工作機械の制御装置 |
| JP4335286B2 (ja) * | 2008-02-08 | 2009-09-30 | ファナック株式会社 | 部品保護機能を備えたロボット制御装置及びロボット制御方法 |
| JP5315830B2 (ja) * | 2008-07-24 | 2013-10-16 | 三菱電機株式会社 | モータの回転異常検出回路 |
| JP5365595B2 (ja) * | 2010-09-15 | 2013-12-11 | 株式会社安川電機 | 減速機の異常判定方法、異常判定装置、ロボット及びロボットシステム |
| JP2016087700A (ja) * | 2014-10-29 | 2016-05-23 | ファナック株式会社 | 負荷情報の設定を確認する機能を備えた制御装置 |
| JP5969574B2 (ja) | 2014-11-07 | 2016-08-17 | ファナック株式会社 | 過大負荷を検出するモータ制御装置 |
| JP6848206B2 (ja) * | 2015-05-20 | 2021-03-24 | 日産自動車株式会社 | 故障診断装置及び故障診断方法 |
| WO2016185593A1 (ja) * | 2015-05-21 | 2016-11-24 | 日産自動車株式会社 | 故障診断装置及び故障診断方法 |
| DE102015009892A1 (de) * | 2015-07-30 | 2017-02-02 | Kuka Roboter Gmbh | Verfahren und System zum Steuern eines Roboters |
| JP6285405B2 (ja) | 2015-12-04 | 2018-02-28 | ファナック株式会社 | 工作機械及びロボットを備えた複合システム |
| CN110587665B (zh) * | 2019-09-02 | 2022-04-08 | 埃夫特智能装备股份有限公司 | 一种工业机器人关节碰撞保护方法 |
| CN111665878A (zh) * | 2020-05-15 | 2020-09-15 | 成都飞机工业（集团）有限责任公司 | 一种基于闭环控制的恒定力加载模拟装置及力加载方法 |
Family Cites Families (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS58186538A (ja) * | 1982-04-22 | 1983-10-31 | Toyoda Mach Works Ltd | ねじ締めロボツト |
| JP2713899B2 (ja) * | 1987-03-30 | 1998-02-16 | 株式会社日立製作所 | ロボツト装置 |
| JPS6478308A (en) * | 1987-09-19 | 1989-03-23 | Fanuc Ltd | Robot control system based on load conditions |
| US4925312A (en) * | 1988-03-21 | 1990-05-15 | Staubli International Ag | Robot control system having adaptive feedforward torque control for improved accuracy |
| JPH01310889A (ja) * | 1988-06-10 | 1989-12-14 | Toshiba Corp | 産業用ロボットの制御装置 |
| JPH02146602A (ja) * | 1988-08-11 | 1990-06-05 | Fanuc Ltd | サーボモータにより駆動される被駆動体の衝突検出・停出方法 |
| JPH02199502A (ja) * | 1989-01-30 | 1990-08-07 | Fanuc Ltd | 外乱推定オブザーバによるサーボ制御方法 |
| JPH02224990A (ja) * | 1989-02-23 | 1990-09-06 | Fujitsu Ltd | 計測ロボット |
| JPH02284899A (ja) * | 1989-04-25 | 1990-11-22 | Citizen Watch Co Ltd | ロボットの制御方法およびその制御装置 |
| JPH02297603A (ja) * | 1989-05-12 | 1990-12-10 | Fanuc Ltd | スライディングモードと外乱推定オブザーバを併用したサーボ制御方式 |
| JP2665984B2 (ja) * | 1989-12-26 | 1997-10-22 | ファナック株式会社 | 外乱推定オブザーバによる衝突検出方法 |
| JP2793695B2 (ja) * | 1990-05-17 | 1998-09-03 | ファナック株式会社 | 物体の認識制御方法 |
-
1991
- 1991-10-29 JP JP3308214A patent/JP2732159B2/ja not_active Expired - Lifetime
-
1992
- 1992-10-10 US US08/084,181 patent/US5493192A/en not_active Expired - Lifetime
- 1992-10-27 EP EP92921818A patent/EP0566741B1/en not_active Expired - Lifetime
- 1992-10-27 KR KR1019930701147A patent/KR930702110A/ko not_active Application Discontinuation
- 1992-10-27 WO PCT/JP1992/001391 patent/WO1993008958A1/ja active IP Right Grant
- 1992-10-27 DE DE69224516T patent/DE69224516T2/de not_active Expired - Lifetime
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US10967514B2 (en) | 2018-08-22 | 2021-04-06 | Abb Schweiz Ag | Apparatus and method to monitor robot mechanical condition |
Also Published As
| Publication number | Publication date |
|---|---|
| EP0566741A4 (en) | 1994-07-27 |
| EP0566741B1 (en) | 1998-02-25 |
| EP0566741A1 (en) | 1993-10-27 |
| DE69224516D1 (de) | 1998-04-02 |
| DE69224516T2 (de) | 1998-06-18 |
| KR930702110A (ko) | 1993-09-08 |
| US5493192A (en) | 1996-02-20 |
| WO1993008958A1 (en) | 1993-05-13 |
| JPH05116094A (ja) | 1993-05-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP2732159B2 (ja) | 異常負荷検出方法 | |
| JP2665984B2 (ja) | 外乱推定オブザーバによる衝突検出方法 | |
| KR0144650B1 (ko) | 서보모터의 이상부하 검출 제어방법 | |
| JP4955791B2 (ja) | ロボットシステム | |
| US5119006A (en) | Method of detecting a collision of machine operating parts driven by servomotors | |
| JPH0866893A (ja) | 衝突検出方法 | |
| KR101844542B1 (ko) | 협업로봇의 충돌을 감지하는 장치 및 방법 | |
| US20060129348A1 (en) | System for collision a voidance of rotary atomizer | |
| JP4261470B2 (ja) | 制御装置 | |
| JP3367641B2 (ja) | ロボットの制御装置 | |
| JP3623582B2 (ja) | ロボットの故障診断方法 | |
| JP6731583B2 (ja) | モータ制御装置 | |
| JPH1170490A (ja) | 産業用ロボットの衝突検出方法 | |
| JPH11282540A (ja) | ロボットの制御装置とその制御方法 | |
| JPH06339292A (ja) | 外乱負荷推定による力制御方法 | |
| JP3211406B2 (ja) | 制振制御方法およびこれを用いた速度パターン算出方法および装置 | |
| JP2749724B2 (ja) | 推定外乱による衝突検出方法 | |
| JPH0682346A (ja) | イナーシャ、外乱トルクの推定及び異常負荷検出方法 | |
| JP2793695B2 (ja) | 物体の認識制御方法 | |
| JPH06131050A (ja) | サーボモータで駆動される可動部の衝突検出方法 | |
| JPH11245191A (ja) | 産業用ロボットの駆動軸制御方法及びその装置 | |
| JP3165087B2 (ja) | 産業用ロボットの故障検出方法 | |
| JP3171860B2 (ja) | サーボ制御システム | |
| JPH06170540A (ja) | 溶接ロボットの溶着検出方法 | |
| JP2673028B2 (ja) | ロボットの位置決め検出方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 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: 20071226 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081226 Year of fee payment: 11 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091226 Year of fee payment: 12 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091226 Year of fee payment: 12 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101226 Year of fee payment: 13 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111226 Year of fee payment: 14 |
|
| EXPY | Cancellation because of completion of term |