JPH01290007A - Method and device for speed control of industrial robot - Google Patents
Method and device for speed control of industrial robotInfo
- Publication number
- JPH01290007A JPH01290007A JP11928888A JP11928888A JPH01290007A JP H01290007 A JPH01290007 A JP H01290007A JP 11928888 A JP11928888 A JP 11928888A JP 11928888 A JP11928888 A JP 11928888A JP H01290007 A JPH01290007 A JP H01290007A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- command
- allowable
- control
- industrial robot
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims description 35
- 230000001133 acceleration Effects 0.000 claims abstract description 56
- 230000008929 regeneration Effects 0.000 claims description 34
- 238000011069 regeneration method Methods 0.000 claims description 34
- 230000001172 regenerating effect Effects 0.000 claims description 4
- 230000006870 function Effects 0.000 description 16
- 238000003466 welding Methods 0.000 description 10
- 238000010586 diagram Methods 0.000 description 4
- OVSKIKFHRZPJSS-UHFFFAOYSA-N 2,4-D Chemical compound OC(=O)COC1=CC=C(Cl)C=C1Cl OVSKIKFHRZPJSS-UHFFFAOYSA-N 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 239000002131 composite material Substances 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 101100008044 Caenorhabditis elegans cut-1 gene Proteins 0.000 description 1
- 101000952234 Homo sapiens Sphingolipid delta(4)-desaturase DES1 Proteins 0.000 description 1
- 102100037416 Sphingolipid delta(4)-desaturase DES1 Human genes 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 239000013256 coordination polymer Substances 0.000 description 1
- PCHJSUWPFVWCPO-UHFFFAOYSA-N gold Chemical group [Au] PCHJSUWPFVWCPO-UHFFFAOYSA-N 0.000 description 1
- 210000003205 muscle Anatomy 0.000 description 1
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
Abstract
Description
【発明の詳細な説明】
［産業上の利用分野コ
本発明は、教示（ティーチング）点間をプレイバック動
作する溶接ロボット等の産業用ロボットにおける速度制
御方法および装置に関するものである。DETAILED DESCRIPTION OF THE INVENTION [Field of Industrial Application] The present invention relates to a speed control method and apparatus for an industrial robot such as a welding robot that performs a playback operation between teaching points.
［従来の技術］
第６図は、産業用ロボッＩ・、例えばアーク溶接ロボッ
トによる溶接工程を示した模式図である。[Prior Art] FIG. 6 is a schematic diagram showing a welding process using an industrial robot I, for example, an arc welding robot.
この第６図において、ギザギザで表わしたＰ２−２３問
およびＰ ５− Ｐ ６間は、アーク溶接する区間であ
り、これらの区間では指定溶接脚長等により許容速度は
予め決まる。これに対して、Ｐ Ｌ −Ｐ２．Ｐ３−Ｐ
４＝Ｐ５．Ｐ６−Ｐ７間は溶接区間Ｐ２−Ｐ３．Ｐ５−
Ｐ６にａボッ１〜を移動させる目的で動かす区間〔従っ
て、これらの区間Ｐ］−Ｐ２．Ｐ３−Ｐ４．−Ｐ５．Ｐ
６−Ｐ７を空送区間（エアカッ１〜区間）と呼ぶ〕であ
るから、この空送区間での速度は溶接施工上の制限はな
く、ロボットの各軸のモータ等の性能、即ち、ロボット
自身がもつ性能により速度は決定されるものである。In FIG. 6, the sections P2-23 and P5-P6, which are indicated by jagged lines, are sections for arc welding, and the allowable speed in these sections is determined in advance by the specified welding leg length, etc. On the other hand, P L -P2. P3-P
4=P5. P6-P7 is a welding section P2-P3. P5-
The section to be moved for the purpose of moving a box 1 to P6 [therefore, these sections P]-P2. P3-P4. -P5. P
6-P7 is called the air feed section (air cut 1 to section)], the speed in this air feed section is not limited by welding construction, and depends on the performance of the motor etc. of each axis of the robot, that is, the robot itself. Speed is determined by the performance of the vehicle.
この空送区間におけるロボットのアーム先端の移動速度
を設定した場合、通常、第７図に鎖線で示すような速度
パターンを描いて速度制御され、指令速度Ｖ。までの加
速区間および停止するまでの減速区間に、所定の時間を
かむりている。When the moving speed of the tip of the arm of the robot in this air transport section is set, the speed is normally controlled by drawing a speed pattern as shown by the chain line in FIG. 7, and the command speed V. A predetermined amount of time is required for the acceleration period until the vehicle stops and the deceleration period until the vehicle stops.
また、従来、許容速度（最高速度：例えば、多関節型ロ
ボットの下腕については、下腕軸５２１１ｉ動用モータ
の最高回転速度により制限され、約８０ｍ／ｍｉｎ程度
である。）Ｖｍａｘを予め設定しておき、指令速度■。In addition, conventionally, the permissible speed (maximum speed: for example, for the lower arm of an articulated robot, it is limited by the maximum rotational speed of the lower arm shaft 5211i motor, and is about 80 m/min) Vmax is set in advance. Now, set the command speed■.
がこの許容速度Ｖｍａｘを超えている場合には、そのま
まではエラーが発生してしまうので、第７図に実線で示
すように、加速中に許容速度Ｖｍａｘに達した時点で、
指令速度■ｏと許容速度Ｖｍａｘとに基づいて制御周期
を引き伸ばして〔例えば、（Ｖｏ ／ Ｖｍａｘ） Ｘ
（通常の制御周期）〕、指令速度■。まで加速するこ
となく許容速度ｖｍａｘを保持し、この許容速度Ｖ ｍ
ａｘから減速するようにしている（最高速度自動設定機
能）。つまり、鎖線で示す通常の速度パターンを許容速
度Ｖ ｍａｘで切り取ったほぼ台形の速度パターンを描
くように速度制御されることになる。If the speed exceeds the allowable speed Vmax, an error will occur if the speed continues, so as shown by the solid line in Fig. 7, when the allowable speed Vmax is reached during acceleration,
The control period is extended based on the command speed ■o and the allowable speed Vmax [for example, (Vo / Vmax)
(Normal control cycle)], command speed ■. Maintain the permissible speed vmax without accelerating up to this permissible speed V m
It is designed to decelerate from ax (maximum speed automatic setting function). In other words, the speed is controlled so as to draw a substantially trapezoidal speed pattern obtained by cutting the normal speed pattern shown by the chain line at the allowable speed V max.
このように速度制御することで、指令速度Ｖ。By controlling the speed in this way, the command speed V.
をティーチングした際に、デス１〜モードにおいて指令
速度Ｖ。が許容速度Ｖｍａｘを超えてエラーが発生する
か否かをチエツクする必要がなくなり、ティーチングを
迅速に行なえるようになる。When teaching, the command speed V in Des 1 to mode. There is no need to check whether an error occurs when the speed exceeds the allowable speed Vmax, and teaching can be performed quickly.
［発明が解決しようとする課題］
しかしながら、上述のような従来の速度制御手段では、
緩加減速の機能を考慮していないため、指令速度Ｖ。が
許容速度Ｖｍａｘを超えている場合には、第７図に実線
で示すような速度パターンで制御され、加速区間から許
容速度ｙｍａＸへ移る時点と、許容速度Ｖｍａｘから減
速区間へ移る時点との２箇所でエツジＥが生し、これら
のエツジＥにより、ロボットのアーム等に大きな振動が
発生して制御精度に悪影響を及ぼすことになる。[Problem to be solved by the invention] However, in the conventional speed control means as described above,
The command speed is V because the slow acceleration/deceleration function is not taken into account. exceeds the allowable speed Vmax, the speed is controlled using a speed pattern as shown by the solid line in FIG. Edges E are generated at these points, and these edges E generate large vibrations in the arm of the robot, etc., which adversely affects control accuracy.
そこで、緩加減速途中においても、加速（もしくは減速
）の最初のステップで、指令速度に到達するまでのうち
の１ステツプとして全体の何分の１かを考慮して加速（
もしくは減速）の最初のステップの許容速度を定め、こ
の許容速度と指令速度とを比較して指令速度が許容速度
を超える場合に、許容速度と指令速度とに基づき制御周
期を延ばし、加速（もしくは減速）中、この制御周期を
保持する方法や、指令速度に到達するまでの各ステップ
毎に、許容速度を設定し、前述と同様にして制御周期を
変更・設定する方法が提案されている。これらの方法を
用いることにより、［振動の無い滑らかな加減速」と［
指令速度以内で最も速い速度で移動できる制御方式」と
を同時に実現できる。しかし、上記の制御方法では、加
減速時の制御周期を引き延ばすため、加減速時間が延び
タクトタイムを下げてしまうという課題がある。Therefore, even during slow acceleration/deceleration, at the first step of acceleration (or deceleration), a fraction of the total speed is considered as one step before reaching the command speed.
The permissible speed for the first step of acceleration (or deceleration) is determined, and this permissible speed is compared with the commanded speed. If the commanded speed exceeds the permissible speed, the control cycle is extended based on the permissible speed and the commanded speed. A method has been proposed in which this control cycle is maintained during (deceleration), or a method in which an allowable speed is set for each step until the command speed is reached, and the control cycle is changed and set in the same manner as described above. By using these methods, [smooth acceleration/deceleration without vibration] and [
A control method that allows the robot to move at the fastest speed within the commanded speed can be realized at the same time. However, in the above control method, since the control cycle during acceleration and deceleration is extended, there is a problem that the acceleration and deceleration time is extended and the takt time is reduced.
本発明は、このような課題を解決しようとするもので、
指令速度が許容速度を超えた場合にエツジを発生させる
ことなく速度制御できるようにして、エツジによる振動
発生を確実に防止し制御精度の向上をはかるとともに、
２回目以降の再生動作時には制御周期を引き延ばすこと
なく指令速度以内で最も速い速度で移動できる産業用ロ
ボットの速度制御方法および装置を提供することを目的
とする。The present invention aims to solve such problems,
By making it possible to control the speed without generating edges when the commanded speed exceeds the allowable speed, we aim to reliably prevent vibrations caused by edges and improve control accuracy.
It is an object of the present invention to provide a speed control method and device for an industrial robot that can move at the fastest speed within the command speed without prolonging the control cycle during the second and subsequent regeneration operations.
［課題を解決するための手段］
このため、請求項１に記載された本発明の産業用ロボッ
トの速度制御方法は、教示点間を再生動作する産業用ロ
ボットであって、上記教示点間を複数の区間に分割する
分割点を目標位置として位置制御するためのタイミング
を決めるトリガ信号を所要の制御周期で出力するように
構成したものにおいて、加速区間もしくは減速区間の最
初のステップにおける許容速度を上記産業用ロボットの
各軸毎に予め設定し、上記最初のステップに際して上記
各軸への指令速度と上記許容速度とを比較し、上記指令
速度が上記許容速度よりも大きい場合には、次のトリガ
信号を出力すべき制御周期を上記の許容速度および指令
速度の各位を用いて変更し、変更された制御周期を上記
の加速区間もしくは減速区間の間に亘って保持して１回
目の再生動作を行なうとともに、制御周期の変更により
到達した最大速度に関するデータを記憶し、２回目以降
の再生動作時には、記憶された上記データに基づいて上
記最大速度を演算し、演算した上記最大速度を上記指令
速度に代えて用いることを特徴としている。[Means for Solving the Problems] Therefore, the speed control method for an industrial robot of the present invention as set forth in claim 1 provides an industrial robot that performs a regenerative operation between teaching points, In a device that is configured to output a trigger signal that determines the timing for position control using a dividing point divided into multiple sections as a target position at the required control cycle, the allowable speed in the first step of the acceleration section or deceleration section is The speed is set in advance for each axis of the industrial robot, and in the first step, the commanded speed for each axis is compared with the permissible speed, and if the commanded speed is greater than the permissible speed, the following The control period for outputting the trigger signal is changed using each of the above-mentioned allowable speeds and command speeds, and the changed control period is maintained throughout the above-mentioned acceleration section or deceleration section, and the first regeneration operation is performed. At the same time, data regarding the maximum speed reached by changing the control cycle is stored, and during the second and subsequent regeneration operations, the maximum speed is calculated based on the stored data, and the calculated maximum speed is used as the command. It is characterized by being used in place of speed.
また、請求項２に記載された本発明の産業用ロボットの
速度制御方法は、前述と同様の産業用ロボットにおいて
、加速区間もしくは減速区間の各ステップにおける許容
速度を上記産業用ロボットの各軸毎に予め設定し、上記
の各ステップ毎に、上記各軸への指令速度と上記許容速
度とを比較し、上記指令速度が上記許容速度よりも大き
い場合には、次のトリガ信号を出力すべき制御周期を上
記の許容速度および指令速度の各位を用いて変更しなか
ら１回目の再生動作を行なうとともに、制御周期の変更
により到達した最大速度に関するデータを記憶し、２回
目以降の再生動作時には、記憶された上記データに基づ
いて上記最大速度を演算し、演算した上記最大速度を上
記指令速度に代えて用いることを特徴としている。Further, the speed control method for an industrial robot of the present invention recited in claim 2 is such that, in the same industrial robot as described above, the allowable speed in each step of the acceleration section or the deceleration section is set for each axis of the industrial robot. The command speed for each axis is compared with the permissible speed for each of the above steps, and if the command speed is greater than the permissible speed, the next trigger signal should be output. The first regeneration operation is performed without changing the control cycle using each of the allowable speeds and command speeds described above, and data regarding the maximum speed reached by changing the control cycle is stored, and during the second and subsequent regeneration operations, , the maximum speed is calculated based on the stored data, and the calculated maximum speed is used in place of the command speed.
さらに、請求項３に記載された本発明の産業用ロボット
の速度制御装置は、前述同様の産業用ロボットにおいて
、加速区間もしくは減速区間の最初のステップもしくは
各ステップにおける許容速度を上記産業用ロボットの各
軸毎に予め設定する許容速度設定手段と、上記の最初の
ステップもしくは各ステップに際して上記各軸への指令
速度と上記許容速度とを比較する比較手段と、同比較手
段からの比較結果に基づき上記指令速度が上記許容速度
よりも大きい場合に次のトリガ信号を出力すべき制御周
期を上記の許容速度および指令速度の各位を用いて変更
する制御周期演算手段と、同制御周期演算手段により制
御周期を変更することで到達した最大速度に関するデー
タを１回目の再生動作時に記憶する記憶手段と、２回目
以降の再生動作時に上記記憶手段からの上記データに基
づいて上記最大速度を演算し得られた上記最大速度を上
記指令速度に代えて設定する最大速度演算手段とをそな
えたことを特徴としている。Furthermore, the speed control device for an industrial robot of the present invention as described in claim 3 is a method for controlling the allowable speed at the first step or each step of the acceleration section or the deceleration section in the same industrial robot as described above. A permissible speed setting means that is set in advance for each axis, a comparison means that compares the command speed for each axis with the permissible speed at the first step or each step, and based on the comparison result from the comparison means. Control period calculation means for changing the control period at which the next trigger signal should be output when the command speed is greater than the allowable speed, using each of the allowable speeds and command speeds, and control by the control period calculation means. A storage means for storing data regarding the maximum speed reached by changing the cycle during the first reproducing operation, and calculating the maximum speed based on the data from the storage means during the second and subsequent reproducing operations. The present invention is characterized by further comprising maximum speed calculating means for setting the maximum speed in place of the commanded speed.
［作 用］
上述した本発明に係る請求項］の産業用ロボットの速度
制御方法では、加速区間もしくは減速区間の最初のステ
ップに際して、各軸への指令速度と各軸の許容速度とが
比較され、指令速度が許容速度よりも大きい場合には、
次のトリガ信号を出力すべき制御周期が許容速度および
指令速度の各位を用いて変更（延長）され、変更された
制御周期が加速区間もしくは減速区間の間に亘って保持
されて、緩加減速機能が得られる。以」二の１回目の再
生動作を行なうと同時に、制御周期の変更による最大速
度に関するデータ（例えば指令速度と許容速度との比）
を記憶しておく。そして、２回目以降の再生動作時には
記憶されたデータから上記最大速度を演算しその値を指
令速度に代えて用いる。これにより、１回目の再生動作
時には、制御周期を引き延ばすリアルタイム処理をする
ため、加減速時間は若干増加するが、２回目以降の再生
動作時には、１回目の再生動作時の最大速度を指令速度
とし通常の制御周期で速度制御が実行されることになり
、加減速時間は増加しない。[Operation] In the speed control method for an industrial robot according to the above-mentioned claim of the present invention, the commanded speed for each axis and the allowable speed for each axis are compared at the first step of the acceleration section or the deceleration section. , if the command speed is greater than the allowable speed,
The control period in which the next trigger signal is to be output is changed (extended) using each of the allowable speed and command speed, and the changed control period is maintained throughout the acceleration section or deceleration section, allowing gradual acceleration/deceleration. Functionality is obtained. At the same time as performing the first regeneration operation described in ``2'' above, data regarding the maximum speed due to changing the control cycle (for example, the ratio between the command speed and the allowable speed) is
Remember. Then, during the second and subsequent reproducing operations, the maximum speed is calculated from the stored data and the calculated value is used in place of the command speed. As a result, during the first regeneration operation, the acceleration/deceleration time will increase slightly due to real-time processing that extends the control cycle, but during the second and subsequent regeneration operations, the maximum speed during the first regeneration operation will be used as the command speed. Speed control will be executed in a normal control cycle, and acceleration/deceleration time will not increase.
また、請求項２の産業用ロボットの速度制御方法では、
加速区間もしくは減速区間の各ステップ毎に、各軸への
指令速度と各軸の許容速度とが比較され、指令速度が許
容速度よりも大きい場合には、次のトリガ信号を出力す
べき制御周期が許容速度および指令速度の各位を用いて
変更（延長）されて、緩加減速機能が得られる。前述し
た請求項１の方法と同様、以上の１回目の再生動作を行
なうと同時に、制御周期の変更による最大速度に関する
データを記憶し、２回目以降の再生動作時には記憶され
たデータから上記最大速度を演算しその値を指令速度に
代えて用いる。これにより、１回目の再生動作時には加
減速時間は若干増加するが、２回目以降の再生動作時に
は、１回目の再生−１１＝
動作時の最大速度を指令速度とし通常の制御周期で速度
制御が実行され、加減速時間は増加しない。Further, in the speed control method for an industrial robot according to claim 2,
At each step in the acceleration section or deceleration section, the command speed for each axis is compared with the allowable speed for each axis, and if the command speed is greater than the allowable speed, the control cycle in which the next trigger signal should be output is determined. is changed (extended) using each of the allowable speed and command speed to obtain a slow acceleration/deceleration function. Similar to the method of claim 1 described above, at the same time as the first regeneration operation is performed, data regarding the maximum speed due to the change of the control cycle is stored, and during the second and subsequent regeneration operations, the maximum speed is determined from the stored data. is calculated and the value is used in place of the command speed. As a result, the acceleration/deceleration time increases slightly during the first regeneration operation, but during the second and subsequent regeneration operations, the command speed is set to the maximum speed of the first regeneration - 11 = operation, and speed control is performed in the normal control cycle. is executed, and the acceleration/deceleration time does not increase.
さらに、請求項３の産業用ロボッ）・の速度制御装置は
、前述した請求項１および２の方法を実施するためのも
ので、加速区間もしくは減速区間の最初のステップもし
くは各ステップにおける許容速度が、許容速度設定手段
により産業用ロボットの各軸筋に予め設定され、最初の
ステップもしくは各ステップに際して、比較手段により
各軸への指令速度と上記許容速度とが比較され、指令速
度が許容速度を超えた場合、次のトリガ借りを出力すべ
き制御周期が、制御周期演算手段により許容速度および
指令速度に基づき変更（延長）されて、緩加減速機能が
得られることになる。また、１回目の再生動作時には、
制御周期の変更による最大速度に関するデータが記憶手
段に記憶され、２回目以降の再生動作時には、最大速度
演算手段により記憶手段からのデータに基づき一ヒ記最
大速度が、最大速度演算手段により演算され指令速度と
して設定される。これにより、２回］１以降の再生動作
時には、加減速時間は増加しない。Furthermore, the speed control device for an industrial robot according to claim 3 is for carrying out the methods of claims 1 and 2 described above, and the permissible speed at the first step or each step of the acceleration section or deceleration section is is set in advance for each axis of the industrial robot by the allowable speed setting means, and at the first step or each step, the comparison means compares the commanded speed for each axis with the above-mentioned permissible speed, and determines whether the commanded speed exceeds the permissible speed. If the speed exceeds the limit, the control period in which the next trigger signal should be output is changed (extended) by the control period calculating means based on the allowable speed and the command speed, thereby providing a slow acceleration/deceleration function. Also, during the first playback operation,
Data regarding the maximum speed due to the change of the control cycle is stored in the storage means, and at the time of the second and subsequent reproduction operations, the maximum speed is calculated by the maximum speed calculation means based on the data from the storage means. Set as command speed. As a result, the acceleration/deceleration time does not increase during the regeneration operation after 2nd time]1.
［発明の実施例］
以下、図面により本発明の産業用ロボットの速度制御方
法および装置の実施例について説明する。[Embodiments of the Invention] Hereinafter, embodiments of the speed control method and apparatus for an industrial robot of the present invention will be described with reference to the drawings.
第１図は本発明の産業用ロボットの速度制御方法（請求
項１，２）を実施するための装置（請求項３）を示すブ
ロック図であり、ここでは、本発明の方法を例えば２軸
の関節型溶接ロボットの速度制御に適用した場合を考え
る。FIG. 1 is a block diagram showing an apparatus (claim 3) for carrying out the speed control method for an industrial robot (claims 1 and 2) of the present invention. Consider the case where this method is applied to the speed control of an articulated welding robot.
まず、第１図により本発明の一実施例としての産業用ロ
ボットの速度制御装置について説明する。First, a speed control device for an industrial robot as an embodiment of the present invention will be explained with reference to FIG.
第１図において、１は各軸に接続されたロボット関節駆
動用のモータ２のための指令速度信号（この信号は教示
点間の複数の目標位置に対応するロボット位置指令信号
である）を後述のトリガ信号を受けるたびに出力する演
算装置、３は各モータ２（各軸）の実速度を検出するエ
ンコーダ、４は演算装置１からの指令速度とエンコーダ
３からの実速度との偏差を計数する偏差カウンタ、５は
Ｄ／Ａ変換器、６はドライバ、７は各軸ごとの許容速度
を予め設定する許容速度設定器（許容速度設定手段）、
８は演算装置１からの指令速度と許容速度設定器７から
の許容速度とを比較して指令速度が許容速度よりも大き
い場合に制御周期変更信号を出力しそれ以外で制御周期
不変更信号を出力する比較器（比較手段）、９は所要の
タイミング（制御周期）でロボット位置制御のためのト
リガ信号を演算装置１へ出力する制御周期演算装置（制
御周期演算手段）であるが、この制御周期演算装置９は
比較器８からの制御周期変更信号あるいは制御周期不変
更信号および演算装置１．許容速度設定器７からの信号
を受けるようになっている。In Fig. 1, reference numeral 1 denotes a command speed signal for a motor 2 for driving robot joints connected to each axis (this signal is a robot position command signal corresponding to a plurality of target positions between teaching points), which will be described later. 3 is an encoder that detects the actual speed of each motor 2 (each axis); 4 counts the deviation between the command speed from the calculation device 1 and the actual speed from the encoder 3; 5 is a D/A converter, 6 is a driver, 7 is an allowable speed setter (allowable speed setting means) that presets the allowable speed for each axis,
8 compares the commanded speed from the arithmetic unit 1 and the permissible speed from the permissible speed setter 7, and outputs a control period change signal if the commanded speed is greater than the permissible speed, otherwise outputs a control period unchanged signal. The output comparator (comparison means), 9 is a control period calculation device (control period calculation means) that outputs a trigger signal for robot position control to the calculation device 1 at a required timing (control period). The period calculation device 9 receives the control period change signal or control period unchanged signal from the comparator 8 and the calculation device 1. It receives a signal from the allowable speed setting device 7.
また、１０は制御周期演算装置９により制御周期を変更
することで到達した最大速度に関するデータ（制御周期
を演算する際に用いられたもので、 ゛本実施例では
指令速度と許容速度との比）を１回目の再生動作時に記
憶する記憶部（記憶手段）である。そして、本実施例に
おいて、演算装置１は、２回目以降の再生動作時に記憶
部１０からのデータに基づいて最大速度を演算し得られ
た値を指令速度に代えて設定する最大速度演算手段とし
ての機能をそなえている。Further, 10 is data regarding the maximum speed reached by changing the control cycle by the control cycle calculation device 9 (used when calculating the control cycle, and in this embodiment, the ratio between the command speed and the allowable speed) ) at the first reproduction operation. In this embodiment, the calculation device 1 functions as a maximum speed calculation means that calculates the maximum speed based on the data from the storage unit 10 during the second and subsequent playback operations and sets the obtained value instead of the command speed. It has the following functions.
吹に、上述の装置を用いて実施される本発明の第１実施
例（請求項１による実施例）としての産業用ロボットの
速度制御方法について詳細に説明するが、本実施例では
、指令速度への加速制御もしくは減速制御を、３２ユニ
ツト（３２ステツプ）、０．３２ｓｅｃで行なうものと
する。First, a method for controlling the speed of an industrial robot as a first embodiment (embodiment according to claim 1) of the present invention, which is implemented using the above-mentioned device, will be described in detail. It is assumed that acceleration control or deceleration control is performed in 32 units (32 steps) and 0.32 seconds.
まず、第２図により、ゼロから指令速度への加速区間に
おける制御手順を説明すると、各許容速度設定器７には
、加速区間の第１ステツプにおける許容速度（各軸の許
容速度Ｖｍａｘの１／３２）を予め設定しておく。First, the control procedure in the acceleration section from zero to the command speed will be explained with reference to FIG. 32) is set in advance.
そして、演算装置１から出力された各軸への指令速度Ｖ
。に基づき座標変換により求まった制御周期当たりの各
軸のモータ移動量ΔＬと、各許容速度設定器７に設定さ
れた第１ステツプの許容速度Ｖｍａｘ／３２とを比較器
８により比較し、モータ移動量ΔＬが許容速度Ｖｍａｘ
／３２よりも大きい場合には、その大きさに比例して、
通常、２０！ｌ１ｓｅｃの制御＝１５−
周期を引き延ばす。例えば、指令速度Ｖ。に関連するモ
ータ移動量ΔＬと、許容速度Ｖ ｍａｘに関連する第１
ステツプの許容速度Ｖｍａｘ／３２とから、制御周期演
算装置９において、
（ΔＬ ／ （Ｖ ｍａｘ／３２）） ・２０＝（３２
・ΔＬ ／ Ｖｍａｘ）・２０（ｍｓｅｃ）を演算して
、次のトリガ信号の出力時を、２０ｍ５ｅｃから例えば
３０ｍ５ｅｃに引き延ばす。Then, the command speed V for each axis output from the calculation device 1
. The comparator 8 compares the motor movement amount ΔL of each axis per control cycle obtained by coordinate transformation based on the 1st step allowable speed Vmax/32 set in each allowable speed setter 7, and determines the motor movement. The amount ΔL is the allowable speed Vmax
/32, in proportion to the size,
Usually 20! l1sec control = 15- lengthen the period. For example, command speed V. motor movement amount ΔL related to
From the allowable speed of the step Vmax/32, the control cycle calculation device 9 calculates (ΔL/(Vmax/32)) ・20=(32
・ΔL/Vmax)・20 (msec) is calculated to extend the output time of the next trigger signal from 20 m5ec to, for example, 30m5ec.
その後、第２ステツプ以降は、上式により求まった第１
ステツプの制御周期（例えば３０ｍ５ｅｃ）を維持し、
３２ステツプ後には、通常の最高速度自動設定機能に移
行して許容速度Ｖ ｍａｘでの駆動制御を行なう。After that, from the second step onward, the first
Maintain the control cycle of the step (for example, 30m5ec),
After 32 steps, the routine shifts to the normal maximum speed automatic setting function and drive control is performed at the allowable speed V max.
また、第３図により、前述の指令速度からゼロへの減速
区間における制御手順を説明すると、減速区間の第１ス
テツプにおいて、減速区間直前（３２ユニツト）の制御
周期での各軸のモータ移動量ΔＬ（演算装置１からの出
力）と、許容速度設定器８に設定された各軸の許容速度
Ｖｍａｘとを比較器８により比較し、モータ移動量ΔＬ
が許容速度Ｖｍａｘよりも大きい場合には、加速区間の
場合と同様に、その大きさに比例して、通常、２０ｍ５
ｅｃの制御周期を引き延ばし、例えば３０ｎｓｅｃとす
る。そして、第２ステツプ以降は、この第１ステツプの
制御周期３０ｍ５ｅｃを維持して制御を行なう。ただし
、同時に通常の最高速度自動設定機能も作動させ、これ
により求まった制御周期が３０ｍ５ｅｃを上回った場合
（例えば３２ｍ５ｅｃ）には、それを優先的に使用する
。In addition, to explain the control procedure in the deceleration period from the command speed to zero mentioned above with reference to FIG. The comparator 8 compares ΔL (output from the calculation device 1) with the allowable speed Vmax of each axis set in the allowable speed setter 8, and calculates the motor movement amount ΔL.
is larger than the permissible speed Vmax, as in the case of the acceleration section, the speed is normally 20m5 in proportion to its size.
The control cycle of ec is extended to, for example, 30 nsec. From the second step onward, control is performed while maintaining the control period of 30 m5ec of the first step. However, at the same time, the normal maximum speed automatic setting function is activated, and if the control period determined thereby exceeds 30 m5ec (for example, 32m5ec), it is used preferentially.
以上のようにして、１回目の再生動作を行なうが、この
とき、指令速度Ｖ。と許容速度ｖＩＩｌａｘとの比（指
令速度Ｖ。を１５０ｍ／ｍｉｎ、許容速度Ｖ ｍａｘを
１００ｍ／ｌｌ１ｉｎとすると、１５０／１００ ＝
１．５）を、記憶部１０に記憶しておく。As described above, the first regeneration operation is performed, and at this time, the command speed V. and the allowable speed vIIlax (if the command speed V is 150 m/min and the allowable speed V max is 100 m/ll1in, then 150/100 =
1.5) is stored in the storage unit 10.
そして、２回目以降の再生動作時には、演算装置１にお
いて、記憶された比に基づき最大速度（通常に許容速度
Ｖｍａｘ対応する）を演算する。つまり、指令速度Ｖ。Then, during the second and subsequent reproduction operations, the calculation device 1 calculates the maximum speed (usually corresponding to the allowable speed Vmax) based on the stored ratio. In other words, the command speed V.
を比（ｉ、ｓ）で除算する。演算装置１は、こうして得
られた値を指令速度ｖ０に代えて出力して、以降の速度
制御を通常の制御周期（２０ｍｓｅｃ）にて実行する。Divide by the ratio (i,s). The arithmetic device 1 outputs the value thus obtained in place of the command speed v0, and executes subsequent speed control at a normal control cycle (20 msec).
ついで、上述の装置を用いて実施される本発明の第２実
施例（請求項２による実施例）としての産業用ロボット
の速度制御方法について詳細に説明する。Next, a method for controlling the speed of an industrial robot as a second embodiment (an embodiment according to claim 2) of the present invention, which is implemented using the above-mentioned device, will be described in detail.
まず、ゼロから指令速度への加速区間においては、各許
容速度設定器７に、加速区間の第１−ステラプル第３２
ステップまでの各ステップにおける許容速度を予め設定
しておく。つまり、第２図に示すように、第１ステツプ
では］ユニツ１−１第２ステップでは２ユニツト等のよ
うに、速度ユニツ１〜の全速３２ユニツ１〜に占める割
合で、第１ステツプから順に、Ｖｍａｘ／３２．２・Ｖ
ｍａｘ／３２．−、 Ｖｍａｘと許容速度を設定する。First, in the acceleration section from zero to the command speed, each allowable speed setter 7 is set to
The allowable speed for each step is set in advance. That is, as shown in Fig. 2, in the first step, the units 1-1, in the second step, 2 units, etc., in order from the first step, in proportion to the total speed 32 units 1-, speed units 1-1, etc. , Vmax/32.2・V
max/32. −, Set Vmax and allowable speed.
そして、各ステップ毎に、演算装置」から出力された各
軸への指令速度Ｖ。に基づき座標変換により求まった制
御周期当たりの各軸のモータ移動量ΔＬと、各許容速度
設定器７に設定された各ステップの許容速度（Ｖｍａｘ
／３２．２・Ｖ＋ｎａｘ／３２． ・。Then, for each step, the command speed V for each axis is output from the arithmetic unit. The motor movement amount ΔL of each axis per control cycle determined by coordinate transformation based on
/32.2・V+nax/32.・.
Ｖｍａｘ）とを比較器８により比較し、モータ移動量Δ
Ｌが許容速度よりも大きい場合には、制御周期演算装置
９により、指令速度Ｖ。に関連するモータ移動量ΔＬと
、許容速度Ｖｍａｘに関連する各ステップの許容速度と
を用いて、通常の制御周期を引き処ばす。Vmax) by the comparator 8, and the motor movement amount Δ
If L is larger than the allowable speed, the control cycle calculation device 9 determines the command speed V. The normal control cycle is concluded using the motor movement amount ΔL related to the motor movement amount ΔL and the allowable speed of each step related to the allowable speed Vmax.
例えば、各軸のモータが最高３０００ｒｐｍ 、 ８０
００パ＃ス／ＩＰ１転とすると、最高速度は、（３０（
１０／６０） ｘ８００〇二４０００００パルス／ｓｅ
ｅであり、制御周期２０ｍ５ｅｃ当たりでは、４０００
００ Ｘ （２０／１．０００） ＝ ８０００パルス
となる。通常の最高速度自動設定機能では、座標演算か
ら求まった各軸の移動量が、この８０００パルスを上回
り、例えば、］、００００パルスとなった場合には、１
．００００／８０００の比率で制御周期を引き延ばして
、２０ Ｘ （１，００００／８０００） ＝ ２５ｍ
５ｅｃの周期で制御するが、加速区間では、全速度ユニ
ットが３２ユニノＩ〜で、今その加速ステップでの速度
が１６ユニツトであるとすれば、各軸の制御周期内の最
高移動量（許容速度設定器７に設定される第１６ステツ
プの許容速度）を８０００ Ｘ （１，６／３２） ＝
４０００パルスとして同様の制御を行なう。即ち、１
．００００パルスに対しては、２゜Ｘ （１００００／
４０００） ＝ ５０ｍ５ｅｃの周期で制御を行なう。For example, the motor of each axis has a maximum speed of 3000 rpm, 80
Assuming 00 passes/1 IP transfer, the maximum speed is (30(
10/60) x800〇2 400000 pulses/se
e, and per control period of 20m5ec, 4000
00 x (20/1.000) = 8000 pulses. With the normal maximum speed automatic setting function, if the amount of movement of each axis determined from coordinate calculation exceeds this 8000 pulses, for example, ], 0000 pulses, 1
．． By extending the control period at a ratio of 0000/8000, 20 x (1,0000/8000) = 25m
Control is performed at a cycle of 5ec, but in the acceleration period, if all speed units are 32 units and the current speed at that acceleration step is 16 units, the maximum movement amount (allowable) within the control cycle of each axis The allowable speed of the 16th step set in the speed setting device 7) is 8000 x (1,6/32) =
Similar control is performed using 4000 pulses. That is, 1
．． For 0000 pulses, 2°X (10000/
4000) = Control is performed at a cycle of 50 m5ec.
このとき、演算装置１は、次のステップが全ユニット（
例えば３２ユニツ１−）に列して何ユニットであるかの
（そのステップでのユニソ１−／全ユニソ１−）の比を
出力するか、または、全ユニソ１へ数と第何ステップで
あるかを出力する。At this time, the arithmetic device 1 determines that the next step is for all units (
For example, output the ratio of how many units there are (Uniso 1-/All Uniso 1- at that step) in line with 32 Units 1-), or output the number and number of steps to all Uniso 1. output.
このようにして、制御周期演算装置９が制御周期を引き
延ばしてトリガ信号を出力し、加速区間製終了した後に
は、通常の最高速度自動設定機能に移行して許容速度Ｖ
ｍａｘでの駆動制御を行なう。In this way, the control cycle calculation device 9 extends the control cycle and outputs a trigger signal, and after completing the acceleration period, the control cycle is shifted to the normal maximum speed automatic setting function and the allowable speed V
Drive control is performed at max.
また、前述の指令速度からゼロへの減速区間においては
、上述した加速区間の場合と同様に、各ステップにおけ
る速度ユニッ１〜数と金ユニット数との比で、その減速
ステップにおける適正な最高速度を求め、この値を用い
て座標演算から求まるモータ移動量がこの値を上回る場
合には、制御周期演算装置９において、その比により制
御周期を引き延ばす。In addition, in the deceleration section from the command speed to zero described above, as in the case of the acceleration section described above, the appropriate maximum speed at that deceleration step is determined by the ratio of the speed unit 1 to number and the number of gold units at each step. If the motor movement amount determined from the coordinate calculation using this value exceeds this value, the control cycle calculation device 9 extends the control cycle by the ratio.
以上のようにして、１回目の再生動作な行なうが、この
とき、第２実施例では、各ステップイσに許容速度が設
定されているので、各ステップ毎に指令速度と許容速度
との比が得られるが、この第２実施例では、複数の比の
平均値、最初の値、中間の値、最後の値等何らかの代表
値を、データとして記憶部１０に記憶しておく。As described above, the first regeneration operation is performed. At this time, in the second embodiment, since the allowable speed is set for each step σ, the ratio between the command speed and the allowable speed is determined for each step. However, in this second embodiment, some representative values such as the average value, first value, middle value, last value, etc. of a plurality of ratios are stored as data in the storage unit 10.
そして、２回目以降の再生動作時には、第１実施例と同
様、演算装Ｗ１は、記憶された比で指令速度Ｖ。を除算
して最大速度（通常に許容速度Ｖ ｍａｘ対応する）を
演算し、その値を指令速度Ｖ。Then, during the second and subsequent regeneration operations, similarly to the first embodiment, the arithmetic unit W1 sets the command speed V using the stored ratio. The maximum speed (corresponding to the normal allowable speed V max) is calculated by dividing the value, and the value is set as the command speed V.
に代えて出力して、以降の速度制御を通常の制御周期（
２０ｍｓｅｃ）にて実行する。is output instead of , and subsequent speed control is performed using the normal control cycle (
20 msec).
なお、演算装置１は、次の点までの移動パルスを出力し
、このパルスに従って偏差カウンタ４がゼロになる方向
にモータ２を制御する構成になっている。そして、指令
速度に相当するパルス数の出力（上記モータ移動量に対
応する）が通常は予め定められた制御周期（例えば２０
ｍ５ｅｃ）毎に行なわれるが、このパルスが加減速区間
の第１ステツプもしくは各ステップにおける各軸筋の許
容速度に相当するパルスを」１回る場合、制御周期演算
装置９により、前記式等に基づく演算を行ない、適正周
期（例えば３０ｍ５ｅｃ）を得て、上記適正周期毎に１
−リガ信号を出力し、演算装置１から次の指令パルスを
出力する構ｌ戊となっている。Note that the arithmetic device 1 is configured to output a pulse for moving to the next point, and control the motor 2 in the direction in which the deviation counter 4 becomes zero in accordance with this pulse. Then, the output of the number of pulses corresponding to the command speed (corresponding to the amount of motor movement mentioned above) is normally set at a predetermined control period (for example, 20
m5ec), but if this pulse goes around once the pulse corresponding to the permissible speed of each axis muscle in the first step or each step of the acceleration/deceleration section, the control period calculation device 9 calculates the Perform the calculation to obtain an appropriate cycle (for example, 30m5ec), and then calculate 1 for each appropriate cycle.
- The configuration is such that the trigger signal is output, and the next command pulse is output from the arithmetic device 1.
また、第１図に示すものは、ロボットが２軸の場合であ
るが、その他多軸のロボットにも、また、極座標ロボッ
ト、円筒座標ロボット、直交座標ロボット、多関節ロボ
ットにも同様にして、本方法の適用が可能である。また
、本方法は、ＦＴＰ制御、ＣＰ制御等を問わず同様に適
用される。In addition, although the robot shown in Fig. 1 is a two-axis robot, other multi-axis robots, polar coordinate robots, cylindrical coordinate robots, Cartesian coordinate robots, and articulated robots can also be used in the same way. This method can be applied. Moreover, this method is similarly applied regardless of FTP control, CP control, etc.
以上のように、第１．第２いずれの実施例によっても、
緩加減速機能が得られ、第４図に示すように（１回目の
再生動作時は図中の実線、２回目以降の再生動作時は図
中の一点鎖線）、指令速度ｖｏが許容速度Ｖ ｍａｘを
超えた場合に、従来のようなエツジを発生させることな
く速度制御が行なわれ、エツジによる振動発生が確実に
防止されるので、ロボットの制御精度が大幅に向上する
。As mentioned above, the first. According to any of the second embodiments,
A slow acceleration/deceleration function is obtained, and as shown in Fig. 4 (the solid line in the figure during the first regeneration operation, and the dashed-dotted line in the figure during the second and subsequent regeneration operations), the command speed vo becomes the allowable speed V. When the speed exceeds max, speed control is performed without generating edges as in the conventional case, and vibration generation due to edges is reliably prevented, so the control accuracy of the robot is greatly improved.
また、第１．第２実施例のいずれも、加減速時に最初の
ステップあるいは各ステップ毎に各軸の指令速度Ｖ。が
許容速度Ｖｍａｘを上回っている比率だけ制御周期を引
き延ばすために、第４図に示すように、１回目の再生動
作時の加減速時間は本来の加減速時間よりも若干長くな
ってしまう。しかも、１回目の再生動作時にはリアルタ
イムで制御処理を行なっているので、教示された指令速
度による合成移動速度を見なおすことは無理である。Also, 1st. In both of the second embodiments, the command speed V of each axis is determined at the first step or at each step during acceleration/deceleration. In order to extend the control period by the ratio that exceeds the allowable speed Vmax, the acceleration/deceleration time during the first regeneration operation becomes slightly longer than the original acceleration/deceleration time, as shown in FIG. Moreover, since control processing is performed in real time during the first reproduction operation, it is impossible to review the composite movement speed based on the taught command speed.
しかし、２回目以降の再生動作時には、１回目の再生動
作時に制御周期を引き延ばすために用いた比率を記憶し
ておくことで、合成移動速度を見なおすことは可能であ
る。本発明はこの点に着目したものである。However, during the second and subsequent reproducing operations, it is possible to review the composite movement speed by storing the ratio used to extend the control cycle during the first reproducing operation. The present invention focuses on this point.
例えば、指令速度を１５０ｍ／ｍｉｎ、ロボットのある
姿勢、移動方向による限界の移動速度つまり許容速度が
１００ｍ／ｍｉｎとし、加速時間が本来０．３２ｓｅｃ
であるとすると、前述した第１．第２実施例のいずれに
よっても、１回目の再生動作時の加減速時間は、第４図
に実線で示すように、０．３２ ｘ （１５０／１ｏｏ
）＝ ０．４８ｓｅｃとなり、０．１６ｓｅｃだけ延び
たことになる。For example, suppose the command speed is 150 m/min, the limit movement speed depending on the robot's posture and direction of movement, that is, the allowable speed, is 100 m/min, and the acceleration time is originally 0.32 sec.
Assuming that, the above-mentioned 1. In any of the second embodiments, the acceleration/deceleration time during the first regeneration operation is 0.32 x (150/1oo
) = 0.48 sec, which means that it has been extended by 0.16 sec.
なお、実際には最初のステップもしくは各ステラプでの
各軸の許容速度と指令速度との比で求められるが、以」
−の説明では、説明を容易にするため簡略化して記載し
ている。In reality, it is determined by the ratio of the allowable speed of each axis and the command speed at the first step or each step, but as follows.
In the explanation of -, the description is simplified for ease of explanation.
そこで、１回目の再生動作時に制御周期を１．５倍に引
き延ばしたこと（比１．５）を記憶部１０に記憶してお
き、２回目以降の再生動作時には、演算装置１により、
加減速時のみは指令速度を記憶された比にて除算しくつ
まり、１５０／］、、５＝１００）、１回目の再生動作
時の最大速度１００ｍ／耐ｎを求める。そして、指令速
度１５０ｍ／ｍｉｎに代えて速度Ｌｏｏｍ／ｍｉｎを指
令速度として設定・出力し、以後の制御は通常の制御周
期にて実行する。Therefore, the fact that the control period has been extended by 1.5 times (ratio 1.5) is stored in the storage unit 10 during the first regeneration operation, and during the second and subsequent regeneration operations, the arithmetic unit 1
Only during acceleration/deceleration, the commanded speed is divided by the stored ratio (ie, 150/], 5=100) to find the maximum speed of 100 m/distance n during the first regeneration operation. Then, instead of the commanded speed of 150 m/min, the speed Loom/min is set and output as the commanded speed, and subsequent control is executed in the normal control cycle.
これにより、２回目以降の再生動作時には、制御周期を
引き延ばす必要がなくなり、第４図に一点鎖線で示すよ
うに、加減速時間は本来の時間（０，３２ｓｅｃ）とな
るのである。This eliminates the need to extend the control period during the second and subsequent regeneration operations, and the acceleration/deceleration time remains the original time (0.32 sec), as shown by the dashed line in FIG.
なお、実際には、２回目以降の再生動作時であっても、
各ステップ毎の状況、事情により、いくつかのステップ
ではわずかながら制御周期を引き延ばす場合もあるが、
本実施例によれば、１回目の加減速時間に比べて２回目
以降の加減速時間が本来の時間にかなり近づくことには
相違ない。In fact, even during the second and subsequent playback operations,
Depending on the situation and circumstances of each step, the control cycle may be slightly extended in some steps.
According to this embodiment, there is no doubt that the second and subsequent acceleration/deceleration times are much closer to the original time than the first acceleration/deceleration times.
また、２回目以降の再生動作においても、加減速区間を
除く本来一定速度で移動すべき区間は、教示された合成
移動速度（指令速度）をそのまま用いる。これは、移動
途中で速度の引き出せる区間では速度を最大限に引き出
すためである。Also, in the second and subsequent reproducing operations, the taught synthetic movement speed (command speed) is used as is for the sections that should originally move at a constant speed except for the acceleration/deceleration sections. This is to maximize speed during sections where speed can be maximized.
さらに、偏差カウンタ４に入るパルス列を等間隔にした
方がサーボ制御上有利であるので、第１図の装置に代え
て第５図に示すような構成の装置を用いてもよい。この
第５図に示すものでは、次の補間点までの移動パルス数
を主演算装置ＩＡ（第１図に示した演算装置１と同様に
最大速度演算手段の機能も兼ねる）から出力し、これを
比較器８Ａにより許容速度を上回っていないかチエツク
し、もし上回っている場合は制御周期演算装置９にて適
正な制御周期を演算し、これにより主演算装置ＩＡに対
しては次のトリガ信号を遅らせる一方、サーボ演算装置
１］、に対しては制御周期演算装置９から等間隔のパル
ス列を作り出すデータとして制御周期を出力させるよう
にする。このようにすれば、偏差カウンタ４に入るパル
ス列を等間隔にしながら、本方法を実施することが可能
である。また、第５図の装置では、許容速度設定器７Ａ
に設定される許容速度は一定値でなく、状態に応じて主
演算装置ＩＡからの信号により変更できるようになって
いる。Further, since it is more advantageous for servo control to make the pulse train input to the deviation counter 4 at equal intervals, a device having a configuration as shown in FIG. 5 may be used in place of the device shown in FIG. 1. In the system shown in Fig. 5, the number of moving pulses to the next interpolation point is output from the main processing unit IA (which also functions as the maximum speed calculation means, similar to the processing unit 1 shown in Fig. 1). The comparator 8A checks whether the speed exceeds the allowable speed, and if it does, the control cycle calculating device 9 calculates an appropriate control period, and then the next trigger signal is sent to the main processing device IA. While delaying the servo calculation device 1], the control period calculation device 9 outputs the control period as data for producing a pulse train at equal intervals. In this way, it is possible to implement the present method while making the pulse train entering the deviation counter 4 equally spaced. In addition, in the device shown in FIG. 5, the allowable speed setting device 7A
The allowable speed set is not a constant value, but can be changed depending on the state by a signal from the main processing unit IA.
［発明の効果］
以上詳述したように、本発明の請求項１および請求項２
のいずれの産業用ロボットの速度制御方法によっても、
緩加減速機能が得られるとともに、２回目以降の再生動
作時には１回目の再生動作時の最大速度を指令速度とし
通常の制御周期で速度制御を実行できるので、エツジに
よる振動発生が確実に防止されて、ロボットの制御精度
が大幅に向上するとともに、２回目以降の再生動作時に
は、教示された指令速度を変更する学習制御的な機能が
得られ、加減速時間の増加を防止できる効果がある。[Effect of the invention] As detailed above, claims 1 and 2 of the present invention
Depending on the speed control method of any industrial robot,
In addition to providing a slow acceleration/deceleration function, during the second and subsequent regeneration operations, the maximum speed during the first regeneration operation is used as the command speed, and speed control can be executed at the normal control cycle, so vibrations caused by edges are reliably prevented. As a result, the control accuracy of the robot is greatly improved, and during the second and subsequent reproduction operations, a learning control-like function is obtained to change the taught command speed, which has the effect of preventing an increase in acceleration/deceleration time.
また、本発明の請求項３の産業用ロボットの速度制御装
置によれば、請求項１もしくは請求項２による方法を実
施することができ、緩加減速機能が得られ、また、２回
目以降の再生動作時には１回目の再生動作時の最大速度
を指令速度とし通常の制御周期で速度制御を実行できる
ように構成されているので、請求項１および２の方法と
同様に、エツジによる振動発生が確実に防止されて、ロ
ボットの制御精度が大幅に向上するとともに、２回目以
降の再生動作時には、教示された指令速度を変更する学
習制御的な機能が得られ、加減速時間の増加を防止でき
る効果がある。Further, according to the speed control device for an industrial robot according to claim 3 of the present invention, the method according to claim 1 or claim 2 can be implemented, a gradual acceleration/deceleration function can be obtained, and During the regeneration operation, the maximum speed during the first regeneration operation is set as the command speed, and the speed control is executed in a normal control cycle, so that, as in the methods of claims 1 and 2, vibrations caused by the edges are prevented. This is reliably prevented, greatly improving the control accuracy of the robot, and during the second and subsequent replay operations, a learning control-like function is provided to change the taught command speed, preventing increases in acceleration/deceleration time. effective.
第１〜５図は本発明の産業用ロボットの速度制御方法お
よび装置の実施例を示すもので、第１図は本発明の産業
用ロボットの速度制御方法を実施するための装置を示す
ブロック図、第２，３図はいずれも本実施例の動作を説
明するためのグラフ、第４図は本実施例の効果を説明す
るためのグラフ、第５図は本方法を実施するための装置
の変形例を示すブロック図であり、第６図はアーク溶接
ロボツトによる溶接工程を示した模式図、第７図は従来
の産業用ロボットの速度制御手段による動作を説明する
ためのグラフである。
１・・−演算装置（最大速度演算手段）、ＩＡ−主演算
装置（最大速度演算手段）、２−モータ、３−・エンコ
ーダ、４−・偏差カウンタ、５−Ｄ ／ Ａ変換器、６
・・−ドライバ、７，７Ａ−・許容速度設定器（許容速
度設定手段）、８．８Ａ、−比較器（比較手段）、９・
・・制御周期演算装置（制御周期演算手段）、１０・−
・記憶部（記憶手段）、１１−サーボ演算装置。
なお、図中、同一の符号は同一、又は相当部分を示して
いる。
特許出願人 株式会社 神戸製鋼所1 to 5 show an embodiment of the speed control method and device for an industrial robot according to the present invention, and FIG. 1 is a block diagram showing the device for implementing the speed control method for an industrial robot according to the present invention. , Figures 2 and 3 are graphs for explaining the operation of this embodiment, Figure 4 is a graph for explaining the effects of this embodiment, and Figure 5 is a graph of an apparatus for implementing the method. FIG. 6 is a schematic diagram showing a welding process by an arc welding robot, and FIG. 7 is a graph for explaining the operation by a speed control means of a conventional industrial robot. 1--Arithmetic unit (maximum speed calculation means), IA-main calculation unit (maximum speed calculation means), 2-Motor, 3--Encoder, 4--Deviation counter, 5-D/A converter, 6
...-Driver, 7,7A--Allowable speed setter (allowable speed setting means), 8.8A, -Comparator (comparison means), 9-
...Control period calculation device (control period calculation means), 10.-
- Storage unit (storage means), 11-servo arithmetic device. In addition, in the figures, the same reference numerals indicate the same or corresponding parts. Patent applicant: Kobe Steel, Ltd.
Claims (3)
、上記教示点間を複数の区間に分割する分割点を目標位
置として位置制御するためのタイミングを決めるトリガ
信号を所要の制御周期で出力するように構成したものに
おいて、加速区間もしくは減速区間の最初のステップに
おける許容速度を上記産業用ロボットの各軸毎に予め設
定し、上記最初のステップに際して上記各軸への指令速
度と上記許容速度とを比較し、上記指令速度が上記許容
速度よりも大きい場合には、次のトリガ信号を出力すべ
き制御周期を上記の許容速度および指令速度の各値を用
いて変更し、変更された制御周期を上記の加速区間もし
くは減速区間の間に亘って保持して１回目の再生動作を
行なうとともに、制御周期の変更により到達した最大速
度に関するデータを記憶し、２回目以降の再生動作時に
は、記憶された上記データに基づいて上記最大速度を演
算し、演算した上記最大速度を上記指令速度に代えて用
いることを特徴とする産業用ロボットの速度制御方法。(1) An industrial robot that performs regenerative motion between teaching points, and a trigger signal that determines the timing for position control with dividing points that divide the teaching points into a plurality of sections as target positions at the required control cycle. In a device configured to output, the allowable speed in the first step of the acceleration section or deceleration section is set in advance for each axis of the industrial robot, and the command speed for each axis and the above allowable speed are set in advance for each axis of the industrial robot. If the commanded speed is greater than the allowable speed, the control cycle in which the next trigger signal should be output is changed using the values of the allowable speed and commanded speed. The first regeneration operation is performed by holding the control period between the above acceleration or deceleration periods, and data regarding the maximum speed reached by changing the control period is stored, and during the second and subsequent regeneration operations, A speed control method for an industrial robot, characterized in that the maximum speed is calculated based on the stored data, and the calculated maximum speed is used in place of the command speed.
、上記教示点間を複数の区間に分割する分割点を目標位
置として位置制御するためのタイミングを決めるトリガ
信号を所要の制御周期で出力するように構成したものに
おいて、加速区間もしくは減速区間の各ステップにおけ
る許容速度を上記産業用ロボットの各軸毎に予め設定し
、上記の各ステップ毎に、上記各軸への指令速度と上記
許容速度とを比較し、上記指令速度が上記許容速度より
も大きい場合には、次のトリガ信号を出力すべき制御周
期を上記の許容速度および指令速度の各値を用いて変更
しながら１回目の再生動作を行なうとともに、制御周期
の変更により到達した最大速度に関するデータを記憶し
、２回目以降の再生動作時には、記憶された上記データ
に基づいて上記最大速度を演算し、演算した上記最大速
度を上記指令速度に代えて用いることを特徴とする産業
用ロボットの速度制御方法。(2) An industrial robot that performs regenerative motion between teaching points, in which a trigger signal that determines the timing for position control with dividing points that divide the teaching points into a plurality of sections as target positions is sent at the required control cycle. In a device configured to output, the allowable speed in each step of the acceleration section or deceleration section is set in advance for each axis of the industrial robot, and the command speed for each axis and the above are set in advance for each step of the industrial robot. Compare the above command speed with the allowable speed, and if the above command speed is larger than the above allowable speed, the control cycle in which the next trigger signal should be output is changed for the first time using each value of the above allowable speed and command speed. At the same time, data regarding the maximum speed reached by changing the control cycle is stored, and during the second and subsequent regeneration operations, the maximum speed is calculated based on the stored data, and the calculated maximum speed is calculated. A method for controlling the speed of an industrial robot, characterized in that the command speed is used in place of the command speed.
、上記教示点間を複数の区間に分割する分割点を目標位
置として位置制御するためのタイミングを決めるトリガ
信号を所要の制御周期で出力するように構成したものに
おいて、加速区間もしくは減速区間の最初のステップも
しくは各ステップにおける許容速度を上記産業用ロボッ
トの各軸毎に予め設定する許容速度設定手段と、上記の
最初のステップもしくは各ステップに際して上記各軸へ
の指令速度と上記許容速度とを比較する比較手段と、同
比較手段からの比較結果に基づき上記指令速度が上記許
容速度よりも大きい場合に次のトリガ信号を出力すべき
制御周期を上記の許容速度および指令速度の各値を用い
て変更する制御周期演算手段と、同制御周期演算手段に
より制御周期を変更することで到達した最大速度に関す
るデータを１回目の再生動作時に記憶する記憶手段と、
２回目以降の再生動作時に上記記憶手段からの上記デー
タに基づいて上記最大速度を演算し得られた上記最大速
度を上記指令速度に代えて設定する最大速度演算手段と
がそなえられたことを特徴とする産業用ロボットの速度
制御装置。(3) An industrial robot that performs a regenerative operation between teaching points, in which a trigger signal that determines the timing for position control using dividing points that divide the teaching points into a plurality of sections as a target position is transmitted at a required control cycle. In the apparatus configured to output the output, an allowable speed setting means for presetting the allowable speed at the first step or each step of the acceleration section or the deceleration section for each axis of the industrial robot; Comparison means for comparing the commanded speed to each axis with the permissible speed during the step, and a next trigger signal to be output when the commanded speed is greater than the permissible speed based on the comparison result from the comparison means. A control period calculation means for changing the control period using each value of the above-mentioned allowable speed and command speed, and data regarding the maximum speed reached by changing the control period by the control period calculation means at the time of the first regeneration operation. A memory means for remembering,
A maximum speed calculation means is provided for calculating the maximum speed based on the data from the storage means and setting the obtained maximum speed in place of the command speed during the second and subsequent reproduction operations. Speed control device for industrial robots.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP63119288A JP2688491B2 (en) | 1988-05-18 | 1988-05-18 | Industrial robot speed control method and apparatus |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP63119288A JP2688491B2 (en) | 1988-05-18 | 1988-05-18 | Industrial robot speed control method and apparatus |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH01290007A true JPH01290007A (en) | 1989-11-21 |
| JP2688491B2 JP2688491B2 (en) | 1997-12-10 |
Family
ID=14757691
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP63119288A Expired - Fee Related JP2688491B2 (en) | 1988-05-18 | 1988-05-18 | Industrial robot speed control method and apparatus |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2688491B2 (en) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008299426A (en) * | 2007-05-29 | 2008-12-11 | Ricoh Co Ltd | Servo control unit, method and program, and ink jet recording device |
| CN110900607A (en) * | 2019-12-09 | 2020-03-24 | 中建科技有限公司深圳分公司 | Robot control method and device |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS53123787A (en) * | 1977-04-05 | 1978-10-28 | Toyota Motor Corp | Travelling speed correction instruction for a method and its apparatus multiaxial direction moving body and memory regenerating |
| JPS5779510A (en) * | 1980-10-31 | 1982-05-18 | Mitsubishi Electric Corp | Numeric controller |
| JPS6380307A (en) * | 1986-09-25 | 1988-04-11 | Kobe Steel Ltd | Speed control method for industrial robot |
-
1988
- 1988-05-18 JP JP63119288A patent/JP2688491B2/en not_active Expired - Fee Related
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS53123787A (en) * | 1977-04-05 | 1978-10-28 | Toyota Motor Corp | Travelling speed correction instruction for a method and its apparatus multiaxial direction moving body and memory regenerating |
| JPS5779510A (en) * | 1980-10-31 | 1982-05-18 | Mitsubishi Electric Corp | Numeric controller |
| JPS6380307A (en) * | 1986-09-25 | 1988-04-11 | Kobe Steel Ltd | Speed control method for industrial robot |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008299426A (en) * | 2007-05-29 | 2008-12-11 | Ricoh Co Ltd | Servo control unit, method and program, and ink jet recording device |
| CN110900607A (en) * | 2019-12-09 | 2020-03-24 | 中建科技有限公司深圳分公司 | Robot control method and device |
| CN110900607B (en) * | 2019-12-09 | 2021-03-02 | 中建科技有限公司深圳分公司 | Robot control method and device |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2688491B2 (en) | 1997-12-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3900789B2 (en) | Motor speed / acceleration determination method, acceleration / deceleration generation method, acceleration / deceleration control method, acceleration / deceleration control device, and motor control device | |
| JP6126152B2 (en) | Robot trajectory generator for generating trajectories having curved portions | |
| KR910009266B1 (en) | Speed control method for industrial robot | |
| US6920363B2 (en) | Acceleration and deceleration control method | |
| WO1989006066A1 (en) | Method of speed control for servomotor | |
| WO1991003009A1 (en) | Acceleration/deceleration control method of numeric controller | |
| JPH01290007A (en) | Method and device for speed control of industrial robot | |
| JP3460761B2 (en) | Robot control device | |
| JP3287225B2 (en) | Interpolation device and interpolation method for numerical controller for laser beam machine | |
| JPH0962331A (en) | Movement command distribution method for servo control | |
| JPH1153021A (en) | Acceleration and deceleration pattern generating method for industrial robot | |
| JPS6380307A (en) | Speed control method for industrial robot | |
| JPH08234801A (en) | Apparatus and method for control for motor-driven joint arm | |
| JPH09204216A (en) | Acceleration/deceleration control method for articulated robot | |
| JP2001216008A (en) | Robot control method | |
| JPH01200414A (en) | Speed control method for industrial robot | |
| JPH07210225A (en) | Numerical controller | |
| JPH1039916A (en) | Acceleration and deceleration control method for articulated robot | |
| JPS6228810A (en) | Robot control device | |
| JPH0830975B2 (en) | Control method for articulated robot | |
| JP3068381B2 (en) | Servo control device | |
| JPH11194813A (en) | Operation command generating method for industrial machine | |
| JP2921756B1 (en) | Robot control method and control device | |
| JPH10301616A (en) | Teaching device for robot | |
| JPH11184512A (en) | Control gain determining method for robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| LAPS | Cancellation because of no payment of annual fees |