JP6627999B2 - Control device, control method, control program - Google Patents

Control device, control method, control program Download PDF

Info

Publication number
JP6627999B2
JP6627999B2 JP2019113855A JP2019113855A JP6627999B2 JP 6627999 B2 JP6627999 B2 JP 6627999B2 JP 2019113855 A JP2019113855 A JP 2019113855A JP 2019113855 A JP2019113855 A JP 2019113855A JP 6627999 B2 JP6627999 B2 JP 6627999B2
Authority
JP
Japan
Prior art keywords
axis
delay time
response delay
servo
command
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2019113855A
Other languages
Japanese (ja)
Other versions
JP2019164838A (en
Inventor
宏次 森野
宏次 森野
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.)
Omron Corp
Original Assignee
Omron Corp
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 Omron Corp filed Critical Omron Corp
Priority to JP2019113855A priority Critical patent/JP6627999B2/en
Publication of JP2019164838A publication Critical patent/JP2019164838A/en
Application granted granted Critical
Publication of JP6627999B2 publication Critical patent/JP6627999B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position Or Direction (AREA)
  • Control Of Multiple Motors (AREA)

Description

本発明は、制御装置、制御方法、制御プログラムに関する。   The present invention relates to a control device, a control method, and a control program.

特許文献1には、ロボットの動作を制御する制御装置が、軸毎に指令値に対する目標軌跡と実際の動作軌跡との差をサーボ遅れ時間として計算し、最短のサーボ遅れ時間を基準時間とし、軸毎のサーボ遅れ時間と前記基準時間とに基づいて軸毎の補償トルクを計算し、軸毎の補償トルクが反映された指令値を各サーボに出力してロボットの動作を制御する手法が開示されている。   In Patent Document 1, a control device that controls the operation of a robot calculates a difference between a target trajectory for a command value and an actual operation trajectory for each axis as a servo delay time, and uses the shortest servo delay time as a reference time, A technique for calculating a compensation torque for each axis based on a servo delay time for each axis and the reference time and outputting a command value reflecting the compensation torque for each axis to each servo to control the operation of the robot is disclosed. Have been.

特開2009−151527号公報(2009年7月9日公開)JP-A-2009-151527 (published on July 9, 2009)

前記手法では、軸毎のサーボ遅れ時間と前記基準時間とに基づく補償トルクの計算、並びに補償トルクが反映された指令値の算出が煩雑になるという問題があった。   In the above method, there is a problem that the calculation of the compensation torque based on the servo delay time for each axis and the reference time and the calculation of the command value in which the compensation torque is reflected become complicated.

本発明は、前記の問題点に鑑みてなされたものであり、その目的は、複数軸(複数のサーボモータ)間の応答遅れ時間のばらつきに起因する軌跡ずれを抑制しうる制御装置を実現することにある。   The present invention has been made in view of the above problems, and an object of the present invention is to provide a control device capable of suppressing a trajectory shift caused by a variation in response delay time between a plurality of axes (a plurality of servomotors). It is in.

本制御装置は、複数のサーボモータに対応する複数のサーボドライバに目標軌跡に基づいた位置指令を行う制御装置であって、前記各サーボドライバに対する前記目標軌跡における時間変化を、前記複数のサーボモータのうち応答遅れ時間が最大である基準サーボモータの応答遅れ時間と、前記各サーボドライバに対応するサーボモータの応答遅れ時間と、の差だけ遅らせるような指令位置となる位置指令を行うとともに、各サーボモータの加速度変化時に、各サーボモータの応答遅れ時間の2乗と加速度との積に比例する量を減算する補正が加わるような指令位置となる位置指令を行う構成である。   The present control device is a control device that issues a position command based on a target trajectory to a plurality of servo drivers corresponding to a plurality of servo motors, and the time change in the target trajectory for each of the servo drivers is controlled by the plurality of servo motors. Of the response delay time of the reference servo motor, the response delay time of which is the maximum, and the response delay time of the servo motor corresponding to each of the servo drivers, a position command to be a command position to delay by the difference, When the acceleration of the servomotor is changed, a position command is set so that the command position is such that a correction for subtracting an amount proportional to the product of the square of the response delay time of each servomotor and the acceleration is added.

本制御装置では、各サーボモータの加速度変化時に、各サーボモータの応答遅れ時間の2乗と加速度との積に1/2を乗じた値を減算する補正が加わるような指令位置となる位置指令を行ってもよい。   In the present control device, when the acceleration of each servomotor changes, a position command that becomes a command position that adds a correction of subtracting a value obtained by multiplying the product of the square of the response delay time of each servomotor and the acceleration by 1/2 is added. May be performed.

本制御方法は、複数のサーボモータに対応する複数のサーボドライバに目標軌跡に基づいた位置指令を行い、前記複数のサーボモータを応答させる制御方法であって、各サーボモータの応答遅れ時間を得る第1ステップと、応答遅れ時間を比較する第2ステップと、前記各サーボドライバに対する前記目標軌跡における時間変化を、前記複数のサーボモータのうち応答遅れ時間が最大である基準サーボモータの応答遅れ時間と前記各サーボドライバに対応するサーボモータの応答遅れ時間との差だけ遅らせるような指令位置となる位置指令を行う第3ステップとを含み、各サーボモータの加速度変化時に、各サーボモータの応答遅れ時間の2乗と加速度との積に比例する量を減算する補正が加わるような指令位置となる位置指令を行う方法である。   The present control method is a control method in which a position command is issued to a plurality of servo drivers corresponding to a plurality of servo motors based on a target trajectory, and the plurality of servo motors respond, and a response delay time of each servo motor is obtained. A first step, a second step of comparing a response delay time, and a time change in the target trajectory for each of the servo drivers, a response delay time of a reference servomotor having a maximum response delay time among the plurality of servomotors. And a third step of issuing a position command that is a command position that delays by the difference between the response delay time of the servo motor corresponding to each servo driver and the response delay of each servo motor when the acceleration of each servo motor changes. A method of issuing a position command that gives a command position that adds a correction that subtracts an amount proportional to the product of the square of time and the acceleration That.

本制御方法では、各サーボモータの加速度変化時に、各サーボモータの応答遅れ時間の2乗と加速度との積に1/2を乗じた値を減算する補正が加わるような指令位置となる位置指令を行ってもよい。   In this control method, when the acceleration of each servomotor changes, a position command that becomes a command position that adds a correction of subtracting a value obtained by multiplying the product of the square of the response delay time of each servomotor and the acceleration by 1/2 is added. May be performed.

本制御プログラムは、前記第1〜第3ステップをプロセッサに実行させることを特徴とする。   The present control program is characterized by causing a processor to execute the first to third steps.

本記録媒体は、前記制御プログラムを記録したコンピュータ読み取り可能な記録媒体である。   This recording medium is a computer-readable recording medium on which the control program is recorded.

本制御装置によれば、複数のサーボモータ間の応答遅れ時間のばらつきに起因する軌跡ずれを抑制することができる。   According to the present control device, it is possible to suppress a trajectory shift due to a variation in response delay time between a plurality of servomotors.

複数軸構成を示す模式図である。It is a schematic diagram which shows a multi-axis structure. 軸間応答遅れ時間差に起因する軌跡ずれの例を説明する参考図である。FIG. 8 is a reference diagram illustrating an example of a trajectory shift caused by an inter-axis response delay time difference. 軸間応答遅れ時間差に起因する軌跡ずれの原理を説明する参考図である。FIG. 9 is a reference diagram for explaining the principle of a trajectory shift caused by an inter-axis response delay time difference. 本制御装置の位置指令を説明する説明図である。FIG. 4 is an explanatory diagram illustrating a position command of the control device. 加速度変化時の位置偏差に起因する軌跡ずれの例を説明する参考図である。FIG. 7 is a reference diagram illustrating an example of a trajectory shift caused by a position deviation at the time of an acceleration change. 加速度変化時の位置偏差に起因する軌跡ずれを抑制する原理を説明する説明図である。FIG. 9 is an explanatory diagram illustrating a principle of suppressing a trajectory shift caused by a position deviation at the time of an acceleration change. 加速度変化時の位置偏差に起因する軌跡ずれを抑制する手法を説明する説明図である。FIG. 9 is an explanatory diagram illustrating a method of suppressing a trajectory shift caused by a position deviation at the time of an acceleration change. 本制御装置の機能モジュールを示す模式図である。It is a schematic diagram which shows the function module of this control apparatus. 本実施形態にかかる各サーボドライバの構成例を示す模式図である。FIG. 2 is a schematic diagram illustrating a configuration example of each servo driver according to the embodiment. 本制御装置の処理工程を示すフローチャートである。4 is a flowchart illustrating processing steps of the control device. 本実施形態の効果を示す軌跡図である。FIG. 4 is a trajectory diagram showing the effect of the present embodiment.

本発明の実施形態を図1〜図11を用いて説明する。以下では図1のような3軸(X軸、Y軸、Z軸)構成の同期グループを前提に説明するが、本実施形態の同期グループは2軸以上の構成であればよい。   An embodiment of the present invention will be described with reference to FIGS. In the following, a description will be given on the assumption that a synchronous group having a three-axis (X-axis, Y-axis, Z-axis) configuration as shown in FIG. 1 is used.

図1のような3軸構成では、例えば、制御装置からの指令を受けたX軸用サーボドライバがX軸用サーボモータを制御し、X軸用サーボモータによってワークWxがX軸方向に移動する(X軸用サーボモータの動作情報はX軸用サーボドライバにフィードバックされる)。また、制御装置からの指令を受けたY軸用サーボドライバがY軸用サーボモータを制御し、Y軸用サーボモータによってワークWyがY軸方向に移動する(Y軸用サーボモータの動作情報はY軸用サーボドライバにフィードバックされる)。また、制御装置からの指令を受けたZ軸用サーボドライバがZ軸用サーボモータを制御し、Z軸用サーボモータによってワークWzがZ軸方向に移動する(Z軸用サーボモータの動作情報はZ軸用サーボドライバにフィードバックされる)。   In the three-axis configuration as shown in FIG. 1, for example, an X-axis servo driver that receives a command from a control device controls the X-axis servo motor, and the work Wx moves in the X-axis direction by the X-axis servo motor. (Operation information of the X-axis servo motor is fed back to the X-axis servo driver). In addition, the Y-axis servo driver that receives the instruction from the control device controls the Y-axis servomotor, and the work Wy moves in the Y-axis direction by the Y-axis servomotor (the operation information of the Y-axis servomotor is This is fed back to the Y-axis servo driver). Further, the Z-axis servo driver that receives the command from the control device controls the Z-axis servo motor, and the work Wz moves in the Z-axis direction by the Z-axis servo motor (the operation information of the Z-axis servo motor is This is fed back to the Z-axis servo driver).

〔応答遅れ時間の軸間差に起因する軌跡ずれの抑制〕
一般に、X軸用サーボドライバ、Y軸用サーボドライバおよびZ軸用サーボドライバへの指令は同期しているが、指令を受けてから対応するサーボモータが応答するまでの時間(応答遅れ時間)は軸間でばらついている。
[Suppression of trajectory deviation caused by difference in response delay time between axes]
Generally, commands to the X-axis servo driver, Y-axis servo driver, and Z-axis servo driver are synchronized, but the time from receiving the command until the corresponding servo motor responds (response delay time) is It varies between axes.

例えば、Y軸系では応答遅れがほとんどなく(小さく)、Z軸系で応答遅れが大きい場合、図2のように、Y軸系では指令速度とフィードバック速度とがほぼ一致するのに対して、Z軸系では指令速度とフィードバック速度とが時間的にずれるため、コーナ軌跡においてZ軸方向の立ち上がりが遅れ、目標よりも外回りの軌跡となってしまう。   For example, in the case where there is little (small) response delay in the Y-axis system and the response delay is large in the Z-axis system, as shown in FIG. In the Z-axis system, the command speed and the feedback speed are temporally different from each other, so that the rise in the Z-axis direction is delayed in the corner trajectory, and the trajectory is more outward than the target.

すなわち、図3(a)のように、X軸用サーボドライバ(以下、サーボドライバSDx)の応答遅れ時間をRx、Y軸用サーボドライバ(以下、サーボドライバSDy)の応答遅れ時間をRy、Z軸用サーボドライバ(以下、サーボドライバSDz)の応答遅れ時間をRzとし、サーボドライバSDx、サーボドライバSDyおよびサーボドライバSDzに対して時刻tに同期して位置指令が到達した場合に、サーボモータSMxの応答時刻がTx(=t+Rx)、応答遅れ時間が最小のサーボモータSMyの応答時刻がTy(=t+Ry)、応答遅れ時間最大のサーボモータSMzの応答時刻がTz(=t+Rz)となって、3つのサーボモータが時間的にばらばらに応答し、図3(b)に示されるように目標軌跡からずれた軌跡をたどることになる。   That is, as shown in FIG. 3A, the response delay time of the X-axis servo driver (hereinafter, servo driver SDx) is Rx, the response delay time of the Y-axis servo driver (hereinafter, servo driver SDy) is Ry, Z When the response delay time of the axis servo driver (hereinafter, servo driver SDz) is Rz, and the position command arrives at the servo driver SDx, the servo driver SDy, and the servo driver SDz in synchronization with the time t, the servo motor SMx Is Tx (= t + Rx), the response time of the servo motor SMy with the shortest response delay time is Ty (= t + Ry), the response time of the servo motor SMz with the longest response delay time is Tz (= t + Rz), The three servo motors respond in a timely manner and follow a trajectory deviated from the target trajectory as shown in FIG. It becomes door.

そこで、本実施形態では、応答遅れ時間の軸間差に起因する軌跡ずれを抑制するため、図4(a)のように、サーボドライバSDx、サーボドライバSDyおよびサーボドライバSDzへの位置指令を時間的にずらして行う。   Therefore, in the present embodiment, as shown in FIG. 4A, position commands to the servo driver SDx, the servo driver SDy, and the servo driver SDz are time-shifted to suppress a trajectory shift caused by a difference in response delay time between axes. It is shifted.

具体的には、応答遅れ時間最大のサーボモータSMzを基準サーボモータとし、サーボモータSMzの応答時刻Tに同期してサーボモータSMxおよびサーボモータSMyを応答させるべく、サーボモータSMz(基準サーボモータ)を制御するサーボドライバSDz(基準サーボドライバ)への指令時刻tzに対して、サーボドライバSDxへの指令時刻txを、dx(基準サーボモータSMzとサーボモータSMxとの応答遅れ時間の差=Rz−Rx)だけ遅らせ、サーボドライバSDyへの指令時刻txを、dy(基準サーボモータSMzとサーボモータSMyとの応答遅れ時間の差=Rz−Ry)だけ遅らせる。   Specifically, a servo motor SMz (reference servo motor) is used in order to make the servo motor SMx and the servo motor SMy respond in synchronization with the response time T of the servo motor SMz with the servo motor SMz having the maximum response delay time as the reference servo motor. Command time tx to the servo driver SDx with respect to the command time tz to the servo driver SDz (reference servo driver) for controlling dx (dx (difference in response delay time between the reference servo motor SMz and the servo motor SMx = Rz− Rx), and the command time tx to the servo driver SDy is delayed by dy (difference in response delay time between the reference servo motor SMz and the servo motor SMy = Rz-Ry).

例えば、ある時刻の目標位置座標が(Px,Py,Pz)であれば、サーボドライバSDxへのPxの位置指令を、サーボドライバSDzへのPzの位置指令よりもdxだけ遅らせ、サーボドライバSDyへのPyの位置指令を、サーボドライバSDzへのPzの位置指令よりもdyだけ遅らせる。これにより、図4(b)に示されるように目標軌跡に近い軌跡とすることができる。   For example, if the target position coordinates at a certain time are (Px, Py, Pz), the Px position command to the servo driver SDx is delayed by dx from the Pz position command to the servo driver SDz, and the servo driver SDy is sent to the servo driver SDy. Is delayed by dy from the Pz position command to the servo driver SDz. Thus, a trajectory close to the target trajectory can be obtained as shown in FIG.

〔加速度変化時の位置偏差に起因する軌跡ずれの抑制〕
前記の手法によって軸間の応答タイミングは揃うが、各軸の応答遅れ自体は存在する。このため、図5のように、X軸用のサーボドライバへの速度指令が小⇒大となり、Y軸用のサーボドライバへの速度指令が大⇒小となる場合、X軸の位置偏差(指令位置とフィードバック位置の差)が時間的に増加する一方、Y軸の位置偏差(指令位置とフィードバック位置の差)は時間的に減少し、図5に示されるように目標軌跡に対して内回りの軌跡をたどることがある。
[Suppression of trajectory deviation due to position deviation during acceleration change]
Although the response timing between the axes is made uniform by the above method, the response delay itself of each axis exists. Therefore, as shown in FIG. 5, when the speed command to the X-axis servo driver changes from small to large and the speed command to the Y-axis servo driver changes from large to small, the X-axis position deviation (command While the difference between the position and the feedback position increases with time, the positional deviation of the Y-axis (the difference between the command position and the feedback position) decreases with time, and as shown in FIG. May follow a trajectory.

発明者は、図6(a)のように、指令速度とフィードバック速度とが応答遅れ時間だけずれているモデルにおいては、図6(b)のように、加速度変化時(プラス方向の変化とマイナス方向の変化を含む)の位置偏差に起因する軌跡ずれに対して、網掛け部分の補正を行うことが有効であることを見出した。具体的には、網掛け部分の面積にあたる、(1/2)×応答遅れ時間の2乗×加速度(予測加速度)に該当する量だけ、指令位置の補正を行う。   As shown in FIG. 6A, the inventor of the present invention has proposed a model in which the command speed and the feedback speed are shifted by the response delay time, as shown in FIG. (Including a change in direction), it has been found that it is effective to correct the shaded portion for the trajectory deviation caused by the positional deviation. Specifically, the command position is corrected by an amount corresponding to (1/2) × square of response delay time × acceleration (predicted acceleration), which corresponds to the area of the hatched portion.

こうすれば、図7(a)のように折り返し軌跡であって、フィードバック位置が折り返し点に到達していなかった場合でも、前記の指令位置の補正によって、図7(b)のようにフィードバック位置が折り返し点に到達するようになる。   By doing so, even if the feedback position is a return locus as shown in FIG. 7A and the feedback position has not reached the return point, the feedback position is corrected as shown in FIG. Reaches the turning point.

〔制御装置のプロセッサの機能モジュール〕
本実施形態にかかる制御装置は、図8のような機能モジュールをもつプロセッサを備える。プロセッサが備える機能モジュールは、予測同期計算部、指令位置生成部、X軸位置補正部、Y軸位置補正部、Z軸位置補正部、X軸指令部、Y軸指令部、およびZ軸指令部である。
[Function module of processor of control device]
The control device according to the present embodiment includes a processor having functional modules as shown in FIG. The functional modules included in the processor include a prediction synchronization calculation unit, a command position generation unit, an X-axis position correction unit, a Y-axis position correction unit, a Z-axis position correction unit, an X-axis command unit, a Y-axis command unit, and a Z-axis command unit. It is.

予測同期計算部は、サーボドライバSDx、サーボドライバSDy、およびサーボドライバSDzからサーボパラメータを読み見出し、X軸応答遅れ時間、Y軸応答遅れ時間、Z軸応答遅れ時間、および基準応答遅れ時間を含む予測位置同期補正パラメータを算出する。   The prediction synchronization calculation unit reads and finds servo parameters from the servo driver SDx, the servo driver SDy, and the servo driver SDz, and includes an X-axis response delay time, a Y-axis response delay time, a Z-axis response delay time, and a reference response delay time. A predicted position synchronization correction parameter is calculated.

ここでは、X軸応答遅れ時間(図3・図4のRx)は、サーボドライバSDxのサーボパラメータの1つである位置ループゲインの逆数とし、Y軸応答遅れ時間(図3・図4のRy)は、サーボドライバSDyのサーボパラメータの1つである位置ループゲインの逆数とし、Z軸応答遅れ時間(図3・図4のRz)は、サーボドライバSDzのサーボパラメータの1つである位置ループゲインの逆数とし、基準応答遅れ時間を、Rx、Ry、およびRzの最大値とする。   Here, the X-axis response delay time (Rx in FIGS. 3 and 4) is the reciprocal of the position loop gain, which is one of the servo parameters of the servo driver SDx, and the Y-axis response delay time (Ry in FIGS. 3 and 4). ) Is the reciprocal of the position loop gain which is one of the servo parameters of the servo driver SDy, and the Z-axis response delay time (Rz in FIGS. 3 and 4) is the position loop which is one of the servo parameters of the servo driver SDz. The reciprocal of the gain is set, and the reference response delay time is set to the maximum value of Rx, Ry, and Rz.

指令位置生成部は、目標軌跡に基づいて、X軸指令位置、Y軸指令位置、およびZ軸指令位置を生成し、X軸指令位置をX軸位置補正部に入力し、Y軸指令位置をY軸位置補正部に入力し、Z軸指令位置をZ軸位置補正部に入力する。   The command position generation unit generates an X-axis command position, a Y-axis command position, and a Z-axis command position based on the target trajectory, inputs the X-axis command position to the X-axis position correction unit, and outputs the Y-axis command position. It is input to the Y-axis position correction unit, and the Z-axis command position is input to the Z-axis position correction unit.

X軸位置補正部は、予測位置同期補正パラメータに基づいて、X軸指令位置の補正(応答遅れ時間の軸間差に関する補正、および加速度変化により生じる位置偏差に関する補正)を行い、X軸指令部は、補正後のX軸指令位置に基づいてサーボドライバSDxへの位置指令を行う。   The X-axis position correction unit corrects the X-axis command position (correction for the difference between the axes in the response delay time and correction for the position deviation caused by a change in acceleration) based on the predicted position synchronization correction parameter, and executes the X-axis command unit. Performs a position command to the servo driver SDx based on the corrected X-axis command position.

Y軸位置補正部は、予測位置同期補正パラメータに基づいて、Y軸指令位置の補正(応答遅れ時間の軸間差に関する補正、および加速度変化により生じる位置偏差に関する補正)を行い、Y軸指令部は、補正後のY軸指令位置に基づいてサーボドライバSDyへの位置指令を行う。   The Y-axis position correction unit corrects the Y-axis command position (correction for the difference between the axes of the response delay time and correction for the position deviation caused by a change in acceleration) based on the predicted position synchronization correction parameter. Performs a position command to the servo driver SDy based on the corrected Y-axis command position.

Z軸位置補正部は、予測位置同期補正パラメータに基づいて、Z軸指令位置の補正(応答遅れ時間の軸間差に関する補正、および加速度変化により生じる位置偏差に関する補正)を行い、Z軸指令部は、補正後のZ軸指令位置に基づいてサーボドライバSDzへの位置指令を行う。   The Z-axis position correction unit corrects the Z-axis command position based on the predicted position synchronization correction parameter (correction regarding a difference in response delay time between axes and correction regarding a position deviation caused by a change in acceleration). Performs a position command to the servo driver SDz based on the corrected Z-axis command position.

図9に示すように、サーボドライバSDxは、制御装置からの位置指令を受けるX軸位置制御部と、X軸位置制御部からの出力を受けるX軸速度制御部と、X軸速度制御部からの出力を受けるX軸電流制御部(X軸トルク制御部)とを含み、X軸電流制御部の出力によってサーボモータSMxの回転部が駆動し、サーボモータSMxのエンコーダの出力が、X軸位置制御部、X軸速度制御部、およびX軸電流制御部にフィードバックされる。X軸位置制御部は制御装置に位置ループゲインを出力し、X軸速度制御部は制御装置に速度ループゲインを出力する。   As shown in FIG. 9, the servo driver SDx includes an X-axis position control unit that receives a position command from the control device, an X-axis speed control unit that receives an output from the X-axis position control unit, and an X-axis speed control unit. And an X-axis current control unit (X-axis torque control unit) that receives the output of the servo motor SMx. The output of the X-axis current control unit drives the rotating unit of the servo motor SMx. The information is fed back to the control unit, the X-axis speed control unit, and the X-axis current control unit. The X-axis position control unit outputs a position loop gain to the control device, and the X-axis speed control unit outputs a speed loop gain to the control device.

また、サーボドライバSDyは、制御装置からの位置指令を受けるY軸位置制御部と、Y軸位置制御部からの出力を受けるY軸速度制御部と、Y軸速度制御部からの出力を受けるY軸電流制御部(Y軸トルク制御部)とを含み、Y軸電流制御部の出力によってサーボモータSMyの回転部が駆動し、サーボモータSMyのエンコーダの出力が、Y軸位置制御部、Y軸速度制御部、およびY軸電流制御部にフィードバックされる。Y軸位置制御部は制御装置に位置ループゲインを出力し、Y軸速度制御部は制御装置に速度ループゲインを出力する。   Also, the servo driver SDy includes a Y-axis position control unit that receives a position command from the control device, a Y-axis speed control unit that receives an output from the Y-axis position control unit, and a Y-axis that receives an output from the Y-axis speed control unit. And an output of the Y-axis current control unit drives the rotation unit of the servo motor SMy, and an output of the encoder of the servo motor SMy is output by the Y-axis position control unit and the Y-axis torque control unit. It is fed back to the speed controller and the Y-axis current controller. The Y-axis position control unit outputs a position loop gain to the control device, and the Y-axis speed control unit outputs a speed loop gain to the control device.

また、サーボドライバSDzは、制御装置からの位置指令を受けるZ軸位置制御部と、Z軸位置制御部からの出力を受けるZ軸速度制御部と、Z軸速度制御部からの出力を受けるZ軸電流制御部(Z軸トルク制御部)とを含み、Z軸電流制御部の出力によってサーボモータSMzの回転部が駆動し、サーボモータSMzのエンコーダの出力が、Z軸位置制御部、Z軸速度制御部、およびZ軸電流制御部にフィードバックされる。Z軸位置制御部は制御装置に位置ループゲインを出力し、Z軸速度制御部は制御装置に速度ループゲインを出力する。   Also, the servo driver SDz includes a Z-axis position control unit that receives a position command from the control device, a Z-axis speed control unit that receives an output from the Z-axis position control unit, and a Z-axis that receives an output from the Z-axis speed control unit. And a rotation unit of the servo motor SMz driven by an output of the Z-axis current control unit, and an output of an encoder of the servo motor SMz is output by a Z-axis position control unit and a Z-axis torque control unit. It is fed back to the speed controller and the Z-axis current controller. The Z-axis position control unit outputs a position loop gain to the control device, and the Z-axis speed control unit outputs a speed loop gain to the control device.

制御装置のプロセッサは、例えば、本実施形態にかかる制御プログラムを実行することで、図10のステップS1〜S8を実行する。   The processor of the control device executes steps S1 to S8 in FIG. 10 by executing the control program according to the present embodiment, for example.

すなわち、ステップS1で、(あらかじめ設定された同期グループの)各軸の位置ループゲインをサーボドライバから取得し、ステップS2で、各軸の応答遅れ時間を算出し、ステップS3で各軸の応答遅れ時間を互いに比較し、ステップS4で、応答遅れ時間のうち、最大応答遅れ時間を算出し、ステップS5で、各軸応答遅れ時間と最大応答遅れ時間との差分を算出し、ステップS6で、指令位置に対し、各軸につき算出された差分だけ遅らせる補正を行い、ステップS7で、ステップS6の結果に対して、加速度変化により生じる位置偏差に関する補正、具体的には、加速度に比例して生じる位置偏差の補正を行い、ステップS8で、ステップS7で得られた補正後の指令位置に基づいて対応するサーボドライバに位置指令を行う。   That is, in step S1, the position loop gain of each axis (of a preset synchronization group) is obtained from the servo driver, in step S2, the response delay time of each axis is calculated, and in step S3, the response delay of each axis is calculated. The times are compared with each other, a maximum response delay time is calculated from the response delay times in step S4, a difference between each axis response delay time and the maximum response delay time is calculated in step S5, and a command is issued in step S6. The position is corrected so as to be delayed by the difference calculated for each axis, and in step S7, the result of step S6 is corrected with respect to the position deviation caused by the acceleration change, specifically, the position generated in proportion to the acceleration. The deviation is corrected, and in step S8, a position command is issued to the corresponding servo driver based on the corrected command position obtained in step S7.

前述のように、応答遅れ時間の軸間差に関する補正、および加速度変化時の位置偏差に関する補正を行うことで、図11のように目標軌跡に対するずれが抑制されることがわかる。   As described above, by performing the correction for the difference between the axes of the response delay time and the correction for the position deviation when the acceleration changes, it can be seen that the deviation from the target trajectory as shown in FIG. 11 is suppressed.

〔位置補正部における処理例〕
図8のX軸補正部や図10のステップS7では、応答遅れ時間の軸間差に関する補正が下記式Axの第1項によって実現され、および加速度変化時の位置偏差に関する補正が下記式Axの第2項によって実現可能である。
[Processing example in position correction unit]
In the X-axis correction unit in FIG. 8 and in step S7 in FIG. 10, the correction regarding the difference between the axes of the response delay time is realized by the first term of the following equation Ax, and the correction regarding the position deviation when the acceleration changes is expressed by the following equation Ax. This can be realized by the second term.

Xcp(t)=X(t−(Rs−Rx))−(1/2)×Rx×Ax・・・式1
X(t):目標位置(目標軌跡)
Xcp(t):サーボドライバSDxに与える指令位置
Rx:X軸の応答遅れ時間(逆数がその位置ループゲイン)
Ax:X軸の加速度(予測加速度)
td:通信遅れ時間(軸間で共通)
Rs:基準応答遅れ時間(Rx、Ry、Rzの最大値)
この式1によって、式2の効果を得ることができる。
Xpp(t)=X(t−(Rs+td))≒Xap(t)・・・式2
Xpp(t):予測位置
Xap(t):Xcp(t)を与えたときの実位置(フィードバック位置)
ここでは、式1第2項の加速度Axとして、(dx/dt)(t−(Rs−Rx))で求められる結果に、位置ループゲインの逆数Rxを一次遅れ時定数とする一次遅れ演算を行い、さらに、1/(2π×速度ループゲイン)を一次遅れ時定数とする一次遅れ演算を行った結果を加速度Axとして使用する。
Xcp (t) = X (t− (Rs−Rx)) − (1/2) × Rx 2 × Ax Formula 1
X (t): target position (target trajectory)
Xcp (t): Command position given to servo driver SDx Rx: X-axis response delay time (reciprocal is the position loop gain)
Ax: X-axis acceleration (predicted acceleration)
td: Communication delay time (common between axes)
Rs: Reference response delay time (maximum value of Rx, Ry, Rz)
The effect of Expression 2 can be obtained by Expression 1.
Xpp (t) = X (t− (Rs + td)) ≒ Xap (t) Formula 2
Xpp (t): predicted position Xap (t): actual position (feedback position) given Xcp (t)
Here, as the acceleration Ax of the second term of Expression 1, the result obtained by (d 2 x / dt 2 ) (t− (Rs−Rx)) is the first order in which the reciprocal Rx of the position loop gain is the first-order lag time constant. The delay calculation is performed, and the result of the first-order delay calculation using 1 / (2π × speed loop gain) as the first-order delay time constant is used as the acceleration Ax.

また、図8のY軸補正部や図10のステップS7では、応答遅れ時間の軸間差に関する補正が下記式3の第1項によって実現され、および加速度変化時の位置偏差に関する補正が下記式3の第2項によって実現可能である。   Further, in the Y-axis correction unit in FIG. 8 and in step S7 in FIG. 10, the correction relating to the difference between the axes of the response delay time is realized by the first term of the following equation 3, and the correction relating to the position deviation when the acceleration changes is represented by the following equation 3 can be realized by the second term.

Ycp(t)=Y(t−(Rs−Ry))−1/2×Ry×Ay・・・式3
Y(t):目標位置(目標軌跡)
Ycp(t):サーボドライバSDyに与える指令位置
Ry:Y軸の応答遅れ時間(逆数がその位置ループゲイン)
Ay:Y軸の加速度(予測加速度)
td:通信遅れ時間(軸間で共通)
Rs:基準応答遅れ時間(Rx、Ry、Rzの最大値)
この式3によって、式4の効果を得ることができる。
Ypp(t)=Y(t−(Rs+td))≒Yap(t)・・・式4
Ypp(t):予測位置
Yap(t):Ycp(t)を与えたときの実位置(フィードバック位置)
ここでは、式3第2項の加速度Ayとして、(dy/dt)(t−(Rs−Ry))で求められる結果に、位置ループゲインの逆数Ryを一次遅れ時定数とする一次遅れ演算を行い、さらに、1/(2π×速度ループゲイン)を一次遅れ時定数とする一次遅れ演算を行った結果を加速度Ayとして使用する。
Ycp (t) = Y (t− (Rs−Ry)) − / × Ry 2 × Ay Expression 3
Y (t): target position (target trajectory)
Ycp (t): Command position given to servo driver SDy Ry: Y-axis response delay time (reciprocal is the position loop gain)
Ay: Y-axis acceleration (predicted acceleration)
td: Communication delay time (common between axes)
Rs: Reference response delay time (maximum value of Rx, Ry, Rz)
The effect of Expression 4 can be obtained by Expression 3.
Ypp (t) = Y (t− (Rs + td)) ≒ Yap (t) Formula 4
Ypp (t): predicted position Yap (t): actual position when Ycp (t) is given (feedback position)
Here, as the acceleration Ay of the second term of Expression 3, the result obtained by (d 2 y / dt 2 ) (t− (Rs−Ry)) includes the first order in which the reciprocal Ry of the position loop gain is the first order lag time constant. The delay calculation is performed, and the result of performing the first-order delay calculation using 1 / (2π × speed loop gain) as the first-order delay time constant is used as the acceleration Ay.

また、図8のZ軸補正部や図10のステップS7では、応答遅れ時間の軸間差に関する補正が下記式5の第1項によって実現され、および加速度変化時の位置偏差に関する補正が下記式5の第2項によって実現可能である。   Further, in the Z-axis correction unit in FIG. 8 and in step S7 in FIG. 10, the correction relating to the difference between the axes of the response delay time is realized by the first term of the following equation 5, and the correction relating to the position deviation when the acceleration changes is represented by the following equation 5 can be realized.

Zcp(t)=Z(t−(Rs−Rz))−1/2×Rz×Az・・・式5
Z(t):目標位置(目標軌跡)
Zcp(t):サーボドライバSDzに与える指令位置
Rz:Z軸の応答遅れ時間(逆数がその位置ループゲイン)
Az:Z軸の加速度(予測加速度)
td:通信遅れ時間(軸間で共通)
Rs:基準応答遅れ時間(Rx、Ry、Rzの最大値)
この式5によって、式6の効果を得ることができる。
Zpp(t)=Z(t−(Rs+td))≒Zap(t)・・・式6
Zpp(t):予測位置
Zap(t):Zcp(t)を与えたときの実位置(フィードバック位置)
ここでは、式5第2項の加速度Azとして、(dz/dt)(t−(Rs−Rz))で求められる結果に、位置ループゲインの逆数Rzを一次遅れ時定数とする一次遅れ演算を行い、さらに、1/(2π×速度ループゲイン)を一次遅れ時定数とする一次遅れ演算を行った結果を加速度Azとして使用する。
Zcp (t) = Z (t− (Rs−Rz)) − 1/2 × Rz 2 × Az Expression 5
Z (t): target position (target trajectory)
Zcp (t): Command position given to servo driver SDz Rz: Z-axis response delay time (reciprocal is the position loop gain)
Az: Z-axis acceleration (predicted acceleration)
td: Communication delay time (common between axes)
Rs: Reference response delay time (maximum value of Rx, Ry, Rz)
The effect of Expression 6 can be obtained by Expression 5.
Zpp (t) = Z (t− (Rs + td)) ≒ Zap (t) Equation 6
Zpp (t): Predicted position Zap (t): Actual position (feedback position) given Zcp (t)
Here, as the acceleration Az of the second term of Expression 5, the result obtained by (d 2 z / dt 2 ) (t− (Rs−Rz)) includes the first order in which the reciprocal Rz of the position loop gain is the first order lag time constant. The delay calculation is performed, and the result of the first-order delay calculation using 1 / (2π × velocity loop gain) as the first-order delay time constant is used as the acceleration Az.

〔ソフトウェアによる実現例〕
制御装置の各機能モジュールは、CPU(Central Processing Unit)を用いてソフトウェアによって実現してもよいし、集積回路(ICチップ)等に形成された論理回路(ハードウェア)によって実現してもよい。
[Example of software implementation]
Each functional module of the control device may be realized by software using a CPU (Central Processing Unit), or may be realized by a logic circuit (hardware) formed in an integrated circuit (IC chip) or the like.

前者の場合、制御装置は、各機能を実現するソフトウェアである制御プログラムの命令を実行するCPU、制御プログラムおよび各種データがコンピュータ(またはCPU)で読み取り可能に記録されたROM(Read Only Memory)または記憶装置(これらを「記録媒体」と称する)、制御プログラムを展開するRAM(Random Access Memory)などを備えている。そして、コンピュータ(またはCPU)が制御プログラムを記録媒体から読み取って実行することにより、本実施形態の目的が達成される。記録媒体としては、「一時的でない有形の媒体」、例えば、ディスク、カード、半導体メモリ、プログラマブルな論理回路などを用いることができる。また、制御プログラムは、これを伝送可能な任意の伝送媒体(通信ネットワークや放送波等)を介してコンピュータに供給されてもよい。なお、本実施形態は、制御プログラムが電子的な伝送によって具現化された、搬送波に埋め込まれたデータ信号の形態でも実現され得る。   In the former case, the control device includes a CPU that executes instructions of a control program that is software for realizing each function, a ROM (Read Only Memory) in which the control program and various data are recorded in a computer (or CPU) readable manner, or A storage device (these are referred to as “recording media”), a RAM (Random Access Memory) for expanding a control program, and the like are provided. The computer (or CPU) reads the control program from the recording medium and executes the control program, thereby achieving the object of the present embodiment. As the recording medium, a “temporary tangible medium”, for example, a disk, a card, a semiconductor memory, a programmable logic circuit, or the like can be used. Further, the control program may be supplied to the computer via an arbitrary transmission medium (a communication network, a broadcast wave, or the like) capable of transmitting the control program. Note that the present embodiment can also be realized in the form of a data signal embedded in a carrier wave, in which a control program is embodied by electronic transmission.

(まとめ)
本制御装置は、複数のサーボモータに対応する複数のサーボドライバに指令を行う制御装置であって、前記複数のサーボモータのうち応答遅れ時間が最大である基準サーボモータに対応するサーボドライバを基準サーボドライバとして、他のサーボドライバへの指令タイミングを、前記基準サーボドライバへの指令タイミングよりも、前記基準サーボモータの応答遅れ時間と前記他のサーボドライバに対応するサーボモータの応答遅れ時間との差だけ遅らせることを特徴とする。
(Summary)
The present control device is a control device that issues a command to a plurality of servo drivers corresponding to a plurality of servo motors, wherein a reference is made to a servo driver corresponding to a reference servo motor having a maximum response delay time among the plurality of servo motors. As the servo driver, the command timing to the other servo driver is set to be shorter than the command timing to the reference servo driver by the response delay time of the reference servo motor and the response delay time of the servo motor corresponding to the other servo driver. It is characterized by being delayed by the difference.

前記構成によれば、前記複数のサーボモータの応答タイミングが揃うため、複数軸(複数のサーボモータ)間の応答遅れ時間のばらつきに起因する軌跡ずれを抑制することができる。   According to the configuration, since the response timings of the plurality of servomotors are aligned, it is possible to suppress a trajectory deviation caused by a variation in response delay time between a plurality of axes (a plurality of servomotors).

本制御装置では、前記指令は、目標軌跡に基づいた位置指令である構成とすることもできる。   In the present control device, the command may be a position command based on a target trajectory.

本制御装置では、各サーボモータの応答遅れ時間は、対応するサーボドライバの位置ループゲインの逆数で示される構成とすることもできる。   In the present control device, the response delay time of each servomotor may be represented by the reciprocal of the position loop gain of the corresponding servo driver.

本制御装置では、各サーボモータの加速度変化時に、加速度に比例する量の補正が加わるように位置指令を行う構成とすることもできる。   In the present control device, it is also possible to adopt a configuration in which, when the acceleration of each servomotor changes, a position command is issued so that an amount proportional to the acceleration is corrected.

前記構成によれば、加速度変化時の位置偏差に起因する軌跡ずれの抑制が可能となる。   According to the configuration, it is possible to suppress a trajectory shift caused by a position deviation at the time of a change in acceleration.

本制御方法は、複数のサーボモータに対応する複数のサーボドライバに指令を行い、前記複数のサーボモータを応答させる制御方法であって、各サーボモータの応答遅れ時間を得る第1ステップと、応答遅れ時間を比較する第2ステップと、前記複数のサーボモータのうち応答遅れ時間が最大である基準サーボモータに対応するサーボドライバを基準サーボドライバとして、他のサーボドライバへの位置指令を、前記基準サーボドライバへの位置指令よりも、前記基準サーボモータの応答遅れ時間と前記他のサーボドライバに対応するサーボモータの応答遅れ時間との差だけ遅らせて行う第3ステップとを含むことを特徴とする。   The present control method is a control method in which a command is issued to a plurality of servo drivers corresponding to a plurality of servo motors to cause the plurality of servo motors to respond, wherein a first step of obtaining a response delay time of each servo motor; A second step of comparing delay times; and setting a servo driver corresponding to a reference servo motor having a maximum response delay time among the plurality of servo motors as a reference servo driver, and transmitting a position command to another servo driver. A third step of delaying by a difference between the response delay time of the reference servomotor and the response delay time of the servomotor corresponding to the other servodriver, relative to the position command to the servo driver. .

前記方法によれば、前記複数のサーボモータの応答タイミングが揃うため、複数軸(複数のサーボモータ)間の応答遅れ時間のばらつきに起因する軌跡ずれを抑制することができる。   According to the method, since the response timings of the plurality of servomotors are aligned, it is possible to suppress a trajectory shift caused by a variation in response delay time between a plurality of axes (a plurality of servomotors).

本制御方法では、前記第2ステップでは、各サーボドライバの位置ループゲインの逆数を比較してもよい。   In this control method, in the second step, the reciprocal of the position loop gain of each servo driver may be compared.

本発明は上記の実施の形態に限定されるものではなく、上記実施の形態を技術常識に基づいて適宜変更したものやそれらを組み合わせて得られるものも本発明の実施の形態に含まれる。     The present invention is not limited to the above-described embodiments, and the embodiments of the present invention include those obtained by appropriately modifying the above-described embodiments based on common general technical knowledge, and those obtained by combining them.

SDx サーボドライバ(X軸)
SDy サーボドライバ(Y軸)
SDz サーボドライバ(Z軸)
SMx サーボモータ(X軸)
SMy サーボモータ(Y軸)
SMz サーボモータ(Z軸)
Rx 応答遅れ時間(X軸)
Ry 応答遅れ時間(Y軸)
Rz 応答遅れ時間(Z軸)
SDx Servo driver (X axis)
SDy Servo driver (Y axis)
SDz Servo driver (Z axis)
SMx servo motor (X axis)
SMy servo motor (Y axis)
SMz servo motor (Z axis)
Rx response delay time (X axis)
Ry response delay time (Y axis)
Rz response delay time (Z axis)

Claims (6)

複数のサーボモータに対応する複数のサーボドライバに目標軌跡に基づいた位置指令を行う制御装置であって、
前記各サーボドライバに対する前記目標軌跡における時間変化を、前記複数のサーボモータのうち応答遅れ時間が最大である基準サーボモータの応答遅れ時間と、前記各サーボドライバに対応するサーボモータの応答遅れ時間と、の差だけ遅らせるような指令位置となる位置指令を行うとともに、
サーボモータの応答遅れ時間の2乗と、各サーボモータの加速度との積に比例する量を減算する補正が加わるような指令位置となる位置指令を行う制御装置。
A control device that issues a position command based on a target trajectory to a plurality of servo drivers corresponding to a plurality of servo motors,
The time change in the target trajectory for each of the servo drivers, the response delay time of the reference servo motor of which the response delay time is the largest among the plurality of servo motors, and the response delay time of the servo motor corresponding to each servo driver. , And a position command to be a command position that delays by the difference of
A control device for issuing a position command to be a command position in which a correction for subtracting an amount proportional to the product of the square of the response delay time of each servomotor and the acceleration of each servomotor is added.
サーボモータの応答遅れ時間の2乗と、各サーボモータの加速度との積に1/2を乗じた値を減算する補正が加わるような指令位置となる位置指令を行う請求項1に記載の制御装置。 And the square of the response delay time of each servo motor, according to claim 1 for position command is corrected by subtracting a value obtained by multiplying 1/2 to the product a command position as applied between the acceleration of the servo motor Control device. 複数のサーボモータに対応する複数のサーボドライバに目標軌跡に基づいた位置指令を行い、前記複数のサーボモータを応答させる制御方法であって、
各サーボモータの応答遅れ時間を得る第1ステップと、
応答遅れ時間を比較する第2ステップと、
前記各サーボドライバに対する前記目標軌跡における時間変化を、前記複数のサーボモータのうち応答遅れ時間が最大である基準サーボモータの応答遅れ時間と前記各サーボドライバに対応するサーボモータの応答遅れ時間との差だけ遅らせるような指令位置となる位置指令を行う第3ステップとを含み、
サーボモータの応答遅れ時間の2乗と、各サーボモータの加速度との積に比例する量を減算する補正が加わるような指令位置となる位置指令を行う制御方法。
A control method for performing a position command based on a target trajectory to a plurality of servo drivers corresponding to a plurality of servo motors, and causing the plurality of servo motors to respond,
A first step of obtaining a response delay time of each servomotor;
A second step of comparing the response delay times;
A time change in the target trajectory for each of the servo drivers is obtained by calculating a response delay time of a reference servo motor having a maximum response delay time among the plurality of servo motors and a response delay time of a servo motor corresponding to each servo driver. A third step of issuing a position command to be a command position to delay by a difference,
A control method for issuing a position command to be a command position in which a correction for subtracting an amount proportional to the product of the square of the response delay time of each servomotor and the acceleration of each servomotor is added.
サーボモータの応答遅れ時間の2乗と、各サーボモータの加速度との積に1/2を乗じた値を減算する補正が加わるような指令位置となる位置指令を行う請求項3に記載の制御方法。 And the square of the response delay time of each servo motor, according to claim 3 for the product value position command is corrected by subtracting the commanded position to join the multiplied by 1/2 of the acceleration of the servo motor Control method. 請求項3または4に記載の第1〜第3ステップをプロセッサに実行させる制御プログラム。   A control program for causing a processor to execute the first to third steps according to claim 3 or 4. 請求項5記載の制御プログラムを記録したコンピュータ読み取り可能な記録媒体。   A computer-readable recording medium on which the control program according to claim 5 is recorded.
JP2019113855A 2019-06-19 2019-06-19 Control device, control method, control program Expired - Fee Related JP6627999B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019113855A JP6627999B2 (en) 2019-06-19 2019-06-19 Control device, control method, control program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019113855A JP6627999B2 (en) 2019-06-19 2019-06-19 Control device, control method, control program

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2015234142A Division JP6551199B2 (en) 2015-11-30 2015-11-30 Control device, control method, control program

Publications (2)

Publication Number Publication Date
JP2019164838A JP2019164838A (en) 2019-09-26
JP6627999B2 true JP6627999B2 (en) 2020-01-08

Family

ID=68064635

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019113855A Expired - Fee Related JP6627999B2 (en) 2019-06-19 2019-06-19 Control device, control method, control program

Country Status (1)

Country Link
JP (1) JP6627999B2 (en)

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0916229A (en) * 1995-06-29 1997-01-17 Shin Meiwa Ind Co Ltd Industrial robot
JP5366840B2 (en) * 2010-01-14 2013-12-11 三菱電機株式会社 Trajectory control device

Also Published As

Publication number Publication date
JP2019164838A (en) 2019-09-26

Similar Documents

Publication Publication Date Title
JP6551199B2 (en) Control device, control method, control program
US11000949B2 (en) Robot for controlling learning in view of operation in production line, and method of controlling the same
Zhang et al. Pre-compensation of contour errors in five-axis CNC machine tools
US20070188116A1 (en) Control system
US9678500B2 (en) Machining program creating device numerical control device, machining system, machining program creating method, numerical control method, and machining program
JP6705971B2 (en) Control system, controller and control method
JP2010170435A (en) System and method for instructing motion control, and motion control system
JP2018151889A (en) Processing apparatus, parameter adjustment method, and parameter adjustment program
JP6627999B2 (en) Control device, control method, control program
US11106184B2 (en) Control system
JP2005186235A (en) Control device for robot
JP2002091570A (en) Servo control method
US20230339113A1 (en) Path Generation Method Of Generating Path Of Robot Using Command From External Apparatus And Robot Control System
JP2005094964A (en) Motor control device and method therefor
KR100729403B1 (en) Programmable controller
JP7091811B2 (en) Motor control method and control device
JP5558638B1 (en) Command generator
JP2006285885A (en) Parallel processing method of distributed motion control system and motion controller
US11513497B2 (en) Control device
JP7124696B2 (en) Synchronous control device, synchronous control system, synchronous control method and simulation device
JP6407478B1 (en) Electronic cam pattern generation method and electronic cam pattern generation device
JP6849713B2 (en) Control devices, control methods, control programs, and recording media
EP3598248B1 (en) Control system
JP6607097B2 (en) Control device, control method, information processing program, and recording medium
JP2006227719A (en) Motion control system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190619

A871 Explanation of circumstances concerning accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A871

Effective date: 20190619

A975 Report on accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A971005

Effective date: 20190826

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190903

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191023

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20191105

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20191118

R150 Certificate of patent or registration of utility model

Ref document number: 6627999

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees