JPS60108904A - ロボットの軌跡異常検出装置 - Google Patents

ロボットの軌跡異常検出装置

Info

Publication number
JPS60108904A
JPS60108904A JP58215104A JP21510483A JPS60108904A JP S60108904 A JPS60108904 A JP S60108904A JP 58215104 A JP58215104 A JP 58215104A JP 21510483 A JP21510483 A JP 21510483A JP S60108904 A JPS60108904 A JP S60108904A
Authority
JP
Japan
Prior art keywords
robot
cpu
adder
subtractor
locus
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.)
Pending
Application number
JP58215104A
Other languages
English (en)
Inventor
Yoshihisa Azuma
東 良久
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nachi Fujikoshi Corp
Original Assignee
Nachi Fujikoshi Corp
Fujikoshi KK
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nachi Fujikoshi Corp, Fujikoshi KK filed Critical Nachi Fujikoshi Corp
Priority to JP58215104A priority Critical patent/JPS60108904A/ja
Publication of JPS60108904A publication Critical patent/JPS60108904A/ja
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/406Numerical 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
    • G05B19/4063Monitoring general control system
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/42Servomotor, servo controller kind till VSS
    • G05B2219/42268Safety, excess in error
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/45Nc applications
    • G05B2219/45083Manipulators, robot

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Testing And Monitoring For Control Systems (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 この発明は産業用ロボットにおいてロボットが本来動作
すべき軌跡に対し何らかの原因で軌跡が再生運転中に許
容範囲をこえてズレを発生した時に、ただちにそnを検
知し、ロボットを停止させるロボットの軌跡異常検出装
置に関する。該装置は、ロボットの内部要因たとえば駆
動系の不良、位置検出器の不良、配線の断線事故なども
検出できるものである。
(背景技術〕 従来のロボット制御において、サーボ系の異常検出をお
こなう技術は主としてロボットの制御装置CPUからサ
ーボモータへの指令値zaと、その軸の検出器からフィ
ード・(ツク信号値xfとの差Δx = xa −xf
 をあらかじめ設定しである値TDと比較して lΔxl > TD ・−・−tl) 1△xl ’ TD ・・・・・・ (2)の判定を行
ない、(2)の場合には正常、(1]の場合には指令直
と現在ロボットのいる位置のズレが大きいとまず判断さ
れる。しかしく1】の条件だけで異常と決定することは
出来ない。たとえばロボットのスタート時では、ロボッ
トは停止状態で指令値のみが先行していく現象は充分あ
りうるために(11の条件は正常な運転時でも発生しう
るのである。これをさけるために従来は(1)の条件に
さらに時間遅れ要素を付加し瞬間的なピークを除く方法
がよく用いら扛る。
上記のような方法でサーボ系の異常を検出しようとする
時には、(1)、(2)式の比較は瞬時に行なわ扛るが
、その後に時間遅n要素をもたせて、一定時間to持続
してはじめて異常と判定するために即応性に欠ける点が
問題である。したがいロボットの描く軌跡の点からみる
と大きく目的とする軌跡からズしてからようやく異常検
出がはたらくという欠点がある。
(本発明の目的ジ この発明の目的と謙るところは、ロボットが本来動いて
作る軌跡から何らかの不具合(たとえ点で、異常検出を
行ない、必要な処置をと扛るようにしたものである。(
たとえば、ロボットをその場で非常停止をかける)。特
に軌跡を重視するロボット作業において、サーボ系の不
良が発生した時に時間遅nなく異常を検出できるように
することを目的とする。
(発明の構成・効果ノ ロボットの1軸にそ扛ぞ扛設けら扛た、位置フィードバ
ック信号(xjつをCPUおよび加減算器に出力する位
置検出器と、ロボットの当該−軸の位置指令値(Xす、
指定移動速度(V)および追従遅扛量(α)とを修正位
置データ演算ユニットに入力する前記CPUと、前記指
令値、指定移動速度および追従遅れ量にもとづき基本単
位時間to後のロボットの当該−軸の推定移動位置即ち
修正位置データ(XA)を前記加減算器に出力する修正
位置データ演算ユニットと、前記位置フィードバンク信
号(XJ’)と前記修正位置データ(XA)との差の絶
対値(△XA)を比較器に人力する加減算器と、予め入
力された許容上限下限値(TV)と前記絶対値(△XA
)とを単位時間(tり毎に比較、してそれと同じかまた
はそれより大きいときに異常信号を前記CPUに出力す
る比較器と、を含むロボットの軌跡異常検出装置とした
ものである。
かかる構成によると、第2図第3図でわかるように従来
のサーボ系の異常検出はロボットの現在値xfとその時
の指令値xOをもとに判断していたがこのxj゛とx’
c をもとに判断するよシ、現在ロボットがここにいる
と推定さ扛る値XAと現在値xfの比較の方がより正確
であり、軌跡異常の検出という点からも重要であること
が判るであろう0即ちこの発明による効果としては、ロ
ボットの軌跡に関する精度管理を実時間で行なえるよう
に、なったことである。特に塗装用とかシーリング用、
またはアーク溶接その他のように軌跡そのものがロボッ
トの性能を規定する場合の異常検出に対しては極めて有
益である。
さらにサニボ系に含まれる部品類の不良検出にも有益で
ある。たとえばモータの異常、エンコーダの異常及びケ
ーブル類の断線などが発生した時にはロボットの現在値
と予測位置に大きな差がすぐ発生するのでこnを時間遅
九なく検出できるメリットもある。
(実施例の説明) 複数の動作軸をもち、それぞ扛に位置検出器(1)を有
するロボット本体と記憶装置と演算装置を有するロボッ
ト用のcptr制御装置(2)があるときに、以下にの
べる付加回路をつけることにより、ロボットの動作軌跡
の異常検出機能を実玩できる。第1図では口でノドの本
体の任意の、軸について説明する○ 駆動軸に位置検出器(1)をと9つける。この出力信号
は通常位置フィードバック信号Xj′(3)として使用
さnるが、この発明では、異常検出用として加算器(減
算器)αIへの入力信号としても使用する。
一方CPU制御装置(2)より、位置指令値xa<4)
をと9だして修正位置−データ演算ユニット(5)へ入
力としで与える。この修正位置データ演算ユニット(5
)の中は3つに分か扛ておす、そnぞ扛入カデータメモ
リ(6ンと修正演習−ユニット(7)と出力データメモ
リ(8)からなっている。人力データメモリ(6)は指
令値を一担保存しく7)の修正演算ユニットのデータを
送り込みをする。(7)の役割はロボットの当該−軸の
位置指令1i[x ロと指定移動速菱v1そして追従遅
れ量αをもとに基本拳位時間teaのロボットの当該−
軸の推定移動位置を計算する。つまりロボットの有する
追従遅iLをもとに現時点におけるロボットの位置を計
算でめることヲ(7)のユニットで行なう。この推定位
置のデータ即ち修正位置データXAは出力データメモリ
(8)に出力さ扛る0そして出力データメモリ(8〕か
らの出力XAはライン(9)を経由して叫の加算器に接
続さ扛、ここでロボットの現在位置のデータ(3)のx
fと引算の演算を行なう。(lO)の加算器の出力qυ
は予測されるロボットの位置と、現実のロボットの位置
の違いを見ることになる。
この出力が差分データΔXA == Xf−XAである
。この出力qつが比較器1.1′4へ送られる。この比
較器において(7)の修正用演算ユニットでめられる許
容上限下限値がQつのラインを経由してu41の許容上
限下限設定値メモリユニットへ転送される0ここでの計
容上限下限値T (v)はロボットの現在いる位置と計
算により(7)でもとめらnる位置との間に許さnる誤
差であり、ロボットの種類及び用途で決定される。q4
の上限下限設定値メモリユニットから単位時間ta毎に
1.12の比較器へデータが送らnてデータの比較を実
行する。その結果において1xf−XAI < T (
tyJ ・・・・・・・・A3)lxf−XAI≧T 
(V) ・・・・・−・・・(4)上式(3)の時は正
常な動作を行ない、ロボットはめる軌跡にそう動作をし
ていると判断できるし1もし上式(4)の時には許容値
からはずnたと判断する。それぞ扛の結果は四のライン
及びαηのラインでCPU制御装置に伝えら扛る。特に
α′?)の軌跡異常出力によりロボットの運転を停止す
るか又は非常停止をかけるなどの処置をとることができ
る。
なお上記において、許容上限下限値(TV)はイー正位
置データ演算ユニット(b)が出力するようにしたがC
PU (21から出力させてもよい。
【図面の簡単な説明】
第1図は本発明の例示的一実施例の装置を示すブロック
図、記2図は第1図の装置の作動による各位置データと
時間との関係を示すグラフ、第3図は第2図の部分拡大
図である。 1・・・・・・位置検出器 2 ・・・・・・cpu 3・・・・・・位置フィードバック信号xf5・・・・
・・修正位置データ演算ユニット9・・・・・・修正位
置データXA 10・・・・・・加減算器 12・・・・・・比較器 代理人 弁理士 河 内 潤 二 第1 目

Claims (1)

    【特許請求の範囲】
  1. ロボットの1軸にそnぞ扛設けら扛た、位置フィードバ
    ック信号(3)(xf)をCPU (2)および加減カ
    ー器00に出力する位置検出器(11と、ロボットの当
    該−軸の位置指令値(xC)、指定移動速度(V)およ
    び追従遅れ量(α]とを修正位置データ演算ユニット(
    5ンに入力する前記CPU (2)と、前記指令値、指
    定移動速度および追従遅れ量にもとづき基本単位時間t
    o後のロボットの当肢−軸の推定移動位置即ち修正位置
    データ(XA )を前記加減算器叫に出力する修正位置
    データ演算ユニット(5)と、前記位置フィードバッタ
    信号(XJつと前記修正位置データ(9) (Xりとの
    差の絶対値(△Xh)を比較器Q2に入力する加減算器
    α0と、予め入力された許容上限下限値(Tv)と前記
    絶対値(△xA)とを単位時間(tり毎に比較してそれ
    と同じか祉たはそれより大きいときに異常信号を前記C
    PU (2)に出力する比較器Q4と、を含むロボット
    の軌跡異常検出装置。
JP58215104A 1983-11-17 1983-11-17 ロボットの軌跡異常検出装置 Pending JPS60108904A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP58215104A JPS60108904A (ja) 1983-11-17 1983-11-17 ロボットの軌跡異常検出装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP58215104A JPS60108904A (ja) 1983-11-17 1983-11-17 ロボットの軌跡異常検出装置

Publications (1)

Publication Number Publication Date
JPS60108904A true JPS60108904A (ja) 1985-06-14

Family

ID=16666816

Family Applications (1)

Application Number Title Priority Date Filing Date
JP58215104A Pending JPS60108904A (ja) 1983-11-17 1983-11-17 ロボットの軌跡異常検出装置

Country Status (1)

Country Link
JP (1) JPS60108904A (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102018004437A1 (de) 2017-06-12 2018-12-13 Fanuc Corporation Vorrichtung und Verfahren für die Unterstützung der Detektion einer Kabelbeschädigung in einem Robotermechanismus

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS54101072A (en) * 1978-01-25 1979-08-09 Toshiba Corp False operation detector of servo-device

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS54101072A (en) * 1978-01-25 1979-08-09 Toshiba Corp False operation detector of servo-device

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102018004437A1 (de) 2017-06-12 2018-12-13 Fanuc Corporation Vorrichtung und Verfahren für die Unterstützung der Detektion einer Kabelbeschädigung in einem Robotermechanismus
JP2019000916A (ja) * 2017-06-12 2019-01-10 ファナック株式会社 ロボット機構内のケーブル損傷発見支援装置及びケーブル損傷発見支援方法
DE102018004437B4 (de) * 2017-06-12 2020-11-26 Fanuc Corporation Vorrichtung und Verfahren für die Unterstützung der Detektion einer Kabelbeschädigung in einem Robotermechanismus
US10899010B2 (en) 2017-06-12 2021-01-26 Fanuc Corporation Cable damage detection assistance apparatus and cable damage detection assistance method in robot mechanism

Similar Documents

Publication Publication Date Title
US20200047344A1 (en) Method and device for detecting abnormality of encoder, and robot control system
US5418440A (en) Position control device for servomotor
US5834916A (en) Industrial robot and its control unit
US8145356B2 (en) Robot controller for halting a robot based on the speed of a robot hand portion
US10996654B2 (en) Servo controller
US7425811B2 (en) Numerical controller
US11446823B2 (en) Method for transmitting information in controller and method for detecting abnormality in encoder
US20160231728A1 (en) Method And System For Operating A Multi-Axis Machine, In Particular A Robot
JPS5981094A (ja) 自動機械
JP5120082B2 (ja) ロボット暴走判定方法およびロボット制御装置
US20220291655A1 (en) Safe operation of a multi-axis kinematic system
US4631464A (en) Industrial robot system
JPS60108904A (ja) ロボットの軌跡異常検出装置
JPH11320477A (ja) 産業用ロボットの動作異常検出方法
KR102021227B1 (ko) 크레인의 횡행 운전 제어 장치 및 방법
JP5092267B2 (ja) モータ駆動装置およびその非常停止方法
JP4449488B2 (ja) 電動パワーステアリング装置の制御装置
JP2005176493A (ja) モータ駆動装置の非常停止方法
US20240088820A1 (en) Motor control device
Kartashev et al. Automatic safe motion control system for a robotic manipulator
JPH0424280B2 (ja)
JPH0584681A (ja) ロボツトアームの異物との衝突検出方法
JPS63241603A (ja) ロボツトの位置偏差信号の処理方法及び装置
JP4310865B2 (ja) サーボトランスファーフィーダの制御装置
JPS63229293A (ja) ロボツト動作異常検出装置