JP4210921B2 - Command generation method and apparatus for servo control device - Google Patents
Command generation method and apparatus for servo control device Download PDFInfo
- Publication number
- JP4210921B2 JP4210921B2 JP2003347373A JP2003347373A JP4210921B2 JP 4210921 B2 JP4210921 B2 JP 4210921B2 JP 2003347373 A JP2003347373 A JP 2003347373A JP 2003347373 A JP2003347373 A JP 2003347373A JP 4210921 B2 JP4210921 B2 JP 4210921B2
- Authority
- JP
- Japan
- Prior art keywords
- command
- time
- acceleration
- control device
- parameter
- 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 - Lifetime
Links
- 238000000034 method Methods 0.000 title claims description 48
- 230000001133 acceleration Effects 0.000 claims description 54
- 238000004088 simulation Methods 0.000 claims description 38
- 238000004364 calculation method Methods 0.000 claims description 30
- 230000001419 dependent effect Effects 0.000 claims 2
- 230000006870 function Effects 0.000 description 31
- 230000000694 effects Effects 0.000 description 7
- 230000004044 response Effects 0.000 description 4
- 230000001052 transient effect Effects 0.000 description 4
- 230000036461 convulsion Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000006399 behavior Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Landscapes
- Numerical Control (AREA)
- Feedback Control In General (AREA)
Description
本発明は、サーボモータ等を制御する制御装置に入力する指令を作成する方法および装置に関するものであり、特に制御対象のある状態量の挙動を１つから４つのパラメータで調整できる制御装置の指令作成方法およびその指令を用いた位置、速度、トルクを制御するサーボ制御装置の指令作成装置に関する。 The present invention relates to a method and apparatus for creating a command to be input to a control device that controls a servo motor or the like, and in particular, a control device command capable of adjusting the behavior of a state quantity to be controlled with one to four parameters. The present invention relates to a creation method and a command creation device of a servo control device that controls position, speed, and torque using the command.
従来の制御装置にて制御を行い所望の動作を行わせたい場合、制御装置へ入力する指令としてカム曲線などを用いて、カム曲線の各パラメータを調整して指令を作成していた（例えば、特許文献１参照）。
特許文献１に、カム曲線は以下の計算を行うことで作成できると記述されている。
まず最初に、t0〜t7およびv0、v7、s0、s7の合計12個の値を調整、設定し、式（２）および式（３）からamm、ampを求め、最終的に式（１）を用いて指令を作成するというものである。
Patent Document 1 describes that a cam curve can be created by performing the following calculation.
First, t 0 to t 7 and a total of 12 values of v 0 , v 7 , s 0 , s 7 are adjusted and set, and a mm and a mp are obtained from equations (2) and (3). Finally, a command is created using equation (1).
この方法に対し特許文献１では、従来はストローク、移動時間、モータで駆動する負荷などの動作条件を考慮して最適なカム曲線を多数のカム曲線テーブルの中から選択するか、またユニバーサルカム曲線のパラメータを調整して生成する必要があり、カム曲線の特性を熟知している人以外には、最適なカム曲線を用いることが困難であり、また、複数のカム曲線テーブルをメモリ上に持つためメモリを大量に必要とする等の問題を指摘し、以下の方法を提案している。
曲線生成のパラメータとしてtv（0≦tv≦0.5）を設定する。このtv、t0、t7から次の式（４）を用いてパラメータt1〜t6を求める。
In contrast to this method, in Patent Document 1, conventionally, an optimal cam curve is selected from a number of cam curve tables in consideration of operating conditions such as stroke, moving time, and load driven by a motor, or a universal cam curve. It is difficult to use the optimal cam curve unless you are familiar with the characteristics of the cam curve, and you have multiple cam curve tables in the memory. Therefore, he points out problems such as the need for a large amount of memory, and proposes the following method.
Set tv (0 ≦ tv ≦ 0.5) as a parameter for curve generation. Parameters t 1 to t 6 are obtained from tv, t 0 and t 7 using the following equation (4).
次に求めたt0〜t7及びその他のパラメータv0、v7、s0、s7を用いてamm、ampについての式（２）式（３）を解き、その値を使用して式（１）により指令を作成するという方法である。
このように、パラメータtvを設定することにより、カム曲線の特性を熟知していない人でも容易にカム曲線を用いてサーボモータを制御でき、また、少ないメモリでも動作が可能なモーション制御装置を得ることができると記述されている。
Next, using the values of t 0 to t 7 and other parameters v 0 , v 7 , s 0 , s 7 , solve the equations (2) and (3) for a mm and a mp and use the values. This is a method of creating a command by equation (1).
Thus, by setting the parameter tv, even a person who is not familiar with the characteristics of the cam curve can easily control the servo motor using the cam curve, and obtain a motion control device that can operate with a small amount of memory. It is described that it can.
しかしながら、従来の技術では、確かにt1〜t6の６つのパラメータを一つのtvというパラメータで計算できるため設定するパラメータは１２個から７個に減っているが、結局、式（４）の計算量が増えてしまい、さらに、式（３）および式（２）および式（１）の計算が必要になり，非常に計算量が多くなるといった問題があった。また、式（１）の計算で三角関数を用いるため、通常の四則演算に比べ演算時間がかかるという問題もあった。また、結果として高速処理を実現するCPUが必要になるという問題もあった。
本発明はこのような様々な問題点に鑑みてなされたものであり、ある調整できるパラメータｋあるいはk1,k2あるいは、k11,k12,k21,k22を有する簡単な指令を用いることで、以下のサーボモータ制御装置の指令作成方法および指令作成装置を提供することを目的とする。
１ カム曲線等を使用する場合に比べコントローラの計算量を格段に少なくする。
２ シミュレーションしながら各パラメータを決定することができ、調整を簡単にする。
３ 調整パラメータが１つから最大でも４つだけなので、調整を簡単にする。
４ 高速処理を実現するCPUを不要とする。
５ 指令払い出し時間は固定で、過渡応答を選択できるようにする。
６ 一定速度動作が必要な場合や、最高速度の制限がある場合なども、加速区間や減速区間の過渡応答を自由に選択できるようにする。
７ 指令関数を積分することにより位置制御時と速度制御時ともに本発明を共通して使用できるようにする。
However, in the prior art, the six parameters t 1 to t 6 can be calculated with one tv parameter, so the number of parameters to be set is reduced from 12 to 7. However, in the end, the equation (4) There is a problem that the amount of calculation increases, and further, the calculations of Expression (3), Expression (2), and Expression (1) become necessary, and the amount of calculation becomes very large. In addition, since a trigonometric function is used in the calculation of Expression (1), there is a problem that it takes a calculation time as compared with the normal four arithmetic operations. As a result, there is a problem that a CPU that realizes high-speed processing is required.
The present invention has been made in view of such various problems, and by using a simple command having a certain adjustable parameter k or k1, k2 or k11, k12, k21, k22, the following servo is provided. It is an object of the present invention to provide a command generation method and a command generation device for a motor control device.
1 Compared with the use of a cam curve, etc., the amount of calculation of the controller is significantly reduced.
2 Each parameter can be determined while simulating, making adjustment easy.
3 Since there are only one adjustment parameter and at most four adjustment parameters, adjustment is simplified.
4 Eliminates the need for a CPU that achieves high-speed processing.
5 The command payout time is fixed so that a transient response can be selected.
6. Make it possible to freely select the transient response in the acceleration zone and deceleration zone even when constant speed operation is required or when there is a limit on the maximum speed.
7. By integrating the command function, the present invention can be used in common for both position control and speed control.
上記問題を解決するため、本発明は、制御対象の状態量を検出する状態量検出器と、指令と検出値に基づいて制御対象を駆動する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、制御対象の移動時間、移動距離、速度、加速度等の移動条件に基づいて作成するサーボ制御装置の指令作成方法において、
aを移動距離distに依存する変数、bを移動時間を表す変数、ｋを調整パラメータとする関数v(t)
In order to solve the above problem, the present invention provides a servo including a state quantity detector that detects a state quantity of a control target, and a control arithmetic unit that calculates and outputs a signal for driving the control target based on a command and a detection value. In the command creation method of the servo control device that creates the command to be input to the control device based on the movement conditions such as the movement time, the movement distance, the speed, and the acceleration of the control target,
a function v (t) where a is a variable depending on the travel distance dist, b is a variable representing the travel time, and k is an adjustment parameter
を速度指令とすることを特徴とするものである。
Is a speed command.
このようになっているため、移動時間を変更せずに、指令の次数までも設定パラメータにより変更できるため、指令の自由度が大幅に増え、所望の動作を実現しやすくなる。また、この関数のみを計算するだけなので、指令作成のための計算量が非常に少なくなる。 Thus, the order of the command can be changed by the setting parameter without changing the travel time, so that the degree of freedom of the command is greatly increased and a desired operation can be easily realized. In addition, since only this function is calculated, the amount of calculation for creating a command becomes very small.
また、制御対象の状態量を検出する状態量検出器と、指令と検出値に基づいて制御対象を駆動する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、制御対象の移動時間、移動距離、速度、加速度等の移動条件に基づいて作成するサーボ制御装置の指令作成方法において、
aを移動距離distに依存する変数、bを移動時間を表す変数、k1、k2を調整パラメータとする関数v(t)
In addition, a command to be input to a servo control device having a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value is controlled. In the command creation method of the servo control device created based on the movement conditions such as the movement time, movement distance, speed, acceleration, etc. of the target,
A function v (t) where a is a variable depending on the travel distance dist, b is a variable representing the travel time, and k1 and k2 are adjustment parameters
を速度指令とすることを特徴とするものである。
このようになっているため、加速時と減速時の各状態量の波形を変化させることが可能になり、さらに、指令の自由度が増大する。また、この関数のみを計算するだけなので、指令作成のための計算量が非常に少なくなる。
Is a speed command.
Because of this, it becomes possible to change the waveform of each state quantity during acceleration and deceleration, and the degree of freedom in command increases. In addition, since only this function is calculated, the amount of calculation for creating a command becomes very small.
また、前記関数v(t)を積分し、積分された関数を位置指令とすることを特徴とするものである。このようになっているため、位置制御時も、速度制御時も本発明を使用できる。 Further, the function v (t) is integrated, and the integrated function is used as a position command. Thus, the present invention can be used during position control and speed control.
また、前記パラメータｋあるいは、k1,k2の決定方法として、予め指令関数v(t)を用意しておき、移動距離distと移動時間bを移動条件として設定し、パラメータｋあるいはk1,k2の値を適当な値に設定し、移動距離distと移動時間bと設定されたｋあるいはk1,k2の値を用いて変数aの値を計算で求め、設定されたパラメータｋあるいはk1,k2を用いた指令に基づいてシミュレーションし、シミュレーション結果に基づいてｋあるいはk1,k2の値を調整しながらシミュレーションを繰り返し行い、最終的な値を決定することを特徴とするものである。このようになっているため、簡単な手順で所望の動作を実現する指令を作成することができる。 In addition, as a method for determining the parameter k or k1, k2, a command function v (t) is prepared in advance, the movement distance dist and the movement time b are set as movement conditions, and the value of the parameter k, k1, k2 is set. Is set to an appropriate value, the value of the variable a is calculated by using the moving distance dist and the moving time b and the set k or k1, k2 value, and the set parameter k, k1, k2 is used. The simulation is based on the command, and the simulation is repeated while adjusting the value of k or k1, k2 based on the simulation result, and the final value is determined. Because of this, it is possible to create a command for realizing a desired operation with a simple procedure.
また、制御対象の状態量を検出する状態量検出器と、指令と検出値に基づいて制御対象
を駆動する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、
制御対象の移動時間、移動距離、速度、加速度等の移動条件に基づいて作成するサーボ制
御装置の指令作成装置において、 移動距離distと移動時間bを設定する移動条件設定手段と、
前記移動時間distに依存する変数ａおよび調整できるパラメータｋあるいはk1、k2を有する速度の指令関数
v(t)=a・t k ・(b-t) k (0≦t≦b)
または、
v(t)=a・t k1 ・(b-t) k2 (0≦t≦b)
に基づいて指令を演算する指令演算手段と、前記調整できるパラメータkあるいはk1、k2の値を入力するパラメータ入力手段と、指令演算手段で作成された指令を用いてシミュレーションを行うシミュレーション演算手段と、シミュレーション結果を表示するシミュレーション結果表示手段を有することを特徴とするものである。このようになっているため、画面をみながら視覚的、感覚的にパラメータkあるいはk1、k2を調整できるので、簡単に所望の動作を実現できる指令を作成することができる。
In addition, a command input to a servo control device including a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value,
In the command creation device of the servo control device that is created based on the movement conditions such as the movement time, movement distance, speed, and acceleration of the control object, the movement condition setting means for setting the movement distance dist and the movement time b,
Speed command function with variable a depending on the travel time dist and adjustable parameters k or k1, k2.
v (t) = a ・ t k ・ (bt) k (0 ≦ t ≦ b)
Or
v (t) = a ・ t k1 ・ (bt) k2 (0 ≦ t ≦ b)
Command calculation means for calculating a command based on the above, parameter input means for inputting the value of the adjustable parameter k or k1, k2, and simulation calculation means for performing a simulation using the command created by the command calculation means, It has a simulation result display means for displaying a simulation result. Thus, the parameter k or k1, k2 can be visually and sensibly adjusted while viewing the screen, so that a command that can easily realize a desired operation can be created.
また、サーボモータの加速時間、一定速度時間、減速時間、移動距離、移動速度等の移動条件に基づいてサーボモータの指令を作成し、該指令に追従するように制御対象を制御するサーボ制御方法において、
指令発生器と、制御対象の状態量を検出する状態量検出器と、指令と検出値をもとに制御対象を駆動する信号を計算し出力する制御演算器を備え、前記指令発生器は、a1とa2を移動距離に依存する変数、b1を加速時間を表す変数、b2を減速時間を表す変数、cを一定速度時間を表す変数、ｋを調整パラメータとする、加速区間、一定速度区間、減速区間で場合分けされた関数α(t)
Also, a servo control method for creating a servo motor command based on the movement conditions such as acceleration time, constant speed time, deceleration time, moving distance, moving speed, etc. of the servo motor and controlling the control target so as to follow the command In
A command generator, a state quantity detector for detecting a state quantity of the controlled object, and a control arithmetic unit for calculating and outputting a signal for driving the controlled object based on the command and the detected value, a1 and a2 are variables depending on travel distance, b1 is a variable representing acceleration time, b2 is a variable representing deceleration time, c is a variable representing constant speed time, k is an adjustment parameter, acceleration section, constant speed section, Function α (t) divided into cases in deceleration zone
を加速度指令とし、前記加速度指令を制御演算器へ出力することを特徴とするものである。
このようになっているため、最高速度に制限がある場合や、一定速度動作を行いたい場合も本発明が使用できる。
Is an acceleration command, and the acceleration command is output to a control calculator.
Thus, the present invention can be used even when the maximum speed is limited or when it is desired to perform a constant speed operation.
また、制御対象の状態量を検出する状態量検出器と、指令と検出値に基づいて制御対象を駆動する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、制御対象の加速時間、一定速度時間、減速時間、移動距離、移動速度等の移動条件に基づいて作成するサーボ制御装置の指令作成方法において、
a1とa2を移動距離distに依存する変数、b1を加速時間を表す変数、b2を減速時間を表す変数、cを一定速度時間を表す変数、ｋを調整パラメータとする、加速区間、一定速度区間、減速区間で場合分けされた関数α(t)
In addition, a command to be input to a servo control device having a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value is controlled. In the command creation method of the servo control device created based on the movement conditions such as the target acceleration time, constant speed time, deceleration time, movement distance, movement speed,
a1 and a2 are variables that depend on the travel distance dist, b1 is a variable that represents acceleration time, b2 is a variable that represents deceleration time, c is a variable that represents constant speed time, and k is an adjustment parameter. , Function α (t) divided into cases in the deceleration zone
を加速度指令とすることを特徴とするものである。このようになっているため、各状態量の波形を、さらに細かく変化させることが可能になり、さらに、指令の自由度が増大する。 Is an acceleration command. As a result, the waveform of each state quantity can be changed more finely, and the degree of freedom in command is further increased.
また、前記関数α(t)を積分し、積分された関数を速度指令とすることを特徴とするものである。このようになっているため、このようになっているため、速度制御時も本発明を使用できる。 Further, the function α (t) is integrated, and the integrated function is used as a speed command. Since this is the case, the present invention can be used even during speed control.
また、前記関数α(t)を２回積分し、２回積分された関数を位置指令とすることを特徴とする請求項６または７記載のサーボ制御装置の指令作成方法。このようになっているため、位置制御時も本発明を使用できる。 8. The servo control device command generation method according to claim 6, wherein the function α (t) is integrated twice, and the function integrated twice is used as a position command. Because of this, the present invention can be used even during position control.
また、前記パラメータｋあるいは、k11,k12,k21,k22の決定方法として、予め指令関数α(t)を用意しておき、移動距離distあるいは移動速度V、加速時間b1、減速時間b2、一定速度時間ｃを移動条件として設定し、パラメータｋあるいはk11,k12,k21,k22の値を設定し、移動距離distあるいは移動速度V、加速時間b1、減速時間b2、一定速度時間ｃ、設定されたパラメータｋあるいはk11,k12,k21,k22の値を用いて変数a1とa2の値を計算で求め、設定されたパラメータｋあるいはk11,k12,k21,k22を用いた指令に基づいてシミュレーションし、シミュレーション結果に基づいてｋあるいはk11,k12,k21,k22の値を調整しながらシミュレーションを繰り返し行い、最終的な値を決定することを特徴とするものである。このようになっているため、簡単な手順で所望の動作を実現する指令を作成することができる。 In addition, as a method for determining the parameter k or k11, k12, k21, k22, a command function α (t) is prepared in advance, and the moving distance dist or moving speed V, acceleration time b1, deceleration time b2, constant speed Set time c as the moving condition, set parameter k or k11, k12, k21, k22, move distance dist or moving speed V, acceleration time b1, deceleration time b2, constant speed time c, set parameters Calculate the values of variables a1 and a2 using the values of k or k11, k12, k21, and k22, and perform simulation based on the command using the set parameter k or k11, k12, k21, and k22. Based on the above, the simulation is repeated while adjusting the value of k or k11, k12, k21, k22, and the final value is determined. Because of this, it is possible to create a command for realizing a desired operation with a simple procedure.
また、制御対象の状態量を検出する状態量検出器と、指令と検出値に基づいて制御対象
を駆動する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、
制御対象の加速時間、一定速度時間、減速時間、移動距離、移動速度等の移動条件に基づ
いて作成するサーボ制御装置の指令作成装置において、
移動距離distあるいは移動速度Vと加速時間b 1 と減速時間b 2 と一定速度時間ｃ を設定する移動条件設定手段と、前記移動距離distに依存する変数a1、a2および調整パラメータｋあるいはk11、k12、k21、k22有する，加速区間、一定速度区間、減速区間で場合分けされた加速度の指令関数
加速区間 α(t)=a 1 ・t k ・(b 1 -t) k (0≦t<b 1 )
一定速度区間 α(t)=0 (b 1 ≦t<b 1 +c)
減速区間 α(t)=-a 2 ・(t-(b 1 +c)) k ・((b 1 +c+b 2 )-t) k (b1+c≦t≦b 1 +c+b 2 )
または、
加速区間 α(t)=a 1 ・t k11 ・(b 1 -t) k21 (0≦t<b 1 )
一定速度区間 α(t)=0 (b 1 ≦t<b 1 +c)
減速区間 α(t)=-a 2 ・(t-(b 1 +c)) k12 ・((b 1 +c+b 2 )-t) k22 (b 1 +c≦t≦b 1 +c+b 2 )
に基づいて指令を演算する指令演算手段と、前記調整パラメータｋあるいはk 11、k12、k21、k22の値を入力するパラメータ入力手段と、指令演算手段で作成された指令を用いてシミュレーションを行うシミュレーション演算手段と、シミュレーション結果を表示するシミュレーション結果表示手段を有することを特徴とするものである。
In addition, a command input to a servo control device including a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value,
In the command creation device of the servo control device that creates based on the movement conditions such as acceleration time, constant speed time, deceleration time, movement distance, movement speed of the controlled object,
Moving distance dist or the moving speed V acceleration time b 1 and deceleration time b 2 a moving condition setting means for setting a constant speed time c, the variable a1 which depends on the moving distance dist, a2 and adjustment parameter k or k11, k12 , K21, k22, acceleration command function divided into acceleration section, constant speed section, and deceleration section
Acceleration section α (t) = a 1 ・ t k ・ (b 1 -t) k (0 ≦ t <b 1 )
Constant speed section α (t) = 0 (b 1 ≤t <b 1 + c)
Deceleration section α (t) =-a 2 ・ (t- (b 1 + c)) k ・ ((b 1 + c + b 2 ) -t) k (b1 + c ≦ t ≦ b 1 + c + b 2 )
Or
Acceleration section α (t) = a 1 ・ t k11 ・ (b 1 -t) k21 (0 ≦ t <b 1 )
Constant speed section α (t) = 0 (b 1 ≤t <b 1 + c)
Deceleration section α (t) =-a 2 ・ (t- (b 1 + c)) k12 ・ ((b 1 + c + b 2 ) -t) k22 (b 1 + c ≦ t ≦ b 1 + c + b 2 )
Simulation for performing simulation using command calculation means for calculating a command based on the above, parameter input means for inputting the value of the adjustment parameter k or k11, k12, k21, k22, and a command created by the command calculation means It has a calculation means and a simulation result display means for displaying a simulation result.
本発明によれば、予め調整できるパラメータを持つ簡単な指令関数を用意しておき、移動距離と、移動時間を設定し、あとはパラメータｋの値を変化させながらシミュレーションを行い、所望の動作を実現するｋを決定することで指令を作成することで、指令払い出し時間は固定で、過渡応答を選択することが可能になるという効果がある。また、カム曲線などを使用する場合に比べ、格段にコントローラの計算量が少なくなるという効果がある。また、様々な波形の指令をテーブルに保存しておいて選択するといった方法ではなく、簡単な指令関数を逐次計算するだけなのでコントローラのメモリ容量も少なくて済むという効果がある。また、画面を見ながらの感覚的で簡単な調整で、所望の動作を得られるので、調整時間の短縮につながるという効果もある。また、指令払い出し時間を変更せずに、指令の次数までも設定パラメータにより変更できるため、指令の自由度が大幅に増え、所望の動作を実現しやすくなるという効果もある。
また、本発明の第二の方法によれば一定速度区間を有する指令を作成できるので、一定速度動作が必要な場合や、最高速度の制限がある場合なども、加速区間や減速区間の過渡応答を自由に選択することが出来るという効果がある。
また、設定パラメータk11,k12,k21,k22を用いれば、加速時と減速時の各状態量の波形を変化させることが可能になり、さらに、指令の自由度が増大するという効果がある。また、指令関数を積分することにより位置制御時も、速度制御時も本発明を使用できるという効果がある。
According to the present invention, a simple command function having parameters that can be adjusted in advance is prepared, a moving distance and a moving time are set, and a simulation is performed while changing the value of the parameter k to perform a desired operation. By creating a command by determining k to be realized, there is an effect that the command payout time is fixed and a transient response can be selected. In addition, compared with the case where a cam curve or the like is used, there is an effect that the calculation amount of the controller is remarkably reduced. In addition, there is an effect that the memory capacity of the controller can be reduced because it is not a method of selecting and saving various waveform commands in a table, but simply calculating simple command functions. In addition, since a desired operation can be obtained by a sensuous and simple adjustment while looking at the screen, the adjustment time can be shortened. Further, since the order of the command can be changed by the setting parameter without changing the command payout time, there is an effect that the degree of freedom of the command is greatly increased and a desired operation can be easily realized.
In addition, according to the second method of the present invention, a command having a constant speed section can be created. Therefore, when a constant speed operation is required or when there is a limit on the maximum speed, the transient response in the acceleration section or the deceleration section is used. There is an effect that can be freely selected.
Further, if the setting parameters k11, k12, k21, and k22 are used, it is possible to change the waveform of each state quantity during acceleration and deceleration, and further, there is an effect that the degree of freedom of command increases. Further, by integrating the command function, there is an effect that the present invention can be used during position control and speed control.
以下、本発明の方法の具体的実施例について、図に基づいて説明する。 Hereinafter, specific examples of the method of the present invention will be described with reference to the drawings.
図４は、本発明の方法を実施する制御装置の構成図である。図において６は位置または速度指令を制御演算器へ出力する指令発生器６である。通常は位置指令、速度指令を出力するＮＣ制御装置等の上位制御装置がこの指令発生器６に相当する。７は制御演算器、８は状態量検出器、１０は電動機（サーボモータ）、１１は負荷機械である、１２は電動機１０を駆動するためのいわゆるサーボアンプである。電動機１０と負荷機械１１を合わせたものが制御対象９である。
そして指令発生器６により出力された位置指令XREFと、状態量検出器で検出された電動機回転位置XMとを制御演算器７に入力し、制御演算器７では、比例積分制御などを行うことにより、電動機トルク指令TREFをサーボアンプ１２へ出力し電動機１０を制御する。図中電動機と負荷機械は二重線で結合されているが、二重線は電動機と負荷機械がばね要素で結合されていることを表している。この図では制御対象を２慣性系としているが、当然、剛体系やその他の構成の機械でも、本発明を実施する上で全く問題は無い。
図２は前記指令発生器６において所望の指令を作成する処理手順を示すフローチャートである。この図を用いて、以下、本発明の方法を順を追って説明する。
はじめにステップ1で、基になる指令関数v(t)を用意する。本実施例ではaを移動距離distに依存する変数、bを移動時間を表す変数、k1,k2を調整できるパラメータとする関数として式（５）となるようなべき乗の指令関数を用いる。
FIG. 4 is a block diagram of a control apparatus that implements the method of the present invention. In the figure, reference numeral 6 denotes a command generator 6 for outputting a position or speed command to the control calculator. Normally, a host controller such as an NC controller that outputs a position command and a speed command corresponds to the command generator 6. 7 is a control arithmetic unit, 8 is a state quantity detector, 10 is an electric motor (servo motor), 11 is a load machine, and 12 is a so-called servo amplifier for driving the electric motor 10. The control object 9 is a combination of the electric motor 10 and the load machine 11.
Then, the position command XREF output from the command generator 6 and the motor rotation position XM detected by the state quantity detector are input to the control calculator 7, and the control calculator 7 performs proportional integral control and the like. Then, the motor torque command TREF is output to the servo amplifier 12 to control the motor 10. In the drawing, the electric motor and the load machine are coupled by a double line, but the double line represents that the electric motor and the load machine are coupled by a spring element. In this figure, the controlled object is a two-inertia system, but of course, there is no problem in implementing the present invention even with a rigid system or a machine having another configuration.
FIG. 2 is a flowchart showing a processing procedure for creating a desired command in the command generator 6. Hereinafter, the method of the present invention will be described step by step with reference to this figure.
First, in Step 1, a base command function v (t) is prepared. In the present embodiment, a power command function as shown in Equation (5) is used as a function in which a is a variable depending on the moving distance dist, b is a variable representing the moving time, and k1 and k2 are parameters that can be adjusted.
ステップ２で移動距離distと移動時間bを設定する。これらは普通、機械の動作仕様から決定できる値である。
ステップ３では式（５）で表される関数v(t)のパラメータk1,k2を入力する。
ステップ４で移動距離dist、移動時間b、パラメータk1,k2の値を用いてaの値を計算で求める。例えば以下の式（６）のように媒介変数Dを使用し計算すればよい。
In step 2, the moving distance dist and the moving time b are set. These are usually values that can be determined from the operating specifications of the machine.
In step 3, parameters k1 and k2 of the function v (t) expressed by equation (5) are input.
In step 4, the value of a is calculated by using the values of the movement distance dist, the movement time b, and the parameters k1 and k2. For example, calculation may be performed using the parameter D as shown in the following formula (6).
ステップ５で変数a,b,distそしてパラメータk1,k2を用いて、指令周期ごとの指令を作成し、実際に制御で使用する制御と制御対象のモデルまで含めたシミュレーションを行い、結果を画面上に表示する。
ステップ６でシミュレーション結果の表示を確認しながら、入力したパラメータk1,k2使用時の合否を判定する。否の場合はパラメータk1,k2の値を調整しながら、所望の動作が得られるまでステップ3からステップ５を繰り返し、最終のパラメータk1,k2を決定する。ここで、合否の判定は、どのように行っても良いが、例えば、負荷機械やモータの位置、速度、加速度など、ある状態量に現れる振動の振幅が、予め設定した設定値以内なら合、設定値より大きい場合は否、というようにしても良いし、例えば、モータの速度やトルク指令値、負荷機械の速度や加速度など、ある状態量のピーク値が最小になる時を合、それ以外を否というようにしてもよい。
このように、ある調整できるパラメータk1,k2を有する指令を用い、シミュレーションしながらそれらのパラメータを決定することができるので、簡単で感覚的に、所望の指令を作成することができる指令作成方法およびその装置を提供することができるのである。
ここで、当然、k1とk2は同じ値にしてもよい。以上が実施例１の説明である。
In step 5, using the variables a, b, dist and parameters k1, k2, create a command for each command cycle, perform the simulation including the control actually used in the control and the model to be controlled, and display the result on the screen. To display.
In step 6, while confirming the display of the simulation result, whether or not the input parameters k1 and k2 are used is determined. If not, steps 3 to 5 are repeated until the desired operation is obtained while adjusting the values of parameters k1 and k2, and final parameters k1 and k2 are determined. Here, the determination of pass / fail may be performed in any way.For example, if the amplitude of vibration appearing in a certain state quantity such as the position, speed, acceleration, etc. of the load machine or motor is within a preset set value, If the value is larger than the set value, it may be determined as “No”. For example, when the peak value of a certain state quantity such as the motor speed or torque command value, the speed or acceleration of the load machine is minimized, etc. It may be said that no.
In this way, since a command having parameters k1 and k2 that can be adjusted is used and those parameters can be determined while simulating, a command creation method capable of creating a desired command easily and intuitively and That device can be provided.
Here, of course, k1 and k2 may be the same value. The above is the description of the first embodiment.
次に本発明の第二の実施例について説明する。
ここでは、指令として、加速区間、一定速度区間、減速区間に場合分けされる指令を用いる場合の方法を説明する。
図３は前記指令発生器において所望の指令を作成する処理手順を示すフローチャートである。この図を用いて、以下、本発明の方法を順を追って説明する。
はじめにステップ1で、基になる指令関数α(t)を用意する。本実施例ではa1,a2を移動距離に依存する変数、b1を加速時間を表す変数、ｃを一定速度時間を表す変数、b2を減速時間を表す変数、ｋ11,k12,k21,k22を調整できるパラメータとする関数として式（７）になるようなべき乗の指令関数を用いる。
Next, a second embodiment of the present invention will be described.
Here, a method in the case of using a command divided into an acceleration section, a constant speed section, and a deceleration section as the command will be described.
FIG. 3 is a flowchart showing a processing procedure for creating a desired command in the command generator. Hereinafter, the method of the present invention will be described step by step with reference to this figure.
First, in Step 1, a base command function α (t) is prepared. In this embodiment, a1 and a2 are variables depending on the moving distance, b1 is a variable representing acceleration time, c is a variable representing constant speed time, b2 is a variable representing deceleration time, and k11, k12, k21, and k22 can be adjusted. A power command function as shown in equation (7) is used as a function as a parameter.
ステップ２で移動距離distと加速時間b1、一定速度時間ｃ、減速時間b2を設定する。これらは普通、機械の動作仕様から決定できる値である。
ステップ３では式（７）で表される関数α(t)のパラメータk11,k12,k21,k22を入力する。
ステップ４で移動距離distと加速時間b1、一定速度時間ｃ、減速時間b2、パラメータk11,k12,k21,k22の値を用いてa1,a2の値を計算で求める。例えば以下の式（８）ように媒介変数D1,D2を使用し計算すればよい。
In step 2, a moving distance dist, an acceleration time b1, a constant speed time c, and a deceleration time b2 are set. These are usually values that can be determined from the operating specifications of the machine.
In step 3, parameters k11, k12, k21, and k22 of the function α (t) expressed by equation (7) are input.
In step 4, the values of a1 and a2 are obtained by calculation using the movement distance dist, the acceleration time b1, the constant speed time c, the deceleration time b2, and the values of the parameters k11, k12, k21, and k22. For example, calculation may be performed using parameters D1 and D2 as shown in the following equation (8).
ステップ５で変数a1,a2,b1,b2,c,distそしてパラメータk11,k12,k21,k22を用いて、指令周期ごとの指令を作成し、実際に制御で使用する制御と制御対象のモデルまで含めたシミュレーションを行い、結果を画面上に表示する。
ステップ６でシミュレーション結果の表示を確認しながら、入力したパラメータｋ1,k2使用時の合否を判定する。否の場合はパラメータk11,k12,k21,k22の値を調整しながら、所望の動作が得られるまでステップ3からステップ５を繰り返し、最終のパラメータk11,k12,k21,k22を決定する。ここで、合否の判定は、どのように行っても良いが、例えば、負荷機械やモータの位置、速度、加速度など、ある状態量に現れる振動の振幅が、予め設定した設定値以内なら合、設定値より大きい場合は否、というようにしても良いし、例えば、モータの速度やトルク指令値、負荷機械の速度や加速度など、ある状態量のピーク値が最小になる時を合、それ以外を否というようにしてもよい。
ここで、当然、k11,k12,k21,k22の値は同じ値でもよい。
以上が実施例２の説明である。
尚、シミュレーションし、表示する状態量としては、モータ位置、モータ速度、モータ加速度、モータ躍度、モータトルク指令、負荷位置、負荷速度、負荷加速度、負荷躍度、負荷トルク、機台変位、機台加速度などが考えられるが、その他どのような状態量をシミュレーションし表示しても良い。また当然、これらの状態量の複数の組み合わせを用いてもよい。
また、調整できるパラメータk1,k2,k11,k12,k21,k22は、整数だけに限らず、小数を使用することも可能である。ここで、調整パラメータを小数にした場合、計算機によっては、小数点のべき乗計算の関数を持っていない場合があるが、その場合は、式（９）の関係により、べき乗計算と等価な指数関数expと自然対数lnで計算できる式を用いて計算すればよい。
In step 5, use the variables a1, a2, b1, b2, c, dist and the parameters k11, k12, k21, k22 to create commands for each command period, and then to the model actually used for control and the model to be controlled The simulation is included and the result is displayed on the screen.
In step 6, while confirming the display of the simulation result, whether or not the input parameters k1 and k2 are used is determined. If NO, step 3 to step 5 are repeated while adjusting the values of parameters k11, k12, k21, k22 until a desired operation is obtained, and final parameters k11, k12, k21, k22 are determined. Here, the determination of pass / fail may be performed in any way.For example, if the amplitude of vibration appearing in a certain state quantity such as the position, speed, acceleration, etc. of the load machine or motor is within a preset set value, If the value is larger than the set value, it may be determined as “No”. For example, when the peak value of a certain state quantity such as the motor speed or torque command value, the speed or acceleration of the load machine is minimized, etc. It may be said that no.
Here, naturally, the values of k11, k12, k21, and k22 may be the same value.
The above is the description of the second embodiment.
The state quantities to be simulated and displayed include motor position, motor speed, motor acceleration, motor jerk, motor torque command, load position, load speed, load acceleration, load jerk, load torque, machine base displacement, machine Table acceleration can be considered, but any other state quantity may be simulated and displayed. Of course, a plurality of combinations of these state quantities may be used.
Further, the adjustable parameters k1, k2, k11, k12, k21, and k22 are not limited to integers, and decimal numbers may be used. Here, when the adjustment parameter is set to a decimal, some computers may not have a function for exponentiation of the decimal point. In this case, an exponential function exp equivalent to the power calculation is obtained according to the relationship of Expression (9). And a natural logarithm ln.
以下に、上の手法を実現するための装置について図に基づいて説明する。
図１は本発明の方法を実現する装置の構成図である。図中、１は移動距離distと移動時間ｂあるいは実施例２の場合は加速時間b1,減速時間b2、一定速度時間ｃを設定する移動条件設定手段を表す。これは図２あるいは図３のステップ２の処理に対応する。５はパラメータ入力手段を表し、設定パラメータk1,k2あるいはk11,k12,k21,k22の値を入力する手段である。これは、図２あるいは図３のステップ３に対応するところである。２は指令演算手段を表す。ここでは、移動条件と設定パラメータk1,k2あるいはk11,k12,k21,k22に基づいて、変数aあるいはa1,a2を計算し、各指令周期毎の指令を演算する手段である。これは、図２あるいは図３のステップ４に対応するところである。３はシミュレーション演算手段を表し、指令からユーザが確認したい各状態量までのシミュレーションを行うところである。また、４は３のシミュレーション結果を表示するシミュレーション結果表示手段を表す。構成要素３と４は、ステップ５に対応する部分である。そして、４のシミュレーション結果表示手段を確認しながら、５のパラメータ入力手段で設定パラメータk1,k2あるいはk11,k12,k21,k22を変更し、繰り返しシミュレーションを行うことで、最終的に所望の動作を実現できるk1,k2あるいはk11,k12,k21,k22の値を決定する。
Hereinafter, an apparatus for realizing the above method will be described with reference to the drawings.
FIG. 1 is a block diagram of an apparatus for realizing the method of the present invention. In the figure, reference numeral 1 denotes a movement condition setting means for setting a movement distance dist and a movement time b, or in the case of the second embodiment, an acceleration time b1, a deceleration time b2, and a constant speed time c. This corresponds to the processing of step 2 in FIG. 2 or FIG. Reference numeral 5 denotes parameter input means for inputting the values of the setting parameters k1, k2 or k11, k12, k21, k22. This corresponds to step 3 in FIG. 2 or FIG. Reference numeral 2 represents command calculation means. Here, the variable a or a1, a2 is calculated on the basis of the movement condition and the setting parameters k1, k2, or k11, k12, k21, k22, and a command for each command cycle is calculated. This corresponds to step 4 in FIG. 2 or FIG. Reference numeral 3 denotes a simulation calculation means for performing a simulation from the command to each state quantity that the user wants to check. Reference numeral 4 denotes simulation result display means for displaying the simulation result of 3. Components 3 and 4 are portions corresponding to step 5. Then, while confirming the simulation result display means 4, change the setting parameters k1, k2 or k11, k12, k21, k22 with the parameter input means 5 and perform the simulation repeatedly to finally achieve the desired operation. The values of k1, k2 or k11, k12, k21, k22 that can be realized are determined.
本発明はコントローラのメモリ容量を小さくでき、シミュレーションしながら指令の各パラメータを決定することができるため、サーボシステム制御に慣れていないユーザでも容易に制御指令を作成することができる。また、液晶製造装置や半導体製造装置等の超精密位置決め駆動制御装置の位置決めにも適用することができる。また、本指令作成方法で作成した指令を用い、パラメータｋを調整するだけで、機械の振動を抑制することが可能なため、振動が問題となる、産業用ロボットや剛性の低い工作機等の位置決め用途にも適用することができる。 According to the present invention, the memory capacity of the controller can be reduced, and each parameter of the command can be determined while simulating. Therefore, even a user who is not used to servo system control can easily create a control command. Further, the present invention can be applied to positioning of an ultra-precision positioning drive control device such as a liquid crystal manufacturing device or a semiconductor manufacturing device. Moreover, since it is possible to suppress the vibration of the machine simply by adjusting the parameter k using the command created by this command creation method, such as industrial robots and low-rigidity machine tools that cause vibration. It can also be applied to positioning applications.
１ 移動条件設定手段
２ 指令演算手段
３ シミュレーション演算手段
４ シミュレーション結果表示手段
５ パラメータ入力手段
６ 指令発生器
７ 制御演算器
８ 状態量検出器
９ 制御対象
１０ 電動機
１１ 負荷機械
１２ サーボアンプ
DESCRIPTION OF SYMBOLS 1 Movement condition setting means 2 Command calculation means 3 Simulation calculation means 4 Simulation result display means 5 Parameter input means 6 Command generator 7 Control calculator 8 State quantity detector 9 Control object 10 Electric motor 11 Load machine 12 Servo amplifier
Claims (11)
する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、制御対
象の移動時間、移動距離、速度、加速度等の移動条件に基づいて作成するサーボ制御装置
の指令作成方法において、
aを移動距離distに依存する変数、bを移動時間を表す変数、ｋを調整パラメータとする関数v(t)
a function v (t) where a is a variable depending on the travel distance dist, b is a variable representing the travel time, and k is an adjustment parameter
する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、制御対
象の移動時間、移動距離、速度、加速度等の移動条件に基づいて作成するサーボ制御装置
の指令作成方法において、 aを移動距離distに依存する変数、bを移動時間を表す変数、k1、k2を調整パラメータとする関数v(t)
を速度指令とすることを特徴とするサーボ制御装置の指令作成方法。
A command to be input to a servo control device having a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value. In the servo controller command creation method created based on movement conditions such as movement time, movement distance, speed, and acceleration, a is a variable that depends on movement distance dist, b is a variable that represents movement time, and k1 and k2 are adjusted Function v (t) as parameter
A command generation method for a servo control device, characterized in that the command is a speed command.
たは２記載のサーボ制御装置の指令作成方法。 The servo control device command generation method according to claim 1, wherein the function v (t) is integrated, and the integrated function is used as a position command.
予め指令関数v(t)を用意しておき、移動距離distと移動時間bを移動条件として設定し、
パラメータｋあるいはk1、k2の値を適当な値に設定し、移動距離distと移動時間bと設定されたｋあるいはk1、k2の値を用いて変数aの値を計算で求め、設定されたパラメータｋあるいはk1、k2を用いた指令に基づいてシミュレーションし、シミュレーション結果に基づいてｋあるいはk1、k2の値を調整しながらシミュレーションを繰り返し行い、最終的な値を決定することを特徴とする請求項１乃至３記載のサーボ制御装置の指令作成方法。 As a method for determining the parameter k or k1, k2,
Prepare a command function v (t) in advance, set the movement distance dist and movement time b as movement conditions,
Set the value of parameter k or k1, k2 to an appropriate value, calculate the value of variable a using movement distance dist and movement time b, and the set k or k1, k2 value, and set the parameter The simulation is performed based on a command using k, k1, or k2, and the simulation is repeatedly performed while adjusting the value of k, k1, or k2 based on the simulation result to determine a final value. 4. A method for creating a command for a servo control device according to any one of claims 1 to 3.
移動距離distと移動時間bを設定する移動条件設定手段と、
前記移動時間distに依存する変数ａおよび調整できるパラメータｋあるいはk1、k2を有する速度の指令関数
v(t)=a・t k ・(b-t) k (0≦t≦b)
または、
v(t)=a・t k1 ・(b-t) k2 (0≦t≦b)
に基づいて指令を演算する指令演算手段と、前記調整できるパラメータｋあるいはk 1、k 2の値を入力するパラメータ入力手段と、指令演算手段で作成された指令を用いてシミュレーションを行うシミュレーション演算手段と、シミュレーション結果を表示するシミュレーション結果表示手段を有することを特徴とするサーボ制御装置の指令作成装置。
A command to be input to a servo control device having a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value. In the command creation device of the servo control device created based on the movement conditions such as travel time, travel distance, speed, acceleration, etc.
A movement condition setting means for setting the movement distance dist and the movement time b;
Speed command function with variable a depending on the travel time dist and adjustable parameters k or k1, k2.
v (t) = a ・ t k ・ (bt) k (0 ≦ t ≦ b)
Or
v (t) = a ・ t k1 ・ (bt) k2 (0 ≦ t ≦ b)
Command calculation means for calculating a command based on the parameter, parameter input means for inputting the value of the adjustable parameter k or k 1, k 2, and simulation calculation means for performing a simulation using the command generated by the command calculation means And a command generation device for a servo control device, comprising simulation result display means for displaying a simulation result.
する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、制御対
象の加速時間、一定速度時間、減速時間、移動距離、移動速度等の移動条件に基づいて作
成するサーボ制御装置の指令作成方法において、 a1とa2を移動距離distに依存する変数、b1を加速時間を表す変数、b2を減速時間を表す変数、cを一定速度時間を表す変数、ｋを調整パラメータとする、加速区間、一定速度区間、減速区間で場合分けされた関数
を加速度指令とすることを特徴とするサーボ制御装置の指令作成方法。
A command to be input to a servo control device having a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value. acceleration time, a constant speed period, deceleration time, travel distance, the command generating method of a servo control apparatus for creating, based on movement conditions such as traveling speed, dependent variables of a 1 and a 2 on the moving distance dist, the b 1 Variable representing acceleration time, variable representing b 2 deceleration time, variable representing c constant speed time, adjustment parameter with k as adjustment parameter, divided into acceleration section, constant speed section, and deceleration section
A command generation method for a servo control device, characterized in that an acceleration command is used.
動する信号を計算し出力する制御演算器を備えたサーボ制御装置へ入力する指令を、制御
対象の加速時間、一定速度時間、減速時間、移動距離、移動速度等の移動条件に基づいて
作成するサーボ制御装置の指令作成方法において、 a1とa2を移動距離distに依存する変数、b1を加速時間を表す変数、b2を減速時間を表す変数、cを一定速度時間を表す変数、k11、k12、k21、k22を調整パラメータとする、加速区間、一定速度区間、減速区間で場合分けされた関数α(t)
を加速度指令とすることを特徴とするサーボ制御装置の指令作成方法。 A command to be input to a servo control device having a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value. acceleration time, a constant speed period, deceleration time, travel distance, the command generating method of a servo control apparatus for creating, based on movement conditions such as traveling speed, dependent variables of a 1 and a 2 on the moving distance dist, the b 1 variable representing the acceleration time, b 2 a variable representing the deceleration time, the variable representing the the c constant speed time, and k11, k12, k21, k22 adjustment parameters, the acceleration section, constant speed section, the case analysis in the decelerating interval Function α (t)
A command generation method for a servo control device, characterized in that an acceleration command is used.
前記関数α(t)を積分し、積分された関数を速度指令とすることを特徴とする、請求項
６または７記載の制御装置の指令作成方法。
8. The control device command generation method according to claim 6, wherein the function α (t) is integrated, and the integrated function is used as a speed command.
請求項６または７記載のサーボ制御装置の指令作成方法。 The servo control device command generation method according to claim 6 or 7, wherein the function α (t) is integrated twice, and the function integrated twice is used as a position command.
予め指令関数α(t)を用意しておき、移動距離distあるいは移動速度V、加速時間b1、減速時間b2、一定速度時間ｃを移動条件として設定し、パラメータｋあるいはk11、k12、k21、k22の値を設定し、移動距離distあるいは移動速度V、加速時間b1、減速時間b2、一定速度時間ｃ、設定されたパラメータｋあるいはk11、k12、k21、k22の値を用いて変数a1とa2の値を計算で求め、設定されたパラメータｋあるいはk11、k12、k21、k22を用いた指令に基づいてシミュレーションし、シミュレーション結果に基づいてｋあるいはk11、k12、
k21、k22の値を調整しながらシミュレーションを繰り返し行い、最終的な値を決定することを特徴とする請求項６乃至９記載のサーボ制御装置の指令作成方法。 As a method of determining the parameter k or k11, k12, k21, k22,
A command function α (t) is prepared in advance, and the movement distance dist or movement speed V, acceleration time b 1 , deceleration time b 2 , constant speed time c are set as movement conditions, and the parameter k or k11, k12, k21 , K22, and the variable a 1 using the moving distance dist or moving speed V, the acceleration time b1, the deceleration time b2, the constant speed time c, and the set parameter k or the values of k11, k12, k21, k22. And a 2 are calculated and simulated based on the set parameter k or a command using k11, k12, k21, k22, and k or k11, k12,
10. The servo control device command generation method according to claim 6, wherein a final value is determined by repeatedly performing a simulation while adjusting the values of k21 and k22.
加速区間 α(t)=a 1 ・t k ・(b 1 -t) k (0≦t<b 1 )
一定速度区間 α(t)=0 (b 1 ≦t<b 1 +c)
減速区間 α(t)=-a 2 ・(t-(b 1 +c)) k ・((b 1 +c+b 2 )-t) k (b1+c≦t≦b 1 +c+b 2 )
または、
加速区間 α(t)=a 1 ・t k11 ・(b 1 -t) k21 (0≦t<b 1 )
一定速度区間 α(t)=0 (b 1 ≦t<b 1 +c)
減速区間 α(t)=-a 2 ・(t-(b 1 +c)) k12 ・((b 1 +c+b 2 )-t) k22 (b 1 +c≦t≦b 1 +c+b 2 )
に基づいて指令を演算する指令演算手段と、前記調整パラメータｋあるいはk11、k12、k21、k22の値を入力するパラメータ入力手段と、指令演算手段で作成された指令を用いてシミュレーションを行うシミュレーション演算手段と、シミュレーション結果を表示するシミュレーション結果表示手段を有することを特徴とするサーボ制御装置の指令作成装置。 A command to be input to a servo control device having a state quantity detector that detects a state quantity of the control target and a control arithmetic unit that calculates and outputs a signal for driving the control target based on the command and the detected value. In the servo controller command creation device created based on the travel conditions such as acceleration time, constant speed time, deceleration time, travel distance, travel speed, etc., the travel distance dist or travel speed V and acceleration time b 1 and deceleration time b 2 In the case of an acceleration section, a constant speed section, and a deceleration section having a moving condition setting means for setting a constant speed time c, and variables a1, a2 and adjustment parameters k or k11, k12, k21, k22 depending on the moving distance dist Divided acceleration command function
Acceleration section α (t) = a 1 ・ t k ・ (b 1 -t) k (0 ≦ t <b 1 )
Constant speed section α (t) = 0 (b 1 ≤t <b 1 + c)
Deceleration section α (t) =-a 2 ・ (t- (b 1 + c)) k ・ ((b 1 + c + b 2 ) -t) k (b1 + c ≦ t ≦ b 1 + c + b 2 )
Or
Acceleration section α (t) = a 1 ・ t k11 ・ (b 1 -t) k21 (0 ≦ t <b 1 )
Constant speed section α (t) = 0 (b 1 ≤t <b 1 + c)
Deceleration section α (t) =-a 2 ・ (t- (b 1 + c)) k12 ・ ((b 1 + c + b 2 ) -t) k22 (b 1 + c ≦ t ≦ b 1 + c + b 2 )
Command calculation means for calculating a command based on the above, parameter input means for inputting the value of the adjustment parameter k or k11, k12, k21, k22, and simulation calculation for performing simulation using the command created by the command calculation means And a command generation device for a servo control device, characterized by comprising simulation result display means for displaying a simulation result.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003347373A JP4210921B2 (en) | 2003-10-06 | 2003-10-06 | Command generation method and apparatus for servo control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003347373A JP4210921B2 (en) | 2003-10-06 | 2003-10-06 | Command generation method and apparatus for servo control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2005115556A JP2005115556A (en) | 2005-04-28 |
| JP4210921B2 true JP4210921B2 (en) | 2009-01-21 |
Family
ID=34539970
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003347373A Expired - Lifetime JP4210921B2 (en) | 2003-10-06 | 2003-10-06 | Command generation method and apparatus for servo control device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4210921B2 (en) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CA2546434C (en) | 2003-11-20 | 2013-01-22 | The Henry M. Jackson Foundation For The Advancement Of Military Medicine , Inc. | Portable hand pump for evacuation of fluids |
| US8337475B2 (en) | 2004-10-12 | 2012-12-25 | C. R. Bard, Inc. | Corporeal drainage system |
| WO2007038643A1 (en) | 2005-09-26 | 2007-04-05 | C.R. Bard, Inc. | Catheter connection systems |
| WO2018017365A1 (en) | 2016-07-18 | 2018-01-25 | Merit Medical Systems, Inc. | Inflatable radial artery compression device |
-
2003
- 2003-10-06 JP JP2003347373A patent/JP4210921B2/en not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| JP2005115556A (en) | 2005-04-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4698656B2 (en) | Control system and control support device | |
| JP6567205B1 (en) | Machine learning device, correction parameter adjusting device, and machine learning method | |
| CN102893515B (en) | Motor control device | |
| CN102163952B (en) | Motor control device | |
| JP4973665B2 (en) | Electric motor control device, output filter adjustment method, and output filter adjustment device | |
| JPWO2018029910A1 (en) | Control device for parallel link mechanism | |
| JP2006340480A (en) | Control device of motor and control method | |
| JP6514273B2 (en) | Robot system that displays speed | |
| JP4210921B2 (en) | Command generation method and apparatus for servo control device | |
| JP2013196327A (en) | Cutting distance computing device for multi-axis processing machine | |
| WO2018168230A1 (en) | Processing device, control parameter determination method, and control parameter determination program | |
| CN106426163A (en) | Control apparatus of motor | |
| JP2000148210A (en) | Gain calculating device | |
| JPH09282020A (en) | Servo motor driving device | |
| JP2004348250A (en) | Robot controller | |
| EP0750249B1 (en) | Computer aided-design system | |
| JP4446068B2 (en) | Numerical control device for machine tool and numerical control method for controlling machine tool | |
| KR20040075745A (en) | Input device of power sense providing type | |
| Ali et al. | The effect of parameters variation on bilateral controller | |
| JP6573750B1 (en) | Control data creation device, control data creation method, and control data creation program | |
| JPH0695294B2 (en) | Trajectory interpolation method for industrial robot | |
| JPH086628A (en) | Planning and generating method for movement command with limit of increased increased acceleration | |
| JP2020197951A (en) | Information processing device, machine tool, robot, control method for information processing device and control program for information processing device | |
| JPH07210250A (en) | Compliance controller for manipulator | |
| KR100405718B1 (en) | A method for controlling position of a material and a system thereof |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060906 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20080717 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20080723 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20080911 |
|
| 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: 20081002 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20081015 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111107 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 4210921 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111107 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121107 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121107 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131107 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20141107 Year of fee payment: 6 |
|
| EXPY | Cancellation because of completion of term |