JPH0276691A - Method and device for stopping motion of industrial robot - Google Patents
Method and device for stopping motion of industrial robotInfo
- Publication number
- JPH0276691A JPH0276691A JP22687588A JP22687588A JPH0276691A JP H0276691 A JPH0276691 A JP H0276691A JP 22687588 A JP22687588 A JP 22687588A JP 22687588 A JP22687588 A JP 22687588A JP H0276691 A JPH0276691 A JP H0276691A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- industrial robot
- motion
- stop
- trajectory
- 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
Links
- 238000000034 method Methods 0.000 title claims description 15
- 230000002093 peripheral effect Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 description 7
- 230000001934 delay Effects 0.000 description 5
- 230000006378 damage Effects 0.000 description 3
- 208000027418 Wounds and injury Diseases 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 208000014674 injury Diseases 0.000 description 2
- 230000003139 buffering effect Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000005498 polishing Methods 0.000 description 1
- 230000008929 regeneration Effects 0.000 description 1
- 238000011069 regeneration method Methods 0.000 description 1
Landscapes
- Control Of Position Or Direction (AREA)
- Manipulator (AREA)
Abstract
Description
【発明の詳細な説明】
〈産業上の利用分野〉
この発明は産業用ロボットにおける動作停止方法および
その装置に関し、さらに詳細にいえば、特にロボット教
示、または計算により設定された動作を確認するための
動作点の再生中にワーク等と干渉する状態が発生した場
合等に好適に適用される動作停止方法およびその装置に
関する。[Detailed Description of the Invention] <Industrial Application Field> The present invention relates to a method and apparatus for stopping motion in an industrial robot, and more specifically, to a method for stopping motion in an industrial robot, and more specifically, for confirming motion set by robot teaching or calculation. The present invention relates to an operation stopping method and apparatus suitably applied when a state of interference with a workpiece or the like occurs during regeneration of an operating point.
〈従来の技術、および発明が解決しようとする課題〉
従来から種々の用途に産業用ロボットが適用されており
、このような産業用ロボットは処理対象ワークの位置、
形状等に最適な動作を行なわせるベく教示作業、または
計算結果入力作業が行なわれる。具体的には、予め複数
個の離散的な動作点が教示させ、または計算により設定
される。<Prior art and problems to be solved by the invention> Industrial robots have been used for various purposes in the past, and these industrial robots have been used to
A teaching operation or a calculation result input operation is performed in order to perform an operation that is optimal for the shape and the like. Specifically, a plurality of discrete operating points are taught or set in advance by calculation.
この場合には、隣合う動作点間を補間したきめ細かい多
数の点データをロボットコントローラにおいて８際時間
で自動的に補間して生成し、生成された多数の補間点デ
ータに基づいて産業ロボットが動作させられる。即ち、
必要な教示作業、または計算結果の入力作業を大巾に減
少することができる。In this case, the robot controller automatically interpolates and generates a large number of fine-grained point data by interpolating between adjacent operating points, and the industrial robot operates based on the generated large number of interpolated point data. I am made to do so. That is,
The required teaching work or calculation result input work can be greatly reduced.
しかし、上記のような教示データ、または計算結果に基
づいて実際に産業用ロボットを動作させる場合には、教
示点間の軌跡データを自動的に生成するのであるから、
ロボットハンド、ロボットアーム等とワーク、他の構造
物等との干渉が発生する可能性があるので、光、静電気
、超音波式等の非接触検出器を産業用ロボットの所定箇
所に装着しておき、非接触検出器によりワーク、他の構
造物等に対して所定距離以下にまで接近した状態を検出
して産業用ロボットに動作停止指令を与える安全装置を
組込んでおくことが望ましい。そして、干渉が発生しそ
うになった場合に、安全装置等の周辺機器からロボット
コントローラを通して動作停止指令を与えることにより
産業用ロボットの動作を停止させる。しかし、このよう
な操作を行なっても、産業用ロボットは直ちに停止する
のではなく、慣性、電気的処理の遅延等の影響を受けて
動作停止指令後ある程度の時間は産業用ロボットが動作
を継続するので、動作停止指令を与える限界距離の設定
によっては、ロボットハンド、ロボットアーム等がワー
ク、治具、または他の構造物を押圧した状態で停止して
しまう可能性がかなり高い。However, when actually operating an industrial robot based on the above teaching data or calculation results, trajectory data between teaching points is automatically generated.
There is a possibility of interference between robot hands, robot arms, etc. and workpieces, other structures, etc., so non-contact detectors such as optical, electrostatic, or ultrasonic detectors should be installed at designated locations on industrial robots. It is desirable to incorporate a safety device that uses a non-contact detector to detect when the industrial robot approaches a workpiece or other structure within a predetermined distance and issues a command to stop the operation of the industrial robot. When interference is likely to occur, the industrial robot is stopped by giving an operation stop command from a peripheral device such as a safety device through the robot controller. However, even if such an operation is performed, the industrial robot does not stop immediately, but is affected by inertia, electrical processing delays, etc., and continues to operate for a certain amount of time after the operation stop command is issued. Therefore, depending on the setting of the limit distance for issuing an operation stop command, there is a high possibility that the robot hand, robot arm, etc. will stop while pressing the workpiece, jig, or other structure.
この結果、ロボットコントローラを通して抑圧状態を解
消させるように産業用ロボットを、作業者が手動操作に
より少しだけ動作させなければならなくなるのであるが
、最終的な停止状態しかわからないのであるから、産業
用ロボットを復動させる積りであっても、このような状
態が発生したことに伴なう精神的な動揺を伴なった状態
では、誤った動作方向を指令する可能性がかなり高くな
るので、押圧力が一層大きくなってしまい、ワーク、他
の構造物等を破壊してしまうことになるという問題があ
る。また、ワークの形状、ロボットの姿勢および押圧箇
所によってはワークが産業用ロボットに追従して移動さ
せられてしまい、作業者が怪我をしてしまう可能性があ
るという問題もある。そして、非接触検出器が必要にな
る関係上、産業用ロボットが高価なものになってしまう
という問題もある。As a result, the industrial robot must be manually operated slightly by the operator to release the suppressed state through the robot controller, but since only the final stop state is known, the industrial robot Even if you intend to make a backward movement, if you are mentally disturbed due to the occurrence of such a situation, there is a high possibility that you will command the wrong direction of movement, so do not apply pressure. There is a problem in that the particles become even larger and may destroy the workpiece, other structures, etc. Furthermore, depending on the shape of the workpiece, the posture of the robot, and the pressed location, the workpiece may be moved following the industrial robot, which may cause injury to the worker. Another problem is that the industrial robot becomes expensive due to the need for a non-contact detector.
また、動作停止指令を与える限界距離を十分に大きく設
定しておくこともできるが、非接触検出器によっては接
近状態が検出できない部分がワーク、他の構造物等に接
近する場合には作業者がロボットコントローラを通して
動作停止指令を与えなければならず、慣性、電気的処理
の遅延等の影響を受けて圧接状態で停止してしまう可能
性が高くなってしまう。In addition, the limit distance for issuing an operation stop command can be set sufficiently large, but if a part of the workpiece or other structure that cannot be detected by the non-contact detector approaches the workpiece or other structure, the worker must give a command to stop the operation through the robot controller, and there is a high possibility that the robot will stop in a press-contact state due to the effects of inertia, delays in electrical processing, etc.
また、動作停止指令が与えられた場合に、産業用ロボッ
トを強制的に原点、または退避点に復帰させることも考
えられるが、どのような経路を通って復帰すると安全で
あるのかは全く不明であるから、ロボットハンド等の停
止位置、ワークの形状および抑圧箇所等によってはワー
クを引っかけてしまうことになり、ワークの破損、作業
者の怪我等が発生する可能性が高くなってしまうという
問題がある。It is also possible to force the industrial robot to return to its origin or evacuation point when a command to stop operation is given, but it is completely unclear which route is safe to return to. Therefore, depending on the stopping position of the robot hand, etc., the shape of the workpiece, and the location where it is suppressed, the workpiece may get caught, increasing the possibility of damage to the workpiece and injury to the worker. be.
さらに、通常の動作停止指令ではなく、作業者の安全の
ためのインターロック信号に起因する非常停止動作が行
なわれた場合にも、その後の復動動作指令によっては圧
接力を大きくしてしまったり、作業者に怪我をさせてし
まったりするという問題がある。〈発明の目的〉
この発明は上記の問題点に鑑みてなされたものであり、
慣性、処理の遅延等の影響を可能な限り排除して、産業
用ロボットの復帰動作を安全に行なわせることができる
ようにする産業用ロボットにおける動作停止方法および
その装置を提供することを目的としている。Furthermore, even if an emergency stop operation is performed due to an interlock signal for worker safety rather than a normal operation stop command, the pressing force may be increased depending on the subsequent double operation command. , there is a problem that workers may be injured. <Object of the invention> This invention was made in view of the above problems,
The purpose of the present invention is to provide a method and device for stopping the operation of an industrial robot, which allows the industrial robot to safely return to its original position by eliminating the effects of inertia, processing delays, etc. as much as possible. There is.
く課題を解決するための手段〉
上記の目的を達成するための、この発明の産業用ロボッ
トにおける動作停止方法は、外部の安全装置等の周辺機
器から動作停止指令が与えられたことを条件として産業
用ロボットを減速させることにより動作を停止させ、動
作停止後にそれまでの動作軌跡を逆に辿って所定の復帰
動作を行なわせた後、産業用ロボットの動作を再び停止
させる方法である。Means for Solving the Problem> In order to achieve the above object, the method for stopping the operation of an industrial robot of the present invention is based on the condition that a command to stop the operation is given from a peripheral device such as an external safety device. This is a method in which the industrial robot is decelerated to stop its operation, and after the operation is stopped, the industrial robot is made to perform a predetermined return operation by retracing its movement trajectory up to that point, and then the industrial robot is stopped again.
但し、所定の復帰動作が低速で行なわれることが好まし
い。However, it is preferable that the predetermined return operation be performed at low speed.
上記の目的を達成するための、この発明の産業用ロボッ
トにおける動作停止装置は、所定の時間内における産業
用ロボットの動作軌跡データを順次更新しながら保持す
る軌跡保持手段と、産業用ロボットが動作停止指令によ
り停止さ゛せられたことを条件として軌跡保持手段から
動作軌跡データを逆に順次読出す軌跡データ読出し手段
と、読出された軌跡データに基づいて産業用ロボットを
低速で動作させるロボット制御手段とを具備している。In order to achieve the above object, the motion stopping device for an industrial robot of the present invention includes a trajectory holding means for sequentially updating and retaining motion trajectory data of the industrial robot within a predetermined time; a trajectory data readout device that sequentially reads motion trajectory data from the trajectory holding device in reverse on the condition that the industrial robot is stopped by a stop command; and a robot control device that operates the industrial robot at a low speed based on the read trajectory data. Equipped with:
く作用〉
以上の動作停止方法であれば、外部の安全装置等の周辺
機器から動作停止指令が与えられたことを条件として産
業用ロボットを一旦停止させ、動作停止後にそれまでの
動作軌跡を逆に辿って所定の復帰動作を行なわせた後、
産業用ロボットの動作を再び停止させるので、慣性、処
理の遅延等の影響を受けて産業用ロボットが余分な動作
を行なっても、その後、往道軌跡にかなり高精度に近似
できる復動軌跡に沿って産業用ロボットを復動させるこ
とができるので、復動途中においてワーク等を引っかけ
るような不都合を確実に阻止して、最終的に非圧接状態
で産業用ロボットを停止させることができる。With the operation stop method described above, the industrial robot is temporarily stopped on the condition that the operation stop command is given from peripheral devices such as external safety devices, and after the operation is stopped, the previous operation trajectory is reversed. After performing the specified return operation according to
Since the motion of the industrial robot is stopped again, even if the industrial robot performs extra motion due to inertia, processing delays, etc., it will be able to maintain a return trajectory that can approximate the forward trajectory with a high degree of accuracy. Since the industrial robot can be moved back along the same direction, it is possible to reliably prevent inconveniences such as workpieces being caught during the backward movement, and finally the industrial robot can be stopped in a non-pressure state.
そして、所定の復帰動作が低速で行なわれる場合には、
復動軌跡に沿って動作する産業用ロボットが必要以上の
速度でに復動させられてしまうことを防止するので、復
動動作途中における安全性を高めることができる。If the predetermined return operation is performed at low speed,
Since the industrial robot operating along the backward movement trajectory is prevented from being made to move backward at a speed higher than necessary, safety during the backward movement can be improved.
上記の目的を達成するための、この発明の産業用ロボッ
トにおける動作停止装置は、産業用ロボットが動作して
いる間ずっと現在位置までの所定の時間内における産業
用ロボットの動作軌跡データを順次更新しながら軌跡保
持手段に保持させることができる。そして、産業用ロボ
ットが非常停止指令を含む動作停止指令により停止させ
られた場合に、軌跡データ読出し手段により軌跡保持手
段から動作軌跡データを逆に順次読出し、読出した軌跡
データに基づいてロボット制御手段により産業用ロボッ
トを低速で動作させるので、往道軌跡に高精度で近似さ
れる復動軌跡に沿って産業用ロボットを復動させること
ができ、復動途中においてワーク等を引っかけるような
不都合を確実に阻止して、最終的に、ワーク、他の構造
物等を圧接しない状態で産業用ロボットを停止させるこ
とができる。In order to achieve the above object, the motion stopping device for an industrial robot of the present invention sequentially updates the motion trajectory data of the industrial robot within a predetermined time period while the industrial robot is operating. The trajectory can be held by the trajectory holding means. When the industrial robot is stopped by a motion stop command including an emergency stop command, the motion trajectory data is sequentially read out from the trajectory holding device by the trajectory data reading device, and the robot control device uses the trajectory data read out based on the trajectory data read out. Since the industrial robot is operated at a low speed, the industrial robot can be moved backward along a backward movement trajectory that is highly accurate to the forward movement trajectory, thereby avoiding the inconvenience of catching workpieces, etc. during the backward movement. It is possible to reliably prevent the industrial robot from coming into contact with the workpiece, other structures, etc., and finally stop the industrial robot.
〈実施例〉 以下、実施例を示す添付図面によって詳細に説明する。<Example> Hereinafter, embodiments will be described in detail with reference to the accompanying drawings showing examples.
第１図はこの発明の動作停止方法を採用した産業用ロボ
ットの動作を説明するフローチャートである。FIG. 1 is a flowchart illustrating the operation of an industrial robot that employs the operation stop method of the present invention.
先ず、ステップ■において産業用ロボットを動作させる
ために必要なアーム長、ギア比、原点位置等のパラメー
タを初期設定した後、通常処理ループに入る。そして、
ステップ■において外部からの動作停止要求があったか
否かを判別し、動作停止要求がなかった場合には、ステ
ッ゛ブ■において通常のロボット動作処理を行ない、ス
テップ■において往動軌跡データをバッファリングした
後、再びステップ■の判別を行なう。First, in step (2), parameters such as arm length, gear ratio, origin position, etc. necessary for operating the industrial robot are initialized, and then a normal processing loop is entered. and,
In step (■), it is determined whether there is an external motion stop request. If there is no motion stop request, normal robot motion processing is performed in step (2), and forward movement trajectory data is buffered in step (2). After that, the determination in step (2) is performed again.
上記ステップ■において動作停止要求があったと判別さ
れた場合には、ステップ■において非常停止であるか否
かを判別し、通常の外部からの動作停止要求であると判
別されれば、ステップ■において、ロボットアームを駆
動するためのサーボ系における最大減速定数で減速動作
を行なわせ、産業用ロボットを停止させる。そして、ス
テップ■において、この時点までにバッファリングされ
ている往動軌道データを逆の順番に読出し、予め設定さ
れている個数の最新の往動軌跡データに基づく復動動作
を低速で行なわせる。逆に、ステップ■において非常停
止であると判別された場合には１、ステップ■において
エラーコードに基づいて故障か否かを判別し、故障でな
いと判別された場合には、ステップ■において復帰入力
があるまで待って、ステップ［相］において動力系の電
源を投入するとともに、制動状態を解除し、その後、ス
テップ■の処理を行なう。上記ステップ■において故障
であると判別された場合には、ステップ■において全て
の電源を遮断し、その後、故障箇所の修理が行なわれる
。If it is determined in the above step (■) that there is an operation stop request, it is determined in step (2) whether or not it is an emergency stop, and if it is determined that it is a normal operation stop request from the outside, in step (2), , the servo system for driving the robot arm performs a deceleration operation using the maximum deceleration constant to stop the industrial robot. Then, in step (3), the forward motion trajectory data buffered up to this point is read out in reverse order, and a backward motion based on a preset number of latest forward motion trajectory data is performed at low speed. Conversely, if it is determined in step ■ that it is an emergency stop, step ■ determines whether or not there is a failure based on the error code, and if it is determined that there is no failure, a return input is performed in step ■. Wait until the time is reached, turn on the power to the power system in step [phase], release the braking state, and then perform the process of step (2). If it is determined that there is a failure in step (2) above, all power supplies are shut off in step (2), and then the failure location is repaired.
また、ステップ■の処理を行なった後は、再びステップ
■の判別を行なう。Further, after performing the process in step (2), the determination in step (2) is performed again.
したがって、何ら停止要求がない状態では、予め設定さ
れた時間間隔で往動軌跡データをバッファリングしなが
ら所定のロボット動作を行なわせることができる。Therefore, when there is no stop request, the robot can perform a predetermined robot operation while buffering forward locus data at preset time intervals.
また、通常の外部からの動作停止指令が与えられた場合
には、通常の制動動作を行なって産業用ロボットを停止
させた後、バッファリングされている往動軌跡データを
逆に順次読出して産業用ロボットを動作させることによ
り、往動軌跡にほぼ沿う状態で産業用ロボットを復動さ
せ、仮にワーク等を押圧する状態で産業用ロボットが停
止していても、ワーク等から離れた状態にすることがで
きる。In addition, when a normal operation stop command is given from the outside, the industrial robot is stopped by performing a normal braking operation, and then the buffered forward trajectory data is read in reverse order and the industrial robot is stopped. By operating the industrial robot, the industrial robot moves back almost along the forward movement trajectory, and even if the industrial robot is stopped while pressing the workpiece, it will be able to move away from the workpiece, etc. be able to.
さらに、産業用ロボット自体の故障等に起因する非常停
止指令が与えられた場合には、動力系の電源遮断および
メカニカルブレーキの併用により産業用ロボットが停止
させられるのであり、そのままで復動させることはでき
ないのであるから、全ての電源を遮断した状態で故障原
因等を解明し、修理した後においてのみ動作するのであ
り、この機能に起因して事故が増長されるという不都合
は全くない。Furthermore, if an emergency stop command is given due to a failure of the industrial robot itself, the industrial robot will be stopped by cutting off the power to the power system and applying the mechanical brake, and will not be able to return to its original position. Since it is not possible to do so, it will only work after the cause of the failure is determined and repaired with all power supplies shut off, and there is no inconvenience that accidents will increase due to this function.
また、慣性等に起因する制御停止から実際にロボットが
停止するまでの時間が最大２０ ｍ５ｅｃ程度であるこ
とを考慮すれば、往動軌跡と復動軌跡とのずれは余り大
きくなく、復動時の速度を低速にすることにより慣性等
の影響を無視することができる。Furthermore, considering that the time from a controlled stop due to inertia etc. to when the robot actually stops is at most 20 m5ec, the deviation between the forward movement trajectory and the backward movement trajectory is not very large, and the By slowing down the speed, the effects of inertia etc. can be ignored.
第２図はこの発明の動作停止装置の一実施例を組込んだ
産業用ロボットの構成を示すブロック図である。FIG. 2 is a block diagram showing the configuration of an industrial robot incorporating an embodiment of the operation stop device of the present invention.
図示しないティーチペンダント等から教示入力された動
作点データ、または計算により設定入力された動作点デ
ータを保持する動作点データメモリ（１）と、動作点デ
ータに基づいて多数の往動軌跡データを順次生成する軌
跡データ生成部（２）と、順次生成される軌跡データが
供給されることにより所期のロボット動作を行なわせる
ロボット制御部（３）と、通常のロボット動作を行ない
ながら所定時間間隔毎に往動軌跡データが書込まれるＬ
ＩＦＯメモリ（４）と、ＬＩＦＯメモリ（４）からデー
タを読出してロボット制御部（３）に供給する復動制御
部（５）とを有している。An operating point data memory (1) that holds operating point data taught from a teach pendant, etc. (not shown) or operating point data set and input by calculation, and sequentially stores a large number of forward locus data based on the operating point data. a robot controller (3) that performs the desired robot motion by being supplied with the sequentially generated trajectory data; The forward locus data is written to L
It has an IFO memory (4) and a double-motion control section (5) that reads data from the LIFO memory (4) and supplies it to the robot control section (3).
上記ロボット制御部（３）は、軌跡データが供給されて
いる場合に、軌跡データに基づくロボット動作を行なわ
せるとともに、軌跡データが供給されない場合に制動動
作を行なわせるものである。The robot control section (3) causes the robot to perform a robot operation based on the trajectory data when the trajectory data is supplied, and causes the robot to perform a braking operation when the trajectory data is not supplied.
上記ＬＩＦＯメモリ（４）は、軌跡データ生成部（２）
において順次生成された往動軌跡データが書込まれるも
のであり、最新の往動軌跡データから順に所定個数の往
動軌跡データが生成順に格納されている。そして、読出
し指令が与えられた場合に、最新の往動軌跡データから
順に読出される。尚、データ読出し速度は、軌跡データ
生成部（２）におけるデータ生成速度よりも遅く設定し
である。The LIFO memory (4) is a trajectory data generator (2)
The forward movement trajectory data sequentially generated in is written, and a predetermined number of forward movement trajectory data are stored in the order of generation starting from the latest forward movement trajectory data. Then, when a read command is given, the forward movement trajectory data is read out in order starting from the latest one. Note that the data read speed is set to be slower than the data generation speed in the trajectory data generation section (2).
上記復動制御部（５）は、通常の停止指令が与えられ、
かつロボットが完全に停止したことを条件としてＬＩＦ
Ｏメモリ（４）に読出し指令を与える第１制御部（５１
）と、非常停止指令が与えられた後、復帰入力が与えら
れたことを条件としてＬＩＦＯメモリ（４）に読出し指
令を与える第２制御部（５２）と、動作停止指令が与え
られたことを条件として軌跡データ生成部（２の動作を
停止させる第３制御部（５３）とを有している。The double-acting control unit (5) is given a normal stop command,
and LIF on the condition that the robot has completely stopped.
A first control section (51) that gives a read command to the O memory (4).
), a second control unit (52) that issues a read command to the LIFO memory (4) on the condition that a return input is given after the emergency stop command is given, and a second control unit (52) that issues a read command to the LIFO memory (4) on the condition that a return input is given after the emergency stop command is given; As a condition, it has a third control section (53) that stops the operation of the trajectory data generation section (2).
上記の構成の産業用ロボットの動作は次のとおりである
。The operation of the industrial robot having the above configuration is as follows.
何ら動作停止指令が与えられていない状態においては、
軌跡データ生成部（２が動作して順次往動軌跡データを
生成し、ロボット制御部（３）に供給するので、教示デ
ータに基づくロボット動作を行なうことができる。In a state where no operation stop command is given,
Since the trajectory data generation section (2) operates to sequentially generate forward trajectory data and supply it to the robot control section (3), the robot can operate based on the teaching data.
そして、ロボット動作の途中において産業用ロボットを
停止させる必要が生じた場合には、ロボットコントロー
ラ（図示せず）を通して通常の動作停止指令を与えれば
よく、第３制御部（５３）により軌跡データ生成部（２
）を停止させることができるので、ロボット制御部（３
）により所定の制動動作が行なわれる。制動動作を行な
った結果、産業用ロボットが停止すれば、第１制御部（
５１）によりＬＩＦＯメモリ（４）からのデータ読出し
が行なわせられるとともに、データ読出し速度が低速に
設定されているのであるから、ロボット制御部（３）に
より産業用ロボットが逆方向に、かつ低速に動作させら
れる。したがって、慣性等の影響を受けてロボットハン
ド等がワーク等に押圧させられた状態で一旦停止しても
、その後、逆方向に動作させられることにより、抑圧状
態を確実に解除することができる。If it becomes necessary to stop the industrial robot during robot operation, a normal operation stop command can be given through the robot controller (not shown), and the third control section (53) generates trajectory data. Part (2
) can be stopped, the robot control unit (3) can be stopped.
), a predetermined braking operation is performed. If the industrial robot stops as a result of the braking operation, the first control unit (
51) causes data to be read from the LIFO memory (4), and since the data read speed is set to low speed, the robot control unit (3) causes the industrial robot to move in the opposite direction and at a low speed. be made to work. Therefore, even if the robot hand or the like is temporarily stopped while being pressed against a workpiece or the like due to the influence of inertia or the like, the suppressed state can be reliably released by moving the robot hand in the opposite direction.
また、産業用ロボット自体に故障が発生した場合には、
自動的に非常停止指令が与えられるので、図示しない非
常停止制御部により動力系の電源遮断およびメカニカル
ブレーキによる制動が行なわれ、産業用ロボットを可能
な限り迅速に停止させることができる。即ち、この状態
では動力系の電源が、遮断されているのでそのまま停止
状態が持続させられるため、こ・の機能に起因して事故
が増長されるという不都合は全くない。In addition, if a failure occurs in the industrial robot itself,
Since an emergency stop command is automatically given, an emergency stop control section (not shown) cuts off the power to the power system and applies braking using a mechanical brake, making it possible to stop the industrial robot as quickly as possible. That is, in this state, the power to the power system is cut off and the stopped state is maintained, so there is no inconvenience that accidents will increase due to this function.
上記の実施例においては、産業用ロボットの用途につい
て何ら説明していないが、部品組付け、切削加工、研磨
加工等種々の用途に適用することができる。In the above embodiments, no explanation is given regarding the use of the industrial robot, but the invention can be applied to various uses such as parts assembly, cutting, polishing, etc.
尚、この発明は上記の実施例に限定されるものではなく
、例えば、復帰時の動作速度を停止指令が与えられてい
ない状態の動作速度と等しく設定することが可能である
ほか、復動させるべき往動軌跡データの数を適宜設定す
ることが可能であり、その他、この発明の要旨を変更し
ない範囲内において種々の設計変更を施すことが可能で
ある。Note that the present invention is not limited to the above-described embodiments; for example, it is possible to set the operating speed at the time of return to be equal to the operating speed in a state where no stop command is given, and it is also possible to set the operating speed at the time of return to be equal to the operating speed in a state where no stop command is given, The number of forward movement locus data can be set as appropriate, and various other design changes can be made without changing the gist of the invention.
〈発明の効果〉
以上のように第１の発明は、慣性、処理の遅延等の影響
を受けて産業用ロボットが余分な動作を行なっても、そ
の後、往道軌跡にかなり高精度に近似できる復動軌跡に
沿って産業用ロボットを復動させるので、復動途中にお
いてワーク等を引っかけるような不都合を確実に阻止し
て、最終的に非圧接状態で産業用ロボットを停止させる
ことができ、安全性を著しく向上させることができると
いう特有の効果を奏する。<Effects of the Invention> As described above, in the first invention, even if the industrial robot performs extra movements due to inertia, processing delays, etc., it is possible to approximate the forward trajectory with a fairly high degree of accuracy. Since the industrial robot moves backward along the backward movement trajectory, it is possible to reliably prevent inconveniences such as workpieces being caught during the backward movement, and finally the industrial robot can be stopped in a non-pressure state. It has the unique effect of significantly improving safety.
第２の発明は、復動軌跡に沿って動作する産業用ロボッ
トが復動動作する場合に低速で動作するため、復動動作
途中における安全性を一層高めることができるという特
有の効果を奏する。The second aspect of the invention has the unique effect of further increasing safety during the backward movement, since the industrial robot that operates along the backward movement trajectory operates at a low speed when performing the backward movement.
第３の発明は、往道軌跡に高精度で近似される復動軌跡
に沿って産業用ロボットを復動させることができ、復動
途中においてワーク等を引っかけるような不都合を確実
に阻止して、最終的に、ワ一り、他の構造物等を圧接し
ない状態で産業用ロボットを停止させることができ、安
全性を著しく向上させることができるという特有の効果
を奏する。The third invention is capable of making an industrial robot move back along a backward movement trajectory that is highly accurately approximated to the forward movement trajectory, and reliably prevents inconveniences such as catching workpieces etc. during the backward movement. Finally, the industrial robot can be stopped without pressing against other structures, etc., and safety can be significantly improved, which is a unique effect.
第１図はこの発明の動作停止方法を採用した産業用ロボ
ットの動作を説明するフローチャート、第２図はこの発
明の動作停止装置の一実施例を組込んだ産業用ロボット
の構成を示すブロック囲み（３）・・・ロボット制御部
、（４）・・・ＬＩＦＯメモリ、（５）・・・復動制御
部、（５１）・・・第１制御部、（５２）・・・第２制
御部、（５３）・・・第３制御部特許出願人 ダイキ
ン工業株式会社FIG. 1 is a flowchart explaining the operation of an industrial robot adopting the operation stopping method of the present invention, and FIG. 2 is a block diagram showing the configuration of an industrial robot incorporating an embodiment of the operation stopping device of the present invention. (3)...Robot control unit, (4)...LIFO memory, (5)...Return control unit, (51)...First control unit, (52)...Second control Department, (53)...Third Control Department Patent Applicant Daikin Industries, Ltd.
Claims (1)
を条件として産業用ロボットを減速させることにより動
作を停止させ、動作停止後にそれまでの動作軌跡を逆に
辿って所定の復帰動作を行なわせた後、産業用ロボット
の動作を再び停止させることを特徴とする産業用ロボッ
トにおける動作停止方法。 ２、所定の復帰動作が低速で行なわれる上記特許請求の
範囲第１項記載の産業用ロボットにおける動作停止方法
。 ３、所定の時間内における産業用ロボットの動作軌跡デ
ータを順次更新しながら保持する軌跡保持手段（４）と
、産業用ロボットが動作停止指令により停止させられた
ことを条件として軌跡保持手段（４）から動作軌跡デー
タを逆に順次読出す軌跡データ読出し手段（５）（５１
）（５２）（５３）と、読出された軌跡データに基づい
て産業用ロボットを低速で動作させるロボット制御手段
（３）とを具備していることを特徴とする産業用ロボッ
トにおける動作停止装置。[Claims] 1. On the condition that an operation stop command is given from an external peripheral device, the industrial robot is decelerated to stop its operation, and after the operation is stopped, the operation trajectory up to that point is reversely traced. A method for stopping an industrial robot, the method comprising: stopping the industrial robot again after performing a predetermined return action. 2. A method for stopping an operation in an industrial robot according to claim 1, wherein the predetermined return operation is performed at low speed. 3. Trajectory holding means (4) for sequentially updating and holding the motion trajectory data of the industrial robot within a predetermined time; ) Trajectory data reading means (5) (51) for sequentially reading out motion trajectory data from
) (52) (53); and robot control means (3) for operating the industrial robot at low speed based on the read trajectory data.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP22687588A JPH0276691A (en) | 1988-09-09 | 1988-09-09 | Method and device for stopping motion of industrial robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP22687588A JPH0276691A (en) | 1988-09-09 | 1988-09-09 | Method and device for stopping motion of industrial robot |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPH0276691A true JPH0276691A (en) | 1990-03-16 |
Family
ID=16851945
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP22687588A Pending JPH0276691A (en) | 1988-09-09 | 1988-09-09 | Method and device for stopping motion of industrial robot |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPH0276691A (en) |
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO1997000760A1 (en) * | 1995-05-09 | 1997-01-09 | Tetsuya Kosaka | Control system for operations of a robot |
| JP2008254141A (en) * | 2007-04-06 | 2008-10-23 | Mitsubishi Electric Corp | Apparatus and method of controlling robot, and robot conveyor |
| CN103433925A (en) * | 2013-07-31 | 2013-12-11 | 北京配天大富精密机械有限公司 | Method for returning robot to starting point, robot running method, robot and robot control device |
| JP2014018901A (en) * | 2012-07-17 | 2014-02-03 | Daihen Corp | Control device and control method |
| CN104827471A (en) * | 2014-02-12 | 2015-08-12 | 库卡罗伯特有限公司 | Method and device for fixing manipulator axle |
| DE102015012230A1 (en) | 2014-09-25 | 2016-03-31 | Fanuc Corporation | Robot controller |
| CN109719702A (en) * | 2017-10-31 | 2019-05-07 | 株式会社安川电机 | The back-off method of robot system, robot controller and robot |
| WO2020026457A1 (en) * | 2018-07-30 | 2020-02-06 | 株式会社ダイアディックシステムズ | Robot control system, robot control method, and program |
| WO2021064331A1 (en) * | 2019-10-04 | 2021-04-08 | Collin | Robotic surgical intervention device with controlled articulated arm for tracing a path |
-
1988
- 1988-09-09 JP JP22687588A patent/JPH0276691A/en active Pending
Cited By (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5912540A (en) * | 1995-05-09 | 1999-06-15 | Fanuc, Ltd. | Robot control system which enables safe robot operation and simple recovery when undesired movements are detected |
| WO1997000760A1 (en) * | 1995-05-09 | 1997-01-09 | Tetsuya Kosaka | Control system for operations of a robot |
| JP2008254141A (en) * | 2007-04-06 | 2008-10-23 | Mitsubishi Electric Corp | Apparatus and method of controlling robot, and robot conveyor |
| JP2014018901A (en) * | 2012-07-17 | 2014-02-03 | Daihen Corp | Control device and control method |
| CN103433925B (en) * | 2013-07-31 | 2018-05-15 | 北京配天技术有限公司 | Robot returns to method, operation method, robot and the control device of starting point |
| CN103433925A (en) * | 2013-07-31 | 2013-12-11 | 北京配天大富精密机械有限公司 | Method for returning robot to starting point, robot running method, robot and robot control device |
| CN104827471A (en) * | 2014-02-12 | 2015-08-12 | 库卡罗伯特有限公司 | Method and device for fixing manipulator axle |
| US9415515B2 (en) | 2014-02-12 | 2016-08-16 | Kuka Roboter Gmbh | Method and apparatus for fixing a manipulator axis |
| DE102015012230A1 (en) | 2014-09-25 | 2016-03-31 | Fanuc Corporation | Robot controller |
| CN109719702A (en) * | 2017-10-31 | 2019-05-07 | 株式会社安川电机 | The back-off method of robot system, robot controller and robot |
| JP2019081234A (en) * | 2017-10-31 | 2019-05-30 | 株式会社安川電機 | Robot system, robot controller, and method for retracting robot |
| US11192244B2 (en) | 2017-10-31 | 2021-12-07 | Kabushiki Kaisha Yaskawa Denki | Robot system, robot controller, and method for withdrawing robot |
| CN109719702B (en) * | 2017-10-31 | 2022-05-31 | 株式会社安川电机 | Robot system, robot controller, and robot retreat method |
| WO2020026457A1 (en) * | 2018-07-30 | 2020-02-06 | 株式会社ダイアディックシステムズ | Robot control system, robot control method, and program |
| JPWO2020026457A1 (en) * | 2018-07-30 | 2021-10-21 | 株式会社ダイアディックシステムズ | Robot control systems, robot control methods, and programs |
| WO2021064331A1 (en) * | 2019-10-04 | 2021-04-08 | Collin | Robotic surgical intervention device with controlled articulated arm for tracing a path |
| FR3101532A1 (en) * | 2019-10-04 | 2021-04-09 | Collin | Robotic operating device with articulated arm controlled for tracking a path |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3288250B2 (en) | Robot controller | |
| JP2020516475A (en) | Teaching Mode Collision Avoidance System and Method for Industrial Robot Manipulators | |
| US5204598A (en) | Method and apparatus for stopping an industrial robot | |
| KR102418451B1 (en) | Robot control system | |
| JPS60160409A (en) | Safety method of robot system | |
| JPWO2009072383A1 (en) | Robot operation restriction method, robot system, and robot action restriction device | |
| JPH0276691A (en) | Method and device for stopping motion of industrial robot | |
| KR0160998B1 (en) | Robot trajectory planning method | |
| JP3632268B2 (en) | Robot direct teaching device | |
| JP4055090B2 (en) | Robot control device | |
| JPH07299777A (en) | Transport robot controlling method | |
| JP3421442B2 (en) | Robot position teaching method and robot control device | |
| JPH10180663A (en) | Controller for robot arm | |
| JPH06190753A (en) | Robot control device | |
| JP2786874B2 (en) | Movable position control device | |
| KR960012702B1 (en) | Play back robot | |
| JP2002052485A (en) | Control device for robot | |
| JP2003136466A (en) | Control device of industrial robot | |
| JPH0639760A (en) | Control device for robot | |
| JP3327205B2 (en) | Robot control method and device | |
| JPH06335883A (en) | Robot controller | |
| JP4098748B2 (en) | Numerical control device having function of outputting emergency stop command | |
| JP2689420B2 (en) | Robot control method | |
| JPH0584681A (en) | Method for detecting collision of robot arm against foreign matter | |
| JPH0712545B2 (en) | Wrist control method for industrial robots |