JP2013071234A - Robot stopping method and robot system - Google Patents

Robot stopping method and robot system Download PDF

Info

Publication number
JP2013071234A
JP2013071234A JP2011214511A JP2011214511A JP2013071234A JP 2013071234 A JP2013071234 A JP 2013071234A JP 2011214511 A JP2011214511 A JP 2011214511A JP 2011214511 A JP2011214511 A JP 2011214511A JP 2013071234 A JP2013071234 A JP 2013071234A
Authority
JP
Japan
Prior art keywords
robot
robots
stopped
speed
stop
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.)
Withdrawn
Application number
JP2011214511A
Other languages
Japanese (ja)
Inventor
Takashi Masuyama
貴史 桝山
Tomoya Yamamoto
智哉 山本
Jun Araki
純 荒木
Shigenori Kozuka
重徳 小塚
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.)
Denso Wave Inc
Original Assignee
Denso Wave Inc
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 Denso Wave Inc filed Critical Denso Wave Inc
Priority to JP2011214511A priority Critical patent/JP2013071234A/en
Publication of JP2013071234A publication Critical patent/JP2013071234A/en
Withdrawn legal-status Critical Current

Links

Images

Abstract

PROBLEM TO BE SOLVED: To discriminate which robot should be actually stopped among a plurality of robots.SOLUTION: When a teaching device 7 of a control device 6 for controlling a plurality of robots 2-5 is operated to select one robot, the moving speed of the selected robot decreases (notification action). The notification action allows the discrimination of a selected robot. By operating the teaching device 7 in the case that the robot that has performed notification action is stopped, the robot is stopped. In the case that the robot that has performed notification action is different from a robot that should be stopped, the teaching device 7 is kept not to be operated. Then, the other robot decelerates and the time of the completion of work operation becomes the same as the robot that should be stopped.

Description

本発明は、複数台のロボットのうちから1台のロボットを選択して停止させる場合のロボットの停止方法およびロボットシステムに関する。   The present invention relates to a robot stopping method and a robot system when one robot is selected from a plurality of robots and stopped.

製造ラインに沿って複数台のロボットを設置し、これらロボットに組み立て作業などを行わせるシステムがある。このロボットシステムにおいて、例えば、調子の悪いロボットを発見したような場合、そのロボットを停止させて点検修理を行う必要がある。
複数台のロボットが1台の制御装置によって一括制御されている場合、複数台のロボットのうちから或る特定のロボットを停止させるには、制御装置に接続された教示装置により停止させたいロボットを選択して停止操作する。
There is a system in which a plurality of robots are installed along a production line and these robots perform assembly work. In this robot system, for example, when a bad robot is found, it is necessary to stop the robot for inspection and repair.
When a plurality of robots are collectively controlled by a single control device, in order to stop a specific robot from the plurality of robots, the robot to be stopped by the teaching device connected to the control device is selected. Select and stop.

本発明とは直接の関係はないが、特許文献1には、ロボットアームに表示器を取り付け、教示装置によってロボットアームを動かす際に、表示器によって移動方向を表示し、これによってロボットアームの動作方向を事前に確認できるようにすることが記載されている。   Although there is no direct relationship with the present invention, in Patent Document 1, a display unit is attached to a robot arm, and when the robot arm is moved by the teaching device, the moving direction is displayed by the display unit. It is described that the direction can be confirmed in advance.

特開2008−878号公報JP 2008-878 A

教示装置で特定のロボットを選択するには、そのロボットが制御装置上で何番のロボットであるかを知らないと、間違えて他のロボットを停止させてしまう恐れがある。しかし、何番のロボットかをユーザーの記憶に頼ることは間違いの原因になり、好ましくない。かといって、動作中のロボットに近寄って何番かをユーザー自身で確認することは、ロボットと衝突の恐れがあって危険である。   In order to select a specific robot by the teaching device, if the robot is not known on the control device, the robot may be mistakenly stopped. However, relying on the user's memory for the robot number is the cause of mistakes and is undesirable. However, it is dangerous to come close to the operating robot and confirm the number by the user because there is a risk of collision with the robot.

特許文献1に開示された技術を応用してロボットに表示器を設け、教示装置によって1台のロボットを選択すると、その選択されたロボットの表示器が選択されたことを表示するように構成することが考えられる。しかし、ロボットの姿勢や設備環境によっては制御装置が置かれた位置からロボットの表示器が見えない場合があり、事前確認手段としては好ましいものではない。   By applying the technique disclosed in Patent Document 1, a robot is provided with a display, and when one robot is selected by the teaching device, it is configured to display that the display of the selected robot is selected. It is possible. However, depending on the posture of the robot and the equipment environment, the robot display may not be visible from the position where the control device is placed, which is not preferable as a prior confirmation means.

本発明は上記の事情に鑑みてなされたもので、その目的は、選択したロボットが実際にどのロボットであるかを、ロボットの姿勢や設備環境のいかんにかかわらず識別できるロボットの停止方法およびロボットシステムを提供することにある。   The present invention has been made in view of the above circumstances, and an object of the present invention is to provide a robot stopping method and a robot that can identify which robot is actually selected regardless of the posture of the robot or the equipment environment. To provide a system.

本発明によれば、選択手段により1台のロボットを選択すると、選択されたロボットが速度を減少、例えば加速途中にあるロボットの加速度が減小し、或いは等速移動していたロボットの移動速度が減速するので、この速度減少(告知動作)によって選択されたロボットがどれであるかを知ることができる。   According to the present invention, when one robot is selected by the selection means, the speed of the selected robot decreases, for example, the acceleration of the robot in the middle of acceleration decreases, or the moving speed of the robot moving at a constant speed Therefore, it is possible to know which robot is selected by this speed reduction (notification operation).

そして、ユーザーが停止させたいと思っていたロボットと、告知動作したロボットとが一致した場合、ユーザーはそのロボットを停止させる操作を行う。ユーザーが停止させたいと思っていたロボットが告知動作したロボットでなかった場合、ユーザーは停止操作をしない。すると、先に告知動作したロボットを除く他のロボットが減速し、先に告知動作したロボットと同じ時期に作業動作を終了するようになる。これにより、複数のロボットの動作関係が元通りとなり、以後の、全てのロボットは、次の作業動作を同時期に開始するようになる。   When the robot that the user wanted to stop coincides with the robot that performed the notification operation, the user performs an operation to stop the robot. If the robot that the user wanted to stop is not the robot that performed the notification operation, the user does not perform the stop operation. Then, the robots other than the robot that performed the notification operation first decelerate, and the work operation ends at the same time as the robot that performed the notification operation first. As a result, the operation relationship of the plurality of robots is restored, and all the subsequent robots start the next work operation at the same time.

本発明の一実施形態における告知動作と復旧動作の一例を示すもので、(a)は停止対象ロボットの速度パターン図、(b)は他のロボットの速度パターン図1 shows an example of a notification operation and a recovery operation in an embodiment of the present invention, where (a) is a velocity pattern diagram of a robot to be stopped, and (b) is a velocity pattern diagram of another robot. 告知動作と復旧動作の他の例を示すもので、(a)は停止対象ロボットの速度パターン図、(b)は他のロボットの速度パターン図It shows another example of the notification operation and the recovery operation, (a) is a speed pattern diagram of the robot to be stopped, (b) is a speed pattern diagram of the other robot 主制御の内容を示すフローチャートFlow chart showing the contents of main control 停止指示対応ルーチンの内容を示すフローチャートFlow chart showing the contents of the stop instruction corresponding routine 告知動作準備ルーチンの内容を示すフローチャートFlow chart showing the contents of the notification operation preparation routine 復旧動作準備ルーチンの内容を示すフローチャートFlow chart showing contents of recovery operation preparation routine 一般的な台形速度パターン図Typical trapezoidal speed pattern diagram 作業サイクルの内容を示す速度パターン図Speed pattern diagram showing the contents of the work cycle 制御装置の電気的構成を示すブロック図Block diagram showing electrical configuration of control device 2台のロボットの共有範囲を示す模式図Schematic diagram showing the shared range of two robots ロボットシステムを示す概略図Schematic diagram showing the robot system ロボットシステムの電気的接続関係を示すブロック図Block diagram showing the electrical connection of the robot system

以下、本発明の一実施形態を図面により説明する。本実施形態におけるロボットシステムは、図11および図12に示すように、製品を搬送するコンベア(製造ライン)1の両側に設置された複数台、この実施形態では4台のロボット2〜5と、これらロボット2〜5を一括して制御する制御装置6と、制御装置6に接続された操作装置としての教示装置7とから構成されている。なお、各ロボット2〜5を区別する場合には、第1〜第4の順番号を付して説明する。   Hereinafter, an embodiment of the present invention will be described with reference to the drawings. As shown in FIGS. 11 and 12, the robot system in this embodiment includes a plurality of units installed on both sides of a conveyor (production line) 1 that conveys products, in this embodiment, four robots 2 to 5, The control device 6 controls the robots 2 to 5 collectively and a teaching device 7 as an operation device connected to the control device 6. In addition, when distinguishing each robot 2-5, it attaches and demonstrates 1st-4th order number.

ロボット2〜5は、いずれも6軸の垂直多関節型ロボットとして構成されている。これらロボット2〜5は、ロボットアーム先端に、ワークを把持するハンドなどのエンドエフェクタ(図示せず)が取り付けられている。そして、各ロボット2〜5は、コンベア1が1ピッチ間欠的に送られる都度、自動供給装置8から定位置に供給される部品を把持してコンベア1上に搬送し、製品に組み付けるという作業を行う。   The robots 2 to 5 are all configured as 6-axis vertical articulated robots. In these robots 2 to 5, an end effector (not shown) such as a hand for gripping a workpiece is attached to the tip of the robot arm. Then, each time the conveyor 1 is intermittently sent by 1 pitch, each robot 2 to 5 grips the parts supplied from the automatic supply device 8 to a fixed position, conveys them onto the conveyor 1 and assembles them to the product. Do.

教示装置7は主としてロボット2〜5を手動で操作する際に使用する。この教示装置7には、各種スイッチ11、表示器(表示手段)12が設けられている。上記スイッチ11には、教示モード、自動動作モードなどのモード選択を行うためのモード選択スイッチ、4台のロボット2〜5のうちから所望する1台のロボットを選択するためのロボット選択スイッチ(選択手段)、教示モード時にロボットアームを動かすための動作指示スイッチ、自動動作モードのとき選択したロボットを停止させるための停止スイッチ(停止指示手段)などが含まれている。そのうち、図12には、ロボット選択スイッチを符号11aで、停止スイッチを符号11bで示した。   The teaching device 7 is mainly used when manually operating the robots 2 to 5. The teaching device 7 is provided with various switches 11 and a display (display means) 12. The switch 11 includes a mode selection switch for selecting a mode such as a teaching mode and an automatic operation mode, and a robot selection switch (selection) for selecting one desired robot from the four robots 2 to 5. Means), an operation instruction switch for moving the robot arm in the teaching mode, a stop switch (stop instruction means) for stopping the selected robot in the automatic operation mode, and the like. In FIG. 12, the robot selection switch is indicated by reference numeral 11a, and the stop switch is indicated by reference numeral 11b.

次に、制御装置6の構成を示す図9において、各ロボット2〜5は、アームを駆動するための6台のモータ13を有し、各モータ13には、当該モータ13の回転位置を検出して制御装置6に出力するロータリーエンコーダ14が連結されている。なお、図9では、制御装置6と1台のロボットとの関係を示し、また、1台のロボットにおいてもモータ13は1台のみ示した。   Next, in FIG. 9 showing the configuration of the control device 6, each robot 2 to 5 has six motors 13 for driving the arms, and each motor 13 detects the rotational position of the motor 13. Thus, a rotary encoder 14 that outputs to the control device 6 is connected. FIG. 9 shows the relationship between the control device 6 and one robot, and only one motor 13 is shown in one robot.

制御装置6は、CPU15、記憶手段としてのROM16およびRAM17を備える他、モータ13の駆動回路18およびロータリーエンコーダ14からの回転位置検出信号によりロボットの各アームの回転位置を検出する位置検出回路19を備えている。ROM16には、ロボット2〜5を教示装置7により作成された動作プログラムに従って自動動作させるための制御プログラム、自動動作中のロボット2〜5を教示装置7からの指示によって停止させる際の制御プログラム、ロボット2〜5の速度制御や位置制御の際に用いられる各種のデータなどが記憶されている。また、RAM17には、教示装置7により作成された動作プログラムなどが記憶される。   The control device 6 includes a CPU 15, a ROM 16 and a RAM 17 as storage means, and a position detection circuit 19 that detects the rotation position of each arm of the robot by a rotation position detection signal from the drive circuit 18 of the motor 13 and the rotary encoder 14. I have. The ROM 16 has a control program for automatically operating the robots 2 to 5 in accordance with the operation program created by the teaching device 7, a control program for stopping the robots 2 to 5 that are operating automatically according to instructions from the teaching device 7, Various data used for speed control and position control of the robots 2 to 5 are stored. The RAM 17 stores an operation program created by the teaching device 7.

CPU15は、RAM17に記憶された動作プログラムから移動軌跡を演算し、ロボットアーム先端がこの軌跡に沿って移動するように当該ロボットアーム先端の位置と速度を制御する。
具体的には、GPU15は、ロボットアーム先端の移動速度を速度パターン、例えば台形速度パターンに当て嵌めて決定する。この場合、台形速度パターンは、図7に示すように、加速域、等速域、減速域からなるが、加速域における加速度+α、等速域における速度V、減速域における減速度−αは動作プログラムに記録されたパラメータから決定される。
The CPU 15 calculates a movement trajectory from the operation program stored in the RAM 17 and controls the position and speed of the robot arm tip so that the robot arm tip moves along the trajectory.
Specifically, the GPU 15 determines the moving speed of the tip of the robot arm by applying it to a speed pattern, for example, a trapezoidal speed pattern. In this case, as shown in FIG. 7, the trapezoidal velocity pattern is composed of an acceleration region, a constant velocity region, and a deceleration region. The acceleration + α in the acceleration region, the speed V in the constant velocity region, and the deceleration −α in the deceleration region are operated. Determined from parameters recorded in the program.

そして、CPU15は、移動開始時点Sから移動終了時点Eまでの間、台形速度パターンから所定のサンプリング周期(時間)Δt経過毎の速度を算出すると共に、移動開始時点Sからの移動距離を算出する。なお、移動距離は速度の積分値(サンプリング時間Δt毎の速度とΔt時間の積の総和)として求めることができる。   Then, the CPU 15 calculates the speed at every predetermined sampling period (time) Δt from the trapezoidal speed pattern from the movement start time S to the movement end time E, and calculates the movement distance from the movement start time S. . The moving distance can be obtained as an integral value of speed (the sum of products of speed and Δt time for each sampling time Δt).

CPU15は、サンプリング時間Δt経過毎に、移動開始時点Sからの移動距離だけ移動したときの位置(座標)を移動軌跡から算出し、求めたサンプリング時間Δt経過毎のロボットアーム先端の位置(指令位置)と速度(指令速度)から、各アームの位置と速度を演算し、これを各アームのサンプリング時間Δt経過毎の目標位置および目標速度とする。そして、CPU15は、位置検出回路19から取得した各アームの現在の位置および速度が、目標位置および目標速度となるように駆動回路18を介してモータ13を制御する。以上により、ロボットアーム先端が、動作プログラムにより定められた軌跡上を、台形速度パターンに従った速度で移動するように制御される。   The CPU 15 calculates the position (coordinates) when moving by the movement distance from the movement start time S from the movement locus every time the sampling time Δt elapses, and the position (command position) of the robot arm tip every time the sampling time Δt elapses. ) And speed (command speed), the position and speed of each arm are calculated, and this is used as the target position and target speed for each lapse of the sampling time Δt of each arm. Then, the CPU 15 controls the motor 13 via the drive circuit 18 so that the current position and speed of each arm acquired from the position detection circuit 19 become the target position and target speed. As described above, the tip of the robot arm is controlled so as to move on the trajectory determined by the operation program at a speed according to the trapezoidal speed pattern.

ここで、台形速度パターンにおいて、加速度+α、減速度−α、等速域での速度Vはロボットアームが強度上耐え得る最大加速度、最大減速度、最高速度に一定の安全率を見込んだ許容上限加速度+αmax、許容下限減速度−αmax、許容上限速度Vmax以下に定められる。なお、モータ13はロボットアームの駆動源であるが、同時に逆転トルク制動(逆転トルクを発生して制動)によってロボットアームを制動する制動手段としても機能する。 Here, in the trapezoidal velocity pattern, acceleration + α, deceleration -α, and velocity V in the constant velocity range are the maximum allowable acceleration that the robot arm can withstand in terms of strength, maximum deceleration, and maximum safety with a certain safety factor. Acceleration + α max , allowable lower limit deceleration −α max , and allowable upper limit speed V max or less. The motor 13 is a driving source of the robot arm, but also functions as a braking means for braking the robot arm by reverse torque braking (braking by generating reverse torque).

図8は、ロボット2〜5の自動動作時におけるロボットアーム先端の速度パターンの一例を示している。図8において、T1〜T2は上昇動作時、T2からT3は横方向移動動作時、T3〜T4は下降動作時、T4〜T5は移動動作停止時、T5〜T6は上昇動作時、T6〜T7は横方向移動動作時、T7〜T8は下降動作時、T8〜T9=T1は移動動作停止時を示している。   FIG. 8 shows an example of the velocity pattern of the tip of the robot arm when the robots 2 to 5 are automatically operated. In FIG. 8, T1 to T2 are ascending operation, T2 to T3 are lateral movement operation, T3 to T4 are descending operation, T4 to T5 are moving operation stop, T5 to T6 are ascending operation, T6 to T7 Indicates a horizontal movement operation, T7 to T8 indicate a lowering operation, and T8 to T9 = T1 indicate a movement operation stop.

この図8では、T1からT5までが第1の作業動作、T5からT9までが第2の作業動作で、この2つの作業動作を1作業サイクルとしている。そして、自動動作時には、この作業サイクルを繰り返し実行する。   In FIG. 8, the first work operation is from T1 to T5, the second work operation is from T5 to T9, and these two work operations are one work cycle. During the automatic operation, this work cycle is repeatedly executed.

この図8の1作業サイクルを各ロボット2〜4に当てはめてみる。まず、第1のロボット2および第4のロボット5は、自動供給装置8から供給されるワークを把持してT1〜T2で上昇し、T2〜T3でワークを自動供給装置8からコンベア1上に搬送し、T3〜T4でコンベアの製品までワークを下降させ、T4〜T5の移動動作停止時でワークの把持を解除する(第1の作業動作)。その後、T5〜T6でコンベア1から上方に離れ、T6〜T7でコンベア1上から自動供給装置8上まで移動し、T7〜T8で自動供給装置8により定位置に供給されたワークまで下降し、T8〜T9の移動動作停止時でワークを把持する(第2の作業動作)。   The one work cycle of FIG. 8 is applied to each robot 2-4. First, the first robot 2 and the fourth robot 5 hold the workpiece supplied from the automatic supply device 8 and move up at T1 to T2, and transfer the workpiece from the automatic supply device 8 onto the conveyor 1 at T2 to T3. Then, the workpiece is lowered to the conveyor product at T3 to T4, and the gripping of the workpiece is released when the moving operation is stopped at T4 to T5 (first work operation). After that, it leaves upward from the conveyor 1 at T5 to T6, moves from the conveyor 1 to the automatic supply device 8 at T6 to T7, and descends to the workpiece supplied to the fixed position by the automatic supply device 8 at T7 to T8. The workpiece is gripped when the moving operation is stopped in T8 to T9 (second work operation).

これに対し、第2のロボット3および第3のロボット4は、T1〜T2でコンベア1から上方に離れ、T2〜T3でコンベア1上から自動供給装置8上まで移動し、T3〜T4で自動供給装置8により定位置に供給されたワークまで下降し、T4〜T5の移動動作停止時でワークを把持する(第1の作業動作)。その後、T5〜T6でワークを把持したまま上昇し、T6〜T7でワークを自動供給装置8からコンベア1上に搬送し、T7〜T8でコンベアの製品までワークを下降させ、T8〜T9の移動動作停止時でワークの把持を解除する(第2の作業動作)。   On the other hand, the second robot 3 and the third robot 4 move upward from the conveyor 1 at T1 to T2, move from the conveyor 1 to the automatic feeder 8 at T2 to T3, and automatically at T3 to T4. The work is lowered to the work supplied to the fixed position by the supply device 8, and the work is gripped when the moving operation is stopped from T4 to T5 (first work operation). Thereafter, the workpiece is lifted while holding the workpiece at T5 to T6, and the workpiece is transferred from the automatic supply device 8 onto the conveyor 1 at T6 to T7, and the workpiece is lowered to the conveyor product at T7 to T8. The gripping of the workpiece is released when the operation is stopped (second work operation).

従って、第1のロボット2と第2のロボット3、第3のロボット4と第4のロボット5とは、通常は、コンベア1に対し、一方が近付くときは、他方が遠ざかるという動作関係を保持するように制御装置6よって制御されるので、衝突の恐れはない。しかし、第1のロボット2と第2のロボット3、第3のロボット4と第4のロボット5とは、図10に示すようにコンベア1上で動作範囲(楕円で示す)を共有する領域(共有領域)Uがあるので、動作のタイミングがずれると、共有領域Uで衝突する可能性が生ずる。   Therefore, the first robot 2 and the second robot 3, and the third robot 4 and the fourth robot 5 normally maintain an operation relationship in which when one approaches the conveyor 1, the other moves away. Thus, since it is controlled by the control device 6, there is no fear of a collision. However, the first robot 2 and the second robot 3, and the third robot 4 and the fourth robot 5 share an operation range (shown by an ellipse) on the conveyor 1 as shown in FIG. Since there is a shared area (U), there is a possibility of collision in the shared area U if the operation timing is shifted.

ところで、ロボット2〜5の自動動作中、例えばユーザーが異常だと感じたロボットがあった場合、異常の程度によっては、そのロボットを停止させて、点検を行うことが必要になってくる。この場合、ロボットの停止操作は教示装置7によって行う。例えば、第1のロボット2を停止させる場合、選択スイッチ11aを操作して第1のロボット2に割り当てられている番号を選択し、停止スイッチ11aを操作する。   By the way, during the automatic operation of the robots 2 to 5, for example, when there is a robot that the user feels abnormal, depending on the degree of abnormality, it is necessary to stop the robot for inspection. In this case, the robot is stopped by the teaching device 7. For example, when the first robot 2 is stopped, the selection switch 11a is operated to select the number assigned to the first robot 2, and the stop switch 11a is operated.

しかし、第1のロボット2が教示装置7上でも第1番のロボットであるかは確かではない。例えば、図11において、第1のロボット2の位置に設置されたロボットが第1番、第2のロボット3の位置に設置されたロボットが第2番に定められるとした場合、実際に工場に据え付ける際に、何らかの理由で、互いに逆の位置に設置(第1のロボット2の位置に第2のロボット3が設置、第2のロボット3の位置に第1のロボット2が設置)されることもある。この場合、第1のロボット2を停止させたいとして、第1番のロボットを選択して停止操作を行うと、第2のロボット3が停止してしまうという不具合を生ずる。   However, it is not certain whether the first robot 2 is also the first robot on the teaching device 7. For example, in FIG. 11, if the robot installed at the position of the first robot 2 is determined as the first and the robot installed at the position of the second robot 3 is determined as the second, the factory actually When installing, for some reason, they are installed at positions opposite to each other (the second robot 3 is installed at the position of the first robot 2, and the first robot 2 is installed at the position of the second robot 3). There is also. In this case, if it is desired to stop the first robot 2 and the first robot is selected and a stop operation is performed, the second robot 3 stops.

このような不具合の発生を防止し、停止させるべきロボットを間違いなく停止させることができるようにするために、本発明では、教示装置7上で停止させるものとして選択されたロボット(操作装置上での停止対象ロボット)に、選択されたことを告知する告知動作を行わせ、ユーザーが停止させたいと思ったロボットと告知動作したロボットとが一致した場合、停止操作を行うようにしている。   In order to prevent the occurrence of such a problem and to surely stop the robot to be stopped, in the present invention, the robot selected to be stopped on the teaching device 7 (on the operating device) The robot to be stopped) performs a notification operation for notifying that the robot has been selected, and when the robot that the user wanted to stop matches the robot that performed the notification operation, the stop operation is performed.

次に、ロボット2〜5の自動動作中に、1台のロボットを停止させる場合の制御装置6の制御内容を図3〜図6のフローチャートをも参照しながら説明する。自動動作モードにおいて、各ロボット2〜5は、複数の移動動作を含む複数の作業動作からなる作業サイクル、つまり図8に示された上昇・横方向移動・下降の移動動作を含む第1の作業動作と第2の作業動作からなる作業サイクルを繰り返し実行している。   Next, the control contents of the control device 6 when one robot is stopped during the automatic operation of the robots 2 to 5 will be described with reference to the flowcharts of FIGS. In the automatic operation mode, each of the robots 2 to 5 has a work cycle composed of a plurality of work operations including a plurality of movement operations, that is, a first operation including a movement operation of ascending / laterally moving / lowering shown in FIG. A work cycle consisting of an operation and a second work operation is repeatedly executed.

この自動動作時において、制御装置6は、各ロボット2〜5のロボットアーム先端の位置と速度を、前述のように指令位置と指令速度によって制御する図3の主制御ルーチンを実行すると共に、図4に示す停止指示対応ルーチンを実行する。図3の主制御ルーチンと、図4の停止指示対応ルーチンとは、並列処理により行われる。   During this automatic operation, the control device 6 executes the main control routine of FIG. 3 for controlling the positions and speeds of the robot arm tips of the robots 2 to 5 by the command position and the command speed as described above. 4 is executed. The main control routine of FIG. 3 and the stop instruction corresponding routine of FIG. 4 are performed by parallel processing.

以下に停止指示対応ルーチンによる制御内容を説明する。即ち、ロボット2〜5が自動動作中にあるとき、例えば調子の悪いロボットを見つけ、そのロボットを停止させる場合、ユーザーは教示装置7の選択スイッチ11aを操作し、停止したいロボットのものと思われるロボット番号を選択する。すると、制御装置6は、図4のステップA1で「YES」と判断して告知動作準備ルーチン(告知動作準備手段)A2に移行する。この告知動作準備ルーチンA2の詳細は図5に示されている。   The contents of control by the stop instruction response routine will be described below. That is, when the robots 2 to 5 are in automatic operation, for example, when a robot that is not in good condition is found and the robot is stopped, the user operates the selection switch 11a of the teaching device 7 and seems to be that of the robot to be stopped. Select the robot number. Then, the control device 6 determines “YES” in step A1 of FIG. 4 and proceeds to a notification operation preparation routine (notification operation preparation means) A2. Details of this notification operation preparation routine A2 are shown in FIG.

告知動作準備ルーチンA2に移行すると、制御装置6は、選択されたロボット番号から停止対象ロボットを決定し、選択操作タイミング(図1(a)に示す停止対象ロボットの台形速度パターン上で時点p1)を記憶する(ステップB1)。次に、制御装置6は、停止対象ロボットの現在進行中の移動動作の台形速度パターン(図1(a)のPt)を基に、現在(選択操作タイミング時点p1)からn時間(例えば2秒)先までのサンプリング時間Δt毎の速度指令値を取得する(ステップB2)。   When proceeding to the notification operation preparation routine A2, the control device 6 determines the stop target robot from the selected robot number, and selects the operation timing (time point p1 on the trapezoidal speed pattern of the stop target robot shown in FIG. 1A). Is stored (step B1). Next, based on the trapezoidal speed pattern (Pt in FIG. 1 (a)) of the currently moving motion of the robot to be stopped, the control device 6 performs n hours (for example, 2 seconds) from the current (selection operation timing point p1). ) Obtain the speed command value for each previous sampling time Δt (step B2).

続いて、制御装置6は、取得した速度指令値から10%減じた速度でn時間動作(告知動作)したと仮定し、その後、所定の加速度、例えば許容上限加速度+αmaxで加速して等速域の速度V0に達するまでの時間mを算出する(ステップB3)。なお、速度指令値から10%減じた速度に落とすために制動を掛ける場合、その減速度は所定の減速度、例えば−αmaxとし、その制動時間もn時間に入る。 Subsequently, it is assumed that the control device 6 has operated for n hours (notification operation) at a speed reduced by 10% from the acquired speed command value, and then accelerated at a predetermined acceleration, for example, an allowable upper limit acceleration + α max , at a constant speed. The time m required to reach the zone velocity V0 is calculated (step B3). In addition, when braking is applied to reduce the speed to a speed reduced by 10% from the speed command value, the deceleration is set to a predetermined deceleration, for example, −α max , and the braking time also enters n hours.

制御装置6は、次に現在進行中の移動動作において、p1が減速域またはp1から減速域の開始時点p3までの時間が(n+m)以内であるか否かを判断する(ステップB4)。ステップB4で「NO」と判断した場合、制御装置6は、前記選択操作タイミング時点p1からの告知動作による動作不足量M0を算出する(ステップB5)。ここで、指令速度から10%減じた速度でn時間移動し、その後、+αmaxで加速してV0に達するまで移動すると、当初の台形速度パターンによる指令速度のまま移動させた場合に比べて移動距離が不足することとなるが、動作不足量とはこの移動距離の不足量を言う。図1で左下がりの斜線を付した部分の面積が動作不足量M0となる。なお、p1時点が加速域にあるとき、当初台形速度パターンPtでの加速度によっては、+αmaxで加速してV0に達するまでの間に、一部分、当初台形速度パターンPtの外側に出ることがあるが、この外側への張り出し部分は動作の増加分であるので、不足動作量を計算する場合は、この増加分を差し引く必要がある。 Next, in the moving operation currently in progress, the control device 6 determines whether or not p1 is within the deceleration region or the time from p1 to the start point p3 of the deceleration region is within (n + m) (step B4). When it is determined as “NO” in Step B4, the control device 6 calculates an operation deficiency M0 due to the notification operation from the selection operation timing point p1 (Step B5). Here, when moving for n hours at a speed reduced by 10% from the command speed, and then moving to reach V0 after accelerating at + αmax , it moves compared to the case where the command speed is moved according to the original trapezoidal speed pattern. Although the distance will be insufficient, the operation shortage amount is the shortage amount of the moving distance. In FIG. 1, the area of the hatched portion with the lower left is the operation deficient amount M0. Incidentally, when the p1 point is in the acceleration range, depending on the acceleration of the initial trapezoidal speed pattern Pt, until reaching the V0 are accelerated by + alpha max, a portion, sometimes initially out to the outside of the trapezoidal speed pattern Pt However, since the outward projecting portion is an increase in the operation, it is necessary to subtract the increase when calculating the insufficient operation amount.

次に、制御装置6は、現在実行中の移動動作の台形速度パターンPtのうち、p1時点から時間nの期間の速度指令値に対し、上記所定の減速度で減速させて10%減じた速度指令値になるように書き換えると共に、n時間経過時点からm時間の加速度を+αmaxに書き換えた新たな台形速度パターンを作成し(ステップB6)、リターンとなる。 Next, in the trapezoidal speed pattern Pt of the moving operation currently being executed, the control device 6 decelerates the speed command value for the period of time n from the time point p1 by the predetermined deceleration and reduces it by 10%. A new trapezoidal velocity pattern is created by rewriting the command value so that the acceleration for m hours is rewritten to + α max from the time point when n hours elapse (step B6), and the process returns.

前記ステップB4で「YES」、即ちp1時点が減速域またはp1時点から減速域に至るまでの時間が(n+m)以内である場合、制御装置6は、ステップB7に移行して選択操作タイミング時点p1を次の移動動作の加速域開始からq時間経過後に変更し、表示器12に「しばらくお待ち下さい」のメッセージを表示(ステップB8)して前述のステップB2〜B6を実行し、リターンとなる。上記選択操作タイミング時点p1を次の移動動作の加速域開始からq時間経過後とする理由は、加速開始時点から告知動作を開始すると、告知動作と見極めることができないからである。なお、選択操作タイミング時点p1が移動停止時であった場合には、告知動作準備ルーチンはステップB7から開始される。   If “YES” in step B4, that is, if the time point p1 is within the deceleration region or the time from the time point p1 to the deceleration region is within (n + m), the control device 6 proceeds to step B7 to select the selection operation timing point p1. Is changed after the lapse of q hours from the start of the acceleration range of the next movement operation, the message “Please wait for a while” is displayed on the display 12 (step B8), the above-mentioned steps B2 to B6 are executed, and the process returns. The reason why the selection operation timing point p1 is set after q hours have elapsed from the start of the acceleration region of the next movement operation is that when the notification operation is started from the acceleration start point, it cannot be determined as the notification operation. When the selection operation timing point p1 is when the movement is stopped, the notification operation preparation routine is started from step B7.

以上により告知動作準備ルーチンA2を終了し、次に復旧動作準備ルーチン(復旧動作準備手段)A3に移行する。復旧準備ルーチンA3は図6に示されている。同ルーチンに入ると、制御装置6は、まず、停止対象ロボットの当初台形速度パターンPtの減速域開始時点p3を遅らせ、これによって生ずる減速域での動作量増加分Ma(図1(a)で右下がりの斜線部分)が前記動作不足量M0と一致するような新台形速度パターンPt´を作成する(ステップC1)。この場合、停止対象ロボットに、現在実行中の移動動作に続く移動動作があれば、図2(a)に示すように、後続の移動動作の台形速度パターンPsについても、当初台形速度パターンPsに対し上記減速域開始時点p3の遅れ分Tdだけ遅らせて新台形速度パターンPs´を作成するものである。   Thus, the notification operation preparation routine A2 is completed, and then the operation proceeds to a recovery operation preparation routine (recovery operation preparation means) A3. The recovery preparation routine A3 is shown in FIG. When entering this routine, the control device 6 first delays the deceleration region start time point p3 of the initial trapezoidal speed pattern Pt of the robot to be stopped, and the operation amount increase Ma in the deceleration region caused by this (in FIG. 1A). A new trapezoidal speed pattern Pt ′ is created so that the downward slanted line portion) matches the motion deficit amount M0 (step C1). In this case, if the robot to be stopped has a movement operation following the movement operation currently being executed, the trapezoidal speed pattern Ps of the subsequent movement operation is also changed to the initial trapezoidal speed pattern Ps as shown in FIG. On the other hand, a new trapezoidal speed pattern Ps ′ is created by delaying by the delay Td of the deceleration region start time point p3.

次に、制御装置6は、当初台形速度パターンPtの減速域開始時点p3から新台形速度パターンPt´の減速域開始時点p3´の遅れ時間Td、換言すれば、当初台形速度パターンPtの終了時点p4に対する新台形速度パターンPt´の終了時点p4´の遅れ時間Tdを算出する(ステップC2)。   Next, the control device 6 determines the delay time Td from the deceleration zone start time p3 of the initial trapezoidal speed pattern Pt to the deceleration zone start time p3 ′ of the new trapezoidal speed pattern Pt ′, in other words, the end time of the initial trapezoidal speed pattern Pt. The delay time Td of the end point p4 ′ of the new trapezoidal speed pattern Pt ′ with respect to p4 is calculated (step C2).

続いて、制御装置6は、停止対象ロボット以外のロボット(以下、他のロボットという)の作業動作の終了時点が当初よりTd時間遅れるように他のロボットのp2時点以降の台形速度パターンを書き換える(ステップC3)。p2時点で実行中の移動動作に後続する移動動作がある場合、その後続の移動動作の台形速度パターンも書き換えの対象となる。   Subsequently, the control device 6 rewrites the trapezoidal velocity pattern of the other robots after the time point p2 so that the end time of the work operation of the robot other than the robot to be stopped (hereinafter referred to as another robot) is delayed by Td time from the beginning ( Step C3). When there is a moving operation that follows the moving operation being executed at the time point p2, the trapezoidal velocity pattern of the subsequent moving operation is also subject to rewriting.

即ち、図1(b)に示すように、他のロボットに後続する移動動作がない場合、p2時点で実行中の移動動作の台形速度パターンPuについて、減速域の終了点p6を停止対象ロボットの新台形速度パターンPt´の終了点p4´に一致させるようにTdだけ遅らせ、且つ、p2時点から所定の減速度、例えば当初台形速度パターンPuにおける減速域の減速度で減速させて当初速度V1からV2に変更したとき、p2時点から減速域の減速度で減速させて当初速度V1からV2に変更することによって生じた動作不足分(左下がりの斜線を付した部分)M1と減速域の終了時点をTdだけ遅らせることによって減速域で生じた動作増加分(右下がりの斜線を付した部分)M2とが等しくなるようにV2を定める。   That is, as shown in FIG. 1B, when there is no movement operation following the other robot, the end point p6 of the deceleration region is set to the stop target robot for the trapezoidal speed pattern Pu of the movement operation being executed at the time point p2. Delayed by Td so as to coincide with the end point p4 ′ of the new trapezoidal speed pattern Pt ′, and decelerated at a predetermined deceleration from the time point p2, for example, deceleration in the deceleration region in the initial trapezoidal speed pattern Pu, from the initial speed V1. When the speed is changed to V2, the operation deficiency (part with the slanting left slanted line) M1 caused by decelerating at the deceleration speed from the time point p2 and changing from the initial speed V1 to V2 and the end time of the speed reduction area Is delayed by Td, and V2 is determined so as to be equal to the operation increase M2 generated in the deceleration region (the portion with the slanting line to the right) M2.

以上のようにしてV2を定めた後、p2時点から減速域と同じ減速度で速度V2まで減速する減速線を作成し、そして、当該V2で等速線を引き、減速域の減速線をp4´(p6´)時点で終了するように作成することで、他のロボットの新台形速度パターンPu´を作成する。   After V2 is determined as described above, a deceleration line for decelerating to the speed V2 at the same deceleration as the deceleration range is created from the time point p2, and then the constant velocity line is drawn at the V2 and the deceleration line in the deceleration range is set to p4. A new trapezoidal velocity pattern Pu ′ of another robot is created by creating it so as to end at the time of ′ (p6 ′).

また、図2(b)に示すように、他のロボットにも後続する移動動作がある場合、現在(p2時点)実行中の作業動作を含めて残りの作業動作の数がN(2以上の整数)であったとすると、p2時点で実行中の作業動作の台形速度パターンPuの終了時点p6、後続の作業動作の終了時点p7をそれぞれTd/Nだけ遅らせる。そして、現在実行中の作業動作の台形速度パターンPuの減速線の終了時点をTd/Nだけ遅らせ、図1(b)と同様にして動作不足量M1と動作増加量M2とが等しくなるように新台形速度パターンPu´を作成する。後続する作業動作の台形速度パターンについては、加速度および減速度は当初台形速度パターンPvと同じで、加速域の開始点P6がTd/Nだけ遅れたこと、および等速域の速度がV3からV4まで減少したことによる動作不足分(左下がりの斜線を付した部分)M3と、減速域の終了点p7がZ・Td/N(Zは、後続の作業動作がp2時点で実行中の作業動作を含めてZ番目のものを示す。)だけ遅れることによる増加動作量M4とが等しくなるように新台形速度パターンPv´を作成する。なお、図2(b)は後続する作業動作が1(Nは2)である場合を示している。
このようにして新台形速度パターンを生成すると、制御装置6は復旧動作準備ルーチンを終了し、リターンとなって図4の停止指示対応ルーチンのステップA4(告知動作制御手段)に移行する。
Further, as shown in FIG. 2B, when another robot also has a subsequent movement operation, the number of remaining operation operations including the operation operation currently being executed (at time p2) is N (2 or more). If it is an integer), the end point p6 of the trapezoidal speed pattern Pu of the work operation being executed at the time point p2 and the end point p7 of the subsequent work operation are delayed by Td / N, respectively. Then, the end point of the deceleration line of the trapezoidal speed pattern Pu of the work operation currently being executed is delayed by Td / N so that the operation deficit amount M1 and the operation increase amount M2 are equal to each other in the same manner as in FIG. A new trapezoidal speed pattern Pu ′ is created. Regarding the trapezoidal speed pattern of the subsequent work operation, the acceleration and deceleration are the same as the initial trapezoidal speed pattern Pv, the start point P6 of the acceleration area is delayed by Td / N, and the speed in the constant speed area is V3 to V4. The shortage of operation due to the decrease (the part with the slanted line to the left) M3 and the end point p7 of the deceleration region is Z · Td / N (Z is the work operation that is being executed at the time point p2 of the subsequent work operation) A new trapezoidal speed pattern Pv ′ is created so that the increased operation amount M4 resulting from the delay is equal. FIG. 2B shows a case where the subsequent work operation is 1 (N is 2).
When the new trapezoidal speed pattern is generated in this way, the control device 6 ends the restoration operation preparation routine, and returns to step A4 (notification operation control means) of the stop instruction corresponding routine in FIG.

制御装置6は、ステップA4において、ステップB6で得た速度パターンにより、p1からn時間、指令速度の10%減の速度となるように、停止対象ロボットのロボットアーム先端の移動速度を制御する。この告知動作制御により、停止対象ロボットの加速度域での加速度が減少、または等速度域での速度が減少する。停止対象ロボットは、この速度減少動作を、教示装置7上で停止させるべきロボットとして選択されたことを告知する動作(告知動作)とする。
そして、この告知動作をしたロボットを見つけたユーザーは、その告知動作をしたロボットが停止させたいと思ったロボットと一致したとき、停止スイッチ11bを操作する(ステップA5で「YES」)。
In step A4, the control device 6 controls the moving speed of the tip of the robot arm of the robot to be stopped so that the speed pattern obtained in step B6 is reduced by 10% of the command speed for n hours from p1. By this notification operation control, the acceleration in the acceleration range of the robot to be stopped is reduced, or the speed in the constant velocity range is reduced. The stop target robot uses this speed reduction operation as an operation (notification operation) for notifying that it has been selected as a robot to be stopped on the teaching device 7.
Then, the user who has found the robot that has performed the notification operation operates the stop switch 11b when the robot that has performed the notification operation matches the robot that the user wants to stop ("YES" in step A5).

制御装置6は、告知動作の開始時点p1からの経過時間をカウントし、この経過時点が所定時間(n+m)以内に停止スイッチ11bが操作されたとき(ステップA5で「YES」、ステップA6で「YES」)、モータ13に逆転トルクを発生させて停止対象ロボットを制動停止させる(ステップA8:停止制御手段)。これにより、停止対象ロボットは移動動作の終了地点に至る前で停止する。   The control device 6 counts the elapsed time from the start point p1 of the notification operation, and when the stop switch 11b is operated within the predetermined time (n + m) at this elapsed time (“YES” in step A5, “ YES ”), reverse torque is generated in the motor 13 to stop and stop the robot to be stopped (step A8: stop control means). Thereby, the robot to be stopped stops before reaching the end point of the moving operation.

告知動作開始時点p1から所定時間(n+m)以内に停止スイッチ11bの操作がなかったとき(ステップA5で「NO」)、制御装置6は、p2時点以降の停止対象ロボットの速度を、前述のステップC1で作成した図1(a)の新台形速度パターンPt´、または図2(a)の新台形速度パターンPt´およびPs´に従って制御する。また、他のロボットを、前記ステップC3で作成した図1(b)の新台形速度パターンPu´、または図2(b)の新台形速度パターンPu´およびPv´に従って制御する(ステップA7:復旧制御手段)。   When the stop switch 11b is not operated within a predetermined time (n + m) from the notification operation start time point p1 (“NO” in step A5), the control device 6 determines the speed of the robot to be stopped after the time point p2 as described above. Control is performed according to the new trapezoidal velocity pattern Pt ′ of FIG. 1A created in C1 or the new trapezoidal velocity patterns Pt ′ and Ps ′ of FIG. Further, other robots are controlled in accordance with the new trapezoidal speed pattern Pu ′ of FIG. 1B created in step C3 or the new trapezoidal speed patterns Pu ′ and Pv ′ of FIG. 2B (step A7: recovery). Control means).

この復旧動作によって、他のロボットは速度を遅らせ、これにより停止対象ロボットの作業動作の終了時点と同じ時期に作業動作を終了するようになされる。
このように本実施形態によれば、ユーザーが教示装置7によって停止させたいと思う1台のロボットを選択すると、選択されたロボットの移動速度が減少するので、この速度変動(告知動作)によってユーザーは教示装置7で選択した停止対象ロボットが実際にどのロボットであるかを知ることができる。そして、ユーザーが停止させたいと思ったロボットと告知動作したロボットとが一致した場合、停止スイッチ11bを操作することで、その停止させたいと思ったロボットを停止させることができる。
By this restoration operation, the other robots slow down the speed, so that the work operation ends at the same time as the end of the work operation of the robot to be stopped.
As described above, according to the present embodiment, when the user selects one robot to be stopped by the teaching device 7, the moving speed of the selected robot is reduced. Can know which robot is actually the robot to be stopped selected by the teaching device 7. When the robot that the user wanted to stop matches the robot that performed the notification operation, the robot that the user wanted to stop can be stopped by operating the stop switch 11b.

また、告知動作したロボットが、ユーザーの停止させたいロボットと異なる場合、ユーザーは停止操作をしない。すると、停止対象ロボットは告知動作した分だけ他のロボットに対し動作遅れを生ずるが、他のロボットが復旧動作、つまり、他のロボットが速度を減少させて、告知動作による停止対象ロボットの遅れ分だけ他のロボットも動作遅れを呈し、4台のロボット共に同じ時期に作業動作を終了するようになる。   Further, when the robot that has performed the notification operation is different from the robot that the user wants to stop, the user does not perform the stop operation. Then, the robot to be stopped causes an operation delay relative to the other robots by the amount of the notification operation, but the other robot recovers, that is, the other robot reduces the speed and the delay of the robot to be stopped due to the notification operation. However, other robots also exhibit a delay in operation, and the four robots finish their work operations at the same time.

そして、復旧動作により、全てのロボット2〜5が同時期に作業動作を停止するので、告知動作したロボットが作業動作の停止タイミングを常とは異ならせることによって共有領域で他のロボットと衝突するという危険性の発生をなくすことができる。   Since all the robots 2 to 5 stop the work operation at the same time due to the recovery operation, the robot that has performed the notification operation collides with another robot in the common area by making the stop timing of the work operation different from usual. The occurrence of the danger can be eliminated.

なお、本発明は上記し且つ図面に示す実施形態に限定されるものではなく、次のような拡張或いは変更が可能である。
告知動作を行う移動動作は、選択スイッチ11aを操作した際に実施されている移動動作としたが、告知動作を行う移動動作を例えば横方向への移動動作に予め定めておいても良い。
横方向への移動動作は、水平方向移動に限られず、上下方向の移動を伴っていても良い。
移動動作の速度を表わすパターンとしては、台形に限られず、三角形であっても良い。特に、移動距離が短い場合には、加速域と減速域からなる三角速度パターンの方が好ましい。
The present invention is not limited to the embodiment described above and shown in the drawings, and can be expanded or changed as follows.
The moving operation for performing the notification operation is the moving operation performed when the selection switch 11a is operated. However, the moving operation for performing the notification operation may be determined in advance as, for example, a horizontal movement operation.
The movement operation in the horizontal direction is not limited to horizontal movement, and may be accompanied by vertical movement.
The pattern representing the speed of the moving operation is not limited to a trapezoid, and may be a triangle. In particular, when the moving distance is short, a triangular speed pattern including an acceleration region and a deceleration region is preferable.

ロボットは垂直多関節型に限られない。
他のロボットの作業動作の停止時は、停止対象ロボットの作業動作の停止時と必ずしも正確に一致する必要はない。他のロボットが停止対象ロボットと衝突することを防止できる程度に停止の時点が同じ時期であれば、停止時点のばらつきはあっても支障はない。
複数(上記実施例では4台)のロボットの各移動動作の開始時点と終了時点は、それぞれ異なっていても良いが、複数のロボットの各移動動作の開始時点(T1〜T3、T5〜T7)と終了時点(T2〜T4、T6〜T8)は互いに同じ時点であることが新台形速度パターンの形成上好ましい。
The robot is not limited to the vertical articulated type.
When the work operation of another robot is stopped, it does not necessarily coincide exactly with the stop of the work operation of the robot to be stopped. If the stop time is the same as long as it can prevent other robots from colliding with the robot to be stopped, there will be no problem even if the stop time varies.
The start time and end time of each movement operation of a plurality (four in the above embodiment) of robots may be different from each other, but the start time (T1 to T3, T5 to T7) of each movement operation of a plurality of robots. It is preferable for the formation of the new trapezoidal velocity pattern that the end points (T2 to T4, T6 to T8) are the same point in time.

図面中、2〜5はロボット、6は制御装置(告知動作制御手段、停止制御手段、復旧制御手段)、7は教示装置(操作装置)、11aは選択スイッチ(選択手段)、11bは停止スイッチ(停止指示手段)を示す。   In the drawing, 2 to 5 are robots, 6 is a control device (notification operation control means, stop control means, recovery control means), 7 is a teaching device (operation device), 11a is a selection switch (selection means), and 11b is a stop switch. (Stop instruction means).

Claims (2)

複数の移動動作を含む複数の作業動作からなる作業サイクルを繰り返し実行する複数台のロボットと、
常には、前記各ロボットの前記各作業動作における前記各移動動作の開始点から終了点までの移動速度を、加速域から等速域を経て減速域に至る台形速度パターン、または加速域と減速域とからなる三角速度パターンに従って制御することにより、前記複数台のロボットの前記各作業動作が全て同じ時期に終了するように制御する1台の制御装置と、
前記制御装置に接続され前記複数台の各ロボットに対して手動による動作指示を行うための1台の操作装置と
を備えたロボットシステムにおいて、
前記操作装置に、前記複数台のロボットのうちから所望のロボットを選択するための選択手段と、この選択手段により選択されたロボットを停止させるための停止指示手段と
を設け、
前記制御装置は、
前記複数台のロボットのうち1台のロボットが前記選択手段により前記操作装置上での停止対象ロボットとして選択されると、前記停止対象ロボットに対し、実行中の前記移動動作または予め定められた移動動作の前記加速域における加速度または前記等速域における速度を減少側に変化させてこの速度変動を前記停止対象ロボットとして選択されたことの告知動作となし、この告知動作後所定時間内に前記停止指示手段が操作された場合には、前記停止対象ロボットを停止させ、前記告知動作後所定時間内に前記停止手段が操作されなかった場合には、前記複数台のロボットのうち前記停止対象ロボットを除く他のロボットの移動速度を減じて当該他のロボットの現在実行中の前記作業動作の終了時期が前記停止対象ロボットの前記告知動作を行った現在実行中の前記作業動作の終了時期と同じになるようにした
ことを特徴とするロボットの停止方法。
A plurality of robots that repeatedly execute a work cycle composed of a plurality of work operations including a plurality of movement operations;
Always, the moving speed from the start point to the end point of each moving operation in each work operation of each robot, the trapezoidal speed pattern from the acceleration region to the deceleration region through the constant velocity region, or the acceleration region and the deceleration region By controlling according to a triangular speed pattern consisting of: one control device for controlling the work operations of the plurality of robots to be completed at the same time, and
In a robot system provided with one operating device for performing manual operation instructions to each of the plurality of robots connected to the control device,
The operating device is provided with a selection means for selecting a desired robot from the plurality of robots, and a stop instruction means for stopping the robot selected by the selection means,
The controller is
When one of the plurality of robots is selected as a robot to be stopped on the operating device by the selection unit, the movement operation being executed or a predetermined movement is performed with respect to the robot to be stopped. The acceleration in the acceleration range of the motion or the speed in the constant speed range is changed to the decrease side, and this speed change is regarded as the notification operation that the robot is selected as the stop target robot, and the stop is performed within a predetermined time after the notification operation. When the instruction means is operated, the stop target robot is stopped, and when the stop means is not operated within a predetermined time after the notification operation, the stop target robot is selected from the plurality of robots. The movement speed of the other robot is reduced, and the end time of the work operation currently being executed by the other robot is determined by the notification motion of the robot to be stopped. The method of stopping a robot, characterized in that as the equal to the end time of the working operation of the currently running went.
複数の移動動作を含む複数の作業動作からなる作業サイクルを繰り返し実行する複数台のロボットと、
常には、前記各ロボットの前記各作業動作における前記各移動動作の開始点から終了点までの移動速度を、加速域から等速域を経て減速域に至る台形速度パターン、または加速域と減速域とからなる三角速度パターンに従って制御することにより、前記複数台のロボットの前記各作業動作が全て同じ時期に終了するように制御する1台の制御装置と、
前記制御装置に接続され前記複数台の各ロボットに対して手動による動作指示を行うための1台の操作装置と
を備えたロボットシステムにおいて、
前記操作装置に、前記複数台のロボットのうちから所望のロボットを選択するための選択手段と、この選択手段により選択されたロボットを停止させるための停止指示手段と
を設け、
前記制御装置に、
前記複数台のロボットのうち1台のロボットが前記選択手段により前記操作装置上での停止対象ロボットとして選択されると、前記停止対象ロボットに対し、実行中の前記移動動作または予め定められた移動動作の前記加速域における加速度または前記等速域における速度を減少側に変化させてこの速度変動を前記停止対象ロボットとして選択されたことの告知動作となす告知動作制御手段と、
前記告知動作後所定時間内に前記停止指示手段が操作されたとき、前記停止対象ロボットを停止させる停止制御手段と、
前記告知動作後所定時間内に前記停止手段が操作されなかったとき、前記複数台のロボットのうち前記停止対象ロボットを除く他のロボットの移動速度を減じて当該他のロボットの現在実行中の前記作業動作の終了時期が前記停止対象ロボットの前記告知動作を行った現在実行中の前記作業動作の終了時期と同じになるよう制御する復旧制御手段と
を設けたことを特徴とするロボットシステム。
A plurality of robots that repeatedly execute a work cycle composed of a plurality of work operations including a plurality of movement operations;
Always, the moving speed from the start point to the end point of each moving operation in each work operation of each robot, the trapezoidal speed pattern from the acceleration region to the deceleration region through the constant velocity region, or the acceleration region and the deceleration region By controlling according to a triangular speed pattern consisting of: one control device for controlling the work operations of the plurality of robots to be completed at the same time, and
In a robot system provided with one operating device for performing manual operation instructions to each of the plurality of robots connected to the control device,
The operating device is provided with a selection means for selecting a desired robot from the plurality of robots, and a stop instruction means for stopping the robot selected by the selection means,
In the control device,
When one of the plurality of robots is selected as a robot to be stopped on the operating device by the selection unit, the movement operation being executed or a predetermined movement is performed with respect to the robot to be stopped. A notification operation control means for changing the acceleration in the acceleration region of the motion or the speed in the constant velocity region to the decreasing side and making this speed variation a notification operation of being selected as the robot to be stopped;
Stop control means for stopping the robot to be stopped when the stop instruction means is operated within a predetermined time after the notification operation;
When the stopping means is not operated within a predetermined time after the notification operation, the moving speed of the other robots except the stopping target robot among the plurality of robots is reduced, and the other robots currently being executed A robot system, comprising: recovery control means for controlling so that an end time of a work operation is the same as an end time of the currently-executed work operation in which the notification operation of the robot to be stopped is performed.
JP2011214511A 2011-09-29 2011-09-29 Robot stopping method and robot system Withdrawn JP2013071234A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2011214511A JP2013071234A (en) 2011-09-29 2011-09-29 Robot stopping method and robot system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011214511A JP2013071234A (en) 2011-09-29 2011-09-29 Robot stopping method and robot system

Publications (1)

Publication Number Publication Date
JP2013071234A true JP2013071234A (en) 2013-04-22

Family

ID=48476150

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011214511A Withdrawn JP2013071234A (en) 2011-09-29 2011-09-29 Robot stopping method and robot system

Country Status (1)

Country Link
JP (1) JP2013071234A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113641132A (en) * 2021-08-18 2021-11-12 珠海格力电器股份有限公司 Robot timing energy-saving circuit and automatic machine

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113641132A (en) * 2021-08-18 2021-11-12 珠海格力电器股份有限公司 Robot timing energy-saving circuit and automatic machine

Similar Documents

Publication Publication Date Title
CN106393097B (en) Industrial robot system and control method thereof
JP6369590B1 (en) Motor control system, motor control device, and safety function setting method
TWI603827B (en) Robot system
CN102208888B (en) Motor driving system, motor controller, and safety function expander
US9102058B2 (en) Method and apparatus for implementing a manipulator process
CN106625654B (en) Robot control device, robot system and method thereof
JP2007172080A (en) Fixed position stopping control device for rotating shaft
US10486944B2 (en) Operation control apparatus for crane
KR20160076477A (en) Method and manipulator assembly for conditionally stopping at least one manipulator on a track
KR101949066B1 (en) Method for weaving welding
JP2014047022A (en) Control method for movable body
CN102482049B (en) Control device for elevator
JP2013071234A (en) Robot stopping method and robot system
JP2013071236A (en) Robot stopping method and robot system
JP2013071235A (en) Robot stopping method in robot system, and robot system
JP6249583B2 (en) Operation control device and operation control method for press line
JP2013071237A (en) Robot stopping method in robot system, and robot system
JP2013071233A (en) Robot stopping method and robot system
JP6476635B2 (en) Robot control apparatus and control method
JP2012245558A (en) Arc welding robot
JP7020092B2 (en) Crane operation control device
JP5678746B2 (en) Robot control method and robot control apparatus
JP2011062794A (en) Robot system
JP4596806B2 (en) Drive control device and drive control method
JP2008027246A (en) Positioning controller and positioning control method

Legal Events

Date Code Title Description
A300 Withdrawal of application because of no request for examination

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 20141202