JP2006018431A - Servo control device - Google Patents
Servo control device Download PDFInfo
- Publication number
- JP2006018431A JP2006018431A JP2004193795A JP2004193795A JP2006018431A JP 2006018431 A JP2006018431 A JP 2006018431A JP 2004193795 A JP2004193795 A JP 2004193795A JP 2004193795 A JP2004193795 A JP 2004193795A JP 2006018431 A JP2006018431 A JP 2006018431A
- Authority
- JP
- Japan
- Prior art keywords
- feedforward
- deviation
- controller
- gain
- motor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
Description
本発明は、指令追従精度を必要とする工作機、半導体製造装置、実装機等を駆動するサーボ制御装置に関する。 The present invention relates to a servo control device that drives a machine tool, a semiconductor manufacturing apparatus, a mounting machine, and the like that require command tracking accuracy.
従来のサーボ制御装置は目標指令にモータ出力を一致させるように、モータ制御器に制御入力を与えるサーボ制御装置として、様々な構成が提案されている。(例えば、特許文献1を参照。)
図8は特許文献1に開示された従来のサーボ制御装置を代表する予測制御装置の構成を示すブロック図である。予測制御装置は制御対象の出力を目標指令に一致させるように動作する。図8に示すように予測制御装置は、制御対象1’、予測制御装置4’、フィードフォワード信号作成指令フィルタ6’で構成され、制御対象1’はモータ制御器3’とモータ2’で構成される。
図9は特許文献1に開示された予測制御装置のフィードフォワード信号作成指令フィルタの構成を示すブロック図である。図9に示されるように、フィードフォワード信号作成指令フィルタはフィルタ24、メモリ25、フィードフォワード信号演算器26で構成される。
Various conventional servo control devices have been proposed as servo control devices that give control inputs to the motor controller so that the motor output matches the target command. (For example, see
FIG. 8 is a block diagram showing a configuration of a predictive control device representing the conventional servo control device disclosed in
FIG. 9 is a block diagram showing the configuration of the feedforward signal creation command filter of the prediction control apparatus disclosed in
次に動作について説明する。フィルタは未来の目標指令に関する情報を入力として、その入力した信号、あるいは、その入力した信号を内部のディジタルフィルタ(不図示)でフィルタリングした信号のMサンプリング未来におけるサンプリング周期の間の増分とを指令Δr(i+M)として出力する。ディジタルフィルタは目標指令をフィルタリングする目的で用いられる。メモリはフィルタからの出力された指令増分値を順次記憶して現在時刻iからMサンプリング未来までの指令値Δr(i)、Δr(i+1)、・・・、Δr(i+M)を出力する。フィードフォワード演算器はメモリから出力された指令増分値Δr(i)、Δr(i+1)、・・・、Δr(i+M)からフィードフォワード信号を求め、トルクフィードフォワード信号Tff(i)、速度フィードフォワード信号Vff(i)を生成する。予測制御器はフィードフォワード信号Tff(i)、Vff(i)と指令増分値Δr(i+1)、・・・、Δr(i+M)、制御対象の出力を入力として、フィードフォワード信号および制御入力からの出力までの伝達関数モデルを用いて未来の偏差予測値をもとめ、その未来偏差予測値と制御入力u(i)に関する評価関数が最小となるように制御入力u(i)を決定し、制御対象に出力する。制御対象はモータ制御器とモータから構成されており、モータ制御器は制御入力u(i)とフィードフォワード信号を入力して制御演算をし、モータを駆動する。図8の構成により、従来の予測制御装置は偏差を最小とするフィードフォワード制御器のフィードフォワードゲインを設定することにより加減速度一定時、および速度一定時の偏差を零とし、加速度変化時の偏差を小さくすることができるのである。
しかしながら、従来の予測制御装置は最適なフィードフォワードゲインを設定するために偏差をモニタし、フィードフォワードゲインを手動で設定するため、加減速度一定時、および速度一定時の偏差を零とし、加減速度変化時の偏差を小さくすることができるが、調整が煩雑であるという問題があった。
本発明はこのような問題点に鑑みてなされたものであり、フィードフォワードゲイン変更手段を用いて自動で偏差を最小とするようなフィードフォワードゲインを設定することができるサーボ制御装置を提供することを目的とする。
However, the conventional predictive control device monitors the deviation in order to set the optimum feedforward gain, and manually sets the feedforward gain. Therefore, the deviation at constant acceleration / deceleration and at constant velocity is set to zero, and the acceleration / deceleration is set. Although the deviation at the time of change can be reduced, there is a problem that adjustment is complicated.
The present invention has been made in view of such a problem, and provides a servo control device capable of automatically setting a feed forward gain that minimizes a deviation by using a feed forward gain changing means. With the goal.
請求項1記載の本発明は、目標指令にモータ出力を一致させるように制御するサーボ制御装置であって、モータを制御するモータ制御器と、目標指令とモータ出力と複数のフィードフォワード信号とを入力し、目標指令とモータ出力とを一致させるように制御入力をモータ制御器に出力するフィードバック制御器と、目標指令を入力して加減速度一定時、および速度一定時における目標指令と前記モータ出力との偏差が零となるように複数の補償信号を生成して補償信号にフィードフォワードゲインを乗じた複数のフィードフォワード信号をモータ制御器とフィードバック制御器とに出力するフィードフォワード制御器とを備えたサーボ制御装置において、目標指令とモータ出力との偏差を入力し、フィードフォワード制御器のフィードフォワードゲインを変更するフィードフォワードゲイン変更手段を備えるようにしたものである。
請求項2記載の本発明は、請求項1記載のサーボ制御装置において、フィードフォワードゲイン変更手段は、絶対値出力器とメモリを備え、絶対値出力器は前記偏差の絶対値を演算し、メモリは偏差絶対値に対応した速度フィードフォワードゲインおよびトルクフィードフォワードゲインを記憶し、フィードフォワード制御器には、速度フィードフォワードゲインと、トルクフィードフォワードゲインとを設定して、複数のフィードフォワード信号を作成し、
フィードバック制御器と、モータ制御器とには、フィードフォワード制御器から出力される複数のフィードフォワード信号を入力するようにしたものである。
請求項3記載の本発明は、請求項1記載の本発明において、フィードフォワードゲイン変更手段は、絶対値出力器と積分器とメモリを備え、絶対値出力器は前記偏差の絶対値を演算し、積分器は偏差の絶対値を積分して第1積分補償値を演算し、メモリは第1積分補償値に対応した速度フィードフォワードゲインおよびトルクフィードフォワードゲインを記憶し、フィードフォワード制御器には、速度フィードフォワードゲインと、トルクフィードフォワードゲインとを設定して、複数のフィードフォワード信号を作成し、
フィードバック制御器と、モータ制御器とには、フィードフォワード制御器から出力される複数のフィードフォワード信号を入力するようにしたものである。
請求項4記載の本発明は、請求項1記載のサーボ制御装置において、フィードフォワードゲイン変更手段は二乗値出力器とメモリとを備え、二乗値出力器は偏差の二乗値を演算し、メモリは偏差二乗値に対応した速度フィードフォワードゲインおよびトルクフィードフォワードゲインを記憶し、フィードフォワード制御器には、速度フィードフォワードゲインと、トルクフィードフォワードゲインとを設定して、複数のフィードフォワード信号を作成し、
フィードバック制御器と、モータ制御器とには、フィードフォワード制御器から出力される複数のフィードフォワード信号を入力するようにしたものである。
請求項5記載の本発明は、請求項1記載のサーボ制御装置において、フィードフォワードゲイン変更手段は二乗値出力器と積分器とメモリとを備え、二乗値出力器は偏差の二乗値を演算し、積分器は偏差二乗値を積分して第2積分補償値を演算し、メモリは偏差二乗値に対応した速度フィードフォワードゲインおよびトルクフィードフォワードゲインを記憶し、フィードバック制御器には、偏差に対応した速度フィードフォワードゲインを設定し、モータ制御器には、偏差に対応したトルクフィードフォワードゲインを設定するようにしたものである。
請求項6記載の本発明は、請求項1乃至5のいずれかに記載のサーボ制御装置において、フィードフォワードゲイン変更手段は、ゼロ出力器とスイッチと絶対値出力器とメモリを備え、スイッチは偏差とゼロ出力器のゼロ出力値を加速度変化検出手段の加速度変化信号により切替え、加速度変化時信号がONの時に偏差を入力し、ゼロフィードフォワードの時は0を入力するようにしたものである。
The present invention according to
According to a second aspect of the present invention, in the servo control device according to the first aspect, the feedforward gain changing means includes an absolute value output unit and a memory, and the absolute value output unit calculates an absolute value of the deviation, and the memory Stores the speed feed forward gain and torque feed forward gain corresponding to the absolute deviation value, and sets the speed feed forward gain and torque feed forward gain in the feed forward controller to create multiple feed forward signals. And
A plurality of feedforward signals output from the feedforward controller are input to the feedback controller and the motor controller.
According to a third aspect of the present invention, in the first aspect of the present invention, the feedforward gain changing means includes an absolute value output unit, an integrator, and a memory, and the absolute value output unit calculates an absolute value of the deviation. The integrator integrates the absolute value of the deviation to calculate the first integral compensation value, the memory stores the speed feedforward gain and torque feedforward gain corresponding to the first integral compensation value, and the feedforward controller , Set the speed feed forward gain and torque feed forward gain, create multiple feed forward signals,
A plurality of feedforward signals output from the feedforward controller are input to the feedback controller and the motor controller.
According to a fourth aspect of the present invention, in the servo control device according to the first aspect, the feedforward gain changing means includes a square value output unit and a memory, the square value output unit calculates a square value of the deviation, and the memory is The speed feedforward gain and torque feedforward gain corresponding to the deviation square value are stored, and the feedforward controller sets the speed feedforward gain and torque feedforward gain to create multiple feedforward signals. ,
A plurality of feedforward signals output from the feedforward controller are input to the feedback controller and the motor controller.
According to a fifth aspect of the present invention, in the servo control device according to the first aspect, the feedforward gain changing means includes a square value output unit, an integrator, and a memory, and the square value output unit calculates a square value of the deviation. The integrator integrates the deviation square value to calculate the second integral compensation value, the memory stores the speed feed forward gain and torque feed forward gain corresponding to the deviation square value, and the feedback controller corresponds to the deviation. The speed feed forward gain is set, and the torque feed forward gain corresponding to the deviation is set in the motor controller.
According to a sixth aspect of the present invention, in the servo control device according to any one of the first to fifth aspects, the feedforward gain changing means includes a zero output device, a switch, an absolute value output device, and a memory, and the switch is a deviation. The zero output value of the zero output device is switched by the acceleration change signal of the acceleration change detecting means, and the deviation is input when the acceleration change signal is ON, and 0 is input when zero feed forward.
請求項1の発明によると、目標指令とモータ出力との偏差を最小とするフィードフォワードゲインを自動で設定できる。
請求項2の発明によると、モータ動作時の偏差絶対値の最大値を記憶し、フィードフォワードゲインを自動で変更するので、目標指令とモータ出力との偏差を最小にすることができる。
請求項3の発明によると、モータ動作時の偏差絶対値の積分値を記憶し、フィードフォワードゲインを自動で変更するので、目標指令とモータ出力との偏差を最小にすることができる。
請求項4の発明によると、モータ動作時の偏差2乗値の最大値を記憶し、フィードフォワードゲインを自動で変更するので、目標指令とモータ出力との偏差を最小にすることができる。
請求項5の発明によると、モータ動作時の偏差2乗値の積分値を記憶し、フィードフォワードゲインを自動で変更するので、目標指令とモータ出力との偏差を最小にすることができる。
請求項6の発明によると、加速度変化時信号がONした時のみ目標指令とモータ出力との偏差を請求項1〜請求項5の手段を用いて記憶し、フィードフォワードゲインを変更するので加速度変化時信号がONした時の目標指令とモータ出力との偏差を最小にすることができる。
According to the first aspect of the present invention, it is possible to automatically set the feed forward gain that minimizes the deviation between the target command and the motor output.
According to the second aspect of the present invention, since the maximum deviation absolute value during motor operation is stored and the feedforward gain is automatically changed, the deviation between the target command and the motor output can be minimized.
According to the invention of
According to the invention of claim 4, since the maximum value of the deviation square value at the time of motor operation is stored and the feed forward gain is automatically changed, the deviation between the target command and the motor output can be minimized.
According to the fifth aspect of the invention, since the integral value of the deviation square value at the time of motor operation is stored and the feed forward gain is automatically changed, the deviation between the target command and the motor output can be minimized.
According to the sixth aspect of the invention, the deviation between the target command and the motor output is stored using the means of the first to fifth aspects only when the acceleration change signal is turned on, and the feedforward gain is changed. The deviation between the target command and the motor output when the hour signal is ON can be minimized.
以下、本発明の実施の形態について図を参照して説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
図1は、本発明の第1の実施例を示すサーボ制御装置の構成を示すブロック図である。図において、フィードフォワードゲイン変更手段5は、目標指令からモータ2の出力を減算器8により減算した偏差を入力し、フィードフォワード制御器6内の複数のフィードフォワードゲインを変更することができる。実施例1における目標指令は目標位置指令、モータ2の出力はモータ位置とする。ただし、目標指令は目標速度指令、モータ2の出力はモータ速度としてもよい。
FIG. 1 is a block diagram showing a configuration of a servo control apparatus according to the first embodiment of the present invention. In the figure, the feedforward gain changing means 5 can input a deviation obtained by subtracting the output of the
フィードバック制御器4は、目標指令とフィードフォワード制御器6の出力である複数のフィードフォワード信号とモータ2の出力とを入力し、モータ2の出力を目標指令に一致させるように制御入力をモータ制御器3に与え、フィードフォワード制御器6は、目標指令を入力し、加減速度一定時、及び速度一定時の偏差が零となるように複数の補償信号を生成して、該信号にフィードフォワードゲイン変更手段5で変更したフィードフォワードゲインである速度フィードフォワードゲイン、及びトルクフィードフォワードゲインを乗じた複数のフィードフォワード信号を生成してモータ制御器3と、フィードバック制御器4とに与える。図1におけるフィードフォワード信号は、速度フィードフォワード信号、及びトルクフィードフォワード信号である。
モータ制御器3はフィードバック制御器4から与えられる制御入力と、モータ2の出力と、フィードフォワード制御器6から与えられる速度フィードフォワード信号、及びトルクフィードフォワード信号とを入力し、モータ2を駆動する。
本発明の第1の実施例を示すサーボ制御装置が従来のサーボ制御装置と異なる部分は、目標指令とモータ2の出力との偏差を入力し、フィードフォワード制御器6における速度フィードフォワードゲイン、及びトルクフィードフォワードゲインを変更することができるフィードフォワードゲイン変更手段5を備えた部分である。
本発明の第1の実施例に示すサーボ制御装置におけるフィードフォワードゲイン変更手段5の動作の例を図2に示す。
The feedback controller 4 inputs a target command, a plurality of feedforward signals that are the output of the
The
The servo control device showing the first embodiment of the present invention is different from the conventional servo control device in that the deviation between the target command and the output of the
An example of the operation of the feed forward
図2において、絶対値出力器14は目標指令とモータ2の出力との差である偏差の絶対値を出力する。メモリ11は絶対値出力器14から出力される値を記憶する。速度フィードフォワードゲイン12と、トルクフィードフォワードゲイン13と、は、メモリ11の値を比較し、モータ2の動作後にフィードフォワード制御器6の速度フィードフォワードゲインとトルクフィードフォワードゲインとを変更することができる。
まず、速度フィードフォワードゲイン、トルクフィードフォワードゲイン、の初期値をそれぞれ0として、モータ2を動作させ、偏差絶対値をメモリ11にて記憶する。
次に速度フィードフォワードゲイン=0.1、トルクフィードフォワードゲイン=0に設定し、モータ2を動作させ、前回の偏差絶対値と今回の偏差絶対値とを比較する。
もし、前回の偏差絶対値よりも今回の偏差絶対値の方が小さければ、速度フィードフォワードゲイン=0.2と設定して同様の処理を繰り返す。
もし、前回の偏差絶対値よりも今回の偏差絶対値の方が大きければ、速度フィードフォワードゲイン=0.01と設定して同様の処理を繰り返す。
この動作を繰り返し、偏差絶対値が最小となる速度フィードフォワードゲイン12を見つける。
トルクフィードフォワードゲイン13も速度フィードフォワードゲイン12と同様の手順で偏差絶対値が最小となるトルクフィードフォワードゲイン13を見つけ設定することにより、自動で偏差絶対値の最大値が最小となるフィードフォワードゲインを設定することができる。
In FIG. 2, the absolute value output unit 14 outputs an absolute value of a deviation that is a difference between the target command and the output of the
First, the initial values of the speed feed forward gain and the torque feed forward gain are set to 0, respectively, the
Next, speed feed forward gain = 0.1 and torque feed forward gain = 0 are set, the
If the current deviation absolute value is smaller than the previous deviation absolute value, the speed feedforward gain is set to 0.2 and the same process is repeated.
If the current deviation absolute value is larger than the previous deviation absolute value, the speed feedforward gain is set to 0.01 and the same processing is repeated.
This operation is repeated to find the speed feedforward gain 12 that minimizes the deviation absolute value.
The torque feedforward gain 13 is also a feedforward gain that automatically minimizes the maximum deviation absolute value by finding and setting the torque feedforward gain 13 that minimizes the absolute deviation by the same procedure as the speed feedforward gain 12. Can be set.
本発明の第1の実施例に示すサーボ制御装置におけるフィードフォワードゲイン変更手段5は他の構成も可能である。フィードフォワードゲイン変更手段5の動作の第2の例を図3に示す。図3において、モータ2動作時の目標指令とモータ2の出力との偏差を入力し、偏差絶対値を絶対値出力器14により出力し、該信号の値を積分器15により積分し、該信号をメモリ11により記憶する。メモリ11はモータ2動作後、フィードフォワード制御器6の速度フィードフォワードゲイン12とトルクフィードフォワードゲイン13を変更し、再度モータ2を動作させ、メモリ11に記憶される偏差絶対値の積分値が最小となるような速度フィードフォワードゲイン12とトルクフィードフォワードゲイン13を見つけ設定することにより、自動で偏差絶対値の積分値が最小となるフィードフォワードゲインを設定することができる。
The feedforward gain changing means 5 in the servo control apparatus shown in the first embodiment of the present invention can have other configurations. A second example of the operation of the feedforward gain changing means 5 is shown in FIG. In FIG. 3, the deviation between the target command during the operation of the
本発明の第1の実施例に示すサーボ制御装置におけるフィードフォワードゲイン変更手段5はさらに他の構成も可能である。フィードフォワードゲイン変更手段5の動作の第3の例を図4に示す。図4において、モータ2動作時の目標指令とモータ2の出力との偏差を入力し、その2乗値を2乗値出力器16により出力し、該信号の最大値をメモリ11により記憶する。メモリ11はモータ2動作後、フィードフォワード制御器6の速度フィードフォワードゲイン12とトルクフィードフォワードゲイン13を変更し、再度モータ2を動作させ、メモリ11に記憶される偏差2乗値の最大値が最小となるような速度フィードフォワードゲイン12とトルクフィードフォワードゲイン13を見つけ設定することにより、自動で偏差2乗値の最大値が最小となるフィードフォワードゲインを設定することができる。
The feedforward gain changing means 5 in the servo control apparatus shown in the first embodiment of the present invention can have other configurations. A third example of the operation of the feedforward gain changing means 5 is shown in FIG. In FIG. 4, the deviation between the target command during the operation of the
本発明の第1の実施例に示すサーボ制御装置におけるフィードフォワードゲイン変更手段5はさらに他の構成も可能である。フィードフォワードゲイン変更手段5の動作の第4の例を図5に示す。図5において、モータ2動作時の目標指令とモータ2の出力との偏差を入力し、偏差2乗値を2乗値出力器16により出力し、該信号の値を積分器15により積分し、該信号をメモリ11により記憶する。メモリ11はモータ2動作後、フィードフォワード制御器6の速度フィードフォワードゲイン12とトルクフィードフォワードゲイン13を変更し、再度モータ2を動作させ、メモリ11に記憶される偏差2乗値の積分値が最小となるような速度フィードフォワードゲイン12とトルクフィードフォワードゲイン13を見つけ設定することにより、自動で偏差2乗値の積分値が最小となるフィードフォワードゲインを設定することができる。
The feedforward gain changing means 5 in the servo control apparatus shown in the first embodiment of the present invention can have other configurations. A fourth example of the operation of the feedforward gain changing means 5 is shown in FIG. In FIG. 5, the deviation between the target command at the time of the
図9はフィードフォワード制御器6の一例を示すブロック図である。図9は目標指令を入力し、速度フィードフォワード信号、及びトルクフィードフォワード信号を出力するために、フィードフォワードゲイン演算器22により演算された信号をフィードフォワードゲイン変更手段5により変更された速度フィードフォワードゲイン12を乗じて出力する。さらに、フィードフォワードゲイン演算器21により演算された信号を速度フィードフォワードゲイン12から自動計算される位相調整ゲイン20を乗じて出力する。速度フィードフォワードゲイン12を乗じた出力と、位相調整ゲイン20を乗じた出力の加算値を速度フィードフォワード信号として出力する。
そして、フィードフォワードゲイン演算器23により演算された信号をフィードフォワードゲイン変更手段5により変更されたトルクフィードフォワードゲイン13を乗じ、トルクフィードフォーワード信号として出力する。
FIG. 9 is a block diagram showing an example of the
Then, the signal calculated by the feedforward gain calculator 23 is multiplied by the torque feedforward gain 13 changed by the feedforward
図6は、本発明の第2の実施例を示すサーボ制御装置の構成を示すブロック図である。図において、加速度変化検出手段10は目標指令を入力し、加減速度が変化した時のみONする信号である。
フィードフォワードゲイン変更手段5´は、加速度変化検出手段10の出力である加速度変化時信号と、目標指令からモータ2の出力を減算器8により減算した偏差とを入力し、フィードフォワード制御器6内の複数のフィードフォワードゲインを変更することができる。実施例2における目標指令は目標位置指令、モータ2の出力はモータ位置とする。
ただし、目標指令は目標速度指令、モータ2の出力はモータ速度としてもよい。
フィードバック制御器4は、目標指令とフィードフォワード制御器6の出力である複数のフィードフォワード信号とモータ2の出力とを入力し、モータ2の出力を目標指令に一致させるように制御入力をモータ制御器3に与え、フィードフォワード制御器6は、目標指令を入力し、加減速度一定時、及び速度一定時の偏差が零となるように複数の補償信号を生成して、該信号にフィードフォワードゲイン変更手段5´で変更したフィードフォワードゲインである速度フィードフォワードゲイン、及びトルクフィードフォワードゲインを乗じた複数のフィードフォワード信号を生成してモータ制御器3と、フィードバック制御器4とに与える。図6におけるフィードフォワード信号は、速度フィードフォワード信号、及びトルクフィードフォワード信号である。
モータ制御器3はフィードバック制御器4から与えられる制御入力と、モータ2の出力と、フィードフォワード制御器6から与えられる速度フィードフォワード信号、及びトルクフィードフォワード信号とを入力し、モータ2を駆動する。
FIG. 6 is a block diagram showing the configuration of the servo control apparatus according to the second embodiment of the present invention. In the figure, the acceleration
The feedforward gain changing means 5 ′ inputs an acceleration change signal that is an output of the acceleration
However, the target command may be a target speed command, and the output of the
The feedback controller 4 inputs a target command, a plurality of feedforward signals that are the output of the
The
本発明の第2の実施例を示すサーボ制御装置が従来のサーボ制御装置と異なる部分は、加減速度が変化した時のみONする加速度変化時信号を出力する加速度変化検出手段10と、目標指令とモータ2の出力との偏差を入力し、加速度変化時信号がONになった時のみ偏差を記憶して、フィードフォワード制御器6における速度フィードフォワードゲイン、及びトルクフィードフォワードゲインを変更することができるフィードフォワードゲイン変更手段5とを備えた部分である。
本発明の第2の実施例に示すサーボ制御装置におけるフィードフォワードゲイン変更手段5´の動作の例を図7に示す。図7において、スイッチ17は加速度変化時信号がOフィードフォワードの時はゼロ出力器18から0を出力し、ONの時はモータ2動作時の目標指令とモータ2の出力との偏差を出力する。該信号の絶対値を絶対値出力器14により出力し、該信号の最大値をメモリ11により記憶する。メモリ11はモータ2動作後、フィードフォワード制御器6の速度フィードフォワードゲイン12とトルクフィードフォワードゲイン13を変更し、再度モータ2を動作させ、メモリ11に記憶される偏差絶対値の最大値が最小となるような速度フィードフォワードゲイン12とトルクフィードフォワードゲイン13を見つけ設定することにより、自動で偏差絶対値の最大値が最小となるフィードフォワードゲインを設定することができる。
The servo control device according to the second embodiment of the present invention is different from the conventional servo control device in that the acceleration change detection means 10 that outputs an acceleration change signal that turns ON only when the acceleration / deceleration changes, a target command, The deviation from the output of the
FIG. 7 shows an example of the operation of the feedforward gain changing means 5 ′ in the servo control apparatus shown in the second embodiment of the present invention. In FIG. 7, the switch 17
本発明の第2の実施例に示すサーボ制御装置におけるフィードフォワードゲイン変更手段5´は図7におけるスイッチ17の出力を図3、4、及び5に入力して、フィードフォワードゲインを設定する他の構成も可能である。
このように、フィードフォワードゲイン変更手段5´を用いて、フィードフォワード制御器6における複数のフィードフォワードゲインを自動で設定することで、煩雑な調整を容易にすることができる。
The feedforward gain changing means 5 ′ in the servo control apparatus shown in the second embodiment of the present invention inputs the output of the switch 17 in FIG. 7 to FIGS. 3, 4, and 5 to set the feedforward gain. Configuration is also possible.
Thus, complicated adjustment can be facilitated by automatically setting a plurality of feedforward gains in the
モータ動作中の偏差を最小とすることで追従精度を改善することができるので、同期制御を行うような機械にも適用できる。 Since the tracking accuracy can be improved by minimizing the deviation during motor operation, the invention can be applied to a machine that performs synchronous control.
2 モータ
3 モータ制御器
4 フィードバック制御器
5 フィードフォワードゲイン変更手段
6 フィードフォワード制御器
8 減算器
10 加速度変化検出手段
11 メモリ
12 速度フィードフォワードゲイン
13 トルクフィードフォワードゲイン
14 絶対値出力器
15 積分器
16 2乗値出力器
17 スイッチ
18 ゼロ出力器
20 位相調整ゲイン
21 フィードフォワードゲイン演算器
22 フィードフォワードゲイン演算器
23 フィードフォワードゲイン演算器
2
Claims (6)
前記目標指令と前記モータ出力との偏差を入力し、前記フィードフォワード制御器の前記フィードフォワードゲインを変更するフィードフォワードゲイン変更手段を備えたことを特徴とするサーボ制御装置。 A servo controller for controlling a motor output to coincide with a target command, the motor controller for controlling the motor, the target command, the motor output, and a plurality of feedforward signals are input, and the target command and A feedback controller that outputs a control input to the motor controller so as to match the motor output, and a deviation between the target command and the motor output when the target command is input and the acceleration / deceleration is constant and the speed is constant. A feed-forward controller that generates a plurality of compensation signals so that becomes zero and outputs the plurality of feed-forward signals obtained by multiplying the compensation signal by a feed-forward gain to the motor controller and the feedback controller. In the provided servo control device,
A servo control device comprising feed-forward gain changing means for inputting a deviation between the target command and the motor output and changing the feed-forward gain of the feed-forward controller.
前記絶対値出力器は前記偏差の絶対値を演算し、
前記メモリは前記偏差絶対値に対応した速度フィードフォワードゲインおよびトルクフィードフォワードゲインを記憶し、
前記フィードフォワード制御器には、前記速度フィードフォワードゲインと、前記トルクフィードフォワードゲインとを設定して、複数のフィードフォワード信号を作成し、
前記フィードバック制御器と、前記モータ制御器とには、前記フィードフォワード制御器から出力される複数の前記フィードフォワード信号を入力するようにしたことを特徴とする請求項1記載のサーボ制御装置。 The feedforward gain changing means includes an absolute value output device and a memory,
The absolute value output unit calculates an absolute value of the deviation,
The memory stores a speed feed forward gain and a torque feed forward gain corresponding to the absolute deviation value,
The feedforward controller sets the speed feedforward gain and the torque feedforward gain to create a plurality of feedforward signals,
The servo control device according to claim 1, wherein a plurality of the feedforward signals output from the feedforward controller are input to the feedback controller and the motor controller.
前記絶対値出力器は前記偏差の絶対値を演算し、
前記積分器は前記偏差の絶対値を積分して第1積分補償値を演算し、
前記メモリは前記第1積分補償値に対応した速度フィードフォワードゲインおよびトルクフィードフォワードゲインを記憶し、
前記フィードフォワード制御器には、前記速度フィードフォワードゲインと、前記トルクフィードフォワードゲインとを設定して、複数のフィードフォワード信号を作成し、
前記フィードバック制御器と、前記モータ制御器とには、前記フィードフォワード制御器から出力される複数の前記フィードフォワード信号を入力するようにしたことを特徴とする請求項1記載のサーボ制御装置。 The feedforward gain changing means includes an absolute value output unit, an integrator, and a memory,
The absolute value output unit calculates an absolute value of the deviation,
The integrator integrates the absolute value of the deviation to calculate a first integral compensation value;
The memory stores a speed feed forward gain and a torque feed forward gain corresponding to the first integral compensation value,
The feedforward controller sets the speed feedforward gain and the torque feedforward gain to create a plurality of feedforward signals,
The servo control device according to claim 1, wherein a plurality of the feedforward signals output from the feedforward controller are input to the feedback controller and the motor controller.
前記二乗値出力器は前記偏差の二乗値を演算し、
前記メモリは前記偏差二乗値に対応した速度フィードフォワードゲインおよびトルクフィードフォワードゲインを記憶し、
前記フィードフォワード制御器には、前記速度フィードフォワードゲインと、前記トルクフィードフォワードゲインとを設定して、複数のフィードフォワード信号を作成し、
前記フィードバック制御器と、前記モータ制御器とには、前記フィードフォワード制御器から出力される複数の前記フィードフォワード信号を入力するようにしたことを特徴とする請求項1記載のサーボ制御装置。 The feedforward gain changing means includes a square value output device and a memory,
The square value output unit calculates a square value of the deviation,
The memory stores a speed feed forward gain and a torque feed forward gain corresponding to the deviation square value,
The feedforward controller sets the speed feedforward gain and the torque feedforward gain to create a plurality of feedforward signals,
The servo control device according to claim 1, wherein a plurality of the feedforward signals output from the feedforward controller are input to the feedback controller and the motor controller.
前記二乗値出力器は前記偏差の二乗値を演算し、
前記積分器は前記偏差二乗値を積分して第2積分補償値を演算し、
前記メモリは前記偏差二乗値に対応した速度フィードフォワードゲインおよびトルクフィードフォワードゲインを記憶し、
前記フィードバック制御器には、前記偏差に対応した速度フィードフォワードゲインを設定し、
前記モータ制御器には、前記偏差に対応したトルクフィードフォワードゲインを設定するようにしたことを特徴とする請求項1記載のサーボ制御装置。 The feedforward gain changing means includes a square value output unit, an integrator, and a memory,
The square value output unit calculates a square value of the deviation,
The integrator integrates the deviation square value to calculate a second integral compensation value;
The memory stores a speed feed forward gain and a torque feed forward gain corresponding to the deviation square value,
In the feedback controller, a speed feedforward gain corresponding to the deviation is set,
2. The servo control device according to claim 1, wherein a torque feed forward gain corresponding to the deviation is set in the motor controller.
前記スイッチは前記偏差と前記ゼロ出力器のゼロ出力値を加速度変化検出手段の加速度変化信号により切替え、
前記加速度変化時信号がオンの時に前記偏差を入力し、オフの時は0を入力することを特徴とする請求項1乃至5のいずれかに記載のサーボ制御装置。 The feedforward gain changing means includes a zero output device, a switch, an absolute value output device, and a memory,
The switch switches the deviation and the zero output value of the zero output device by an acceleration change signal of an acceleration change detection means,
6. The servo control device according to claim 1, wherein the deviation is input when the acceleration change signal is on and 0 is input when the acceleration change signal is off.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004193795A JP2006018431A (en) | 2004-06-30 | 2004-06-30 | Servo control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004193795A JP2006018431A (en) | 2004-06-30 | 2004-06-30 | Servo control device |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2006018431A true JP2006018431A (en) | 2006-01-19 |
Family
ID=35792672
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004193795A Pending JP2006018431A (en) | 2004-06-30 | 2004-06-30 | Servo control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2006018431A (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010082452A1 (en) * | 2009-01-13 | 2010-07-22 | パナソニック株式会社 | Control device and control method for elastic actuator and control program |
JP2018152012A (en) * | 2017-03-15 | 2018-09-27 | ファナック株式会社 | Machine learning device, servo control device, servo control system, and machine learning method |
WO2019171781A1 (en) | 2018-03-07 | 2019-09-12 | オムロン株式会社 | Servo control method |
WO2021131215A1 (en) * | 2019-12-24 | 2021-07-01 | パナソニックIpマネジメント株式会社 | Vehicle control device and vehicle |
CN114153237A (en) * | 2021-10-25 | 2022-03-08 | 河北汉光重工有限责任公司 | Servo stabilized platform speed prediction control method and device |
US11809148B2 (en) | 2019-06-28 | 2023-11-07 | Omron Corporation | Parameter adjustment method for adjusting control parameters for device that performs servo control |
-
2004
- 2004-06-30 JP JP2004193795A patent/JP2006018431A/en active Pending
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010082452A1 (en) * | 2009-01-13 | 2010-07-22 | パナソニック株式会社 | Control device and control method for elastic actuator and control program |
JP2010221399A (en) * | 2009-01-13 | 2010-10-07 | Panasonic Corp | Control device, control method, and control program of elastic body actuator |
JP4563512B2 (en) * | 2009-01-13 | 2010-10-13 | パナソニック株式会社 | Control device and control method for elastic actuator, and control program |
JPWO2010082452A1 (en) * | 2009-01-13 | 2012-07-05 | パナソニック株式会社 | Control device and control method for elastic actuator, and control program |
US8700215B2 (en) | 2009-01-13 | 2014-04-15 | Panasonic Corporation | Control apparatus and control method of elastic body actuator as well as control program thereof |
US10564619B2 (en) | 2017-03-15 | 2020-02-18 | Fanuc Corporation | Machine learning device, servo control device, servo control system, and machine learning method |
JP2018152012A (en) * | 2017-03-15 | 2018-09-27 | ファナック株式会社 | Machine learning device, servo control device, servo control system, and machine learning method |
WO2019171781A1 (en) | 2018-03-07 | 2019-09-12 | オムロン株式会社 | Servo control method |
JP2019159382A (en) * | 2018-03-07 | 2019-09-19 | オムロン株式会社 | Servo control method |
CN111095131A (en) * | 2018-03-07 | 2020-05-01 | 欧姆龙株式会社 | Servo control method |
US11353830B2 (en) | 2018-03-07 | 2022-06-07 | Omron Corporation | Servo control method |
CN111095131B (en) * | 2018-03-07 | 2024-03-22 | 欧姆龙株式会社 | Servo control method |
US11809148B2 (en) | 2019-06-28 | 2023-11-07 | Omron Corporation | Parameter adjustment method for adjusting control parameters for device that performs servo control |
WO2021131215A1 (en) * | 2019-12-24 | 2021-07-01 | パナソニックIpマネジメント株式会社 | Vehicle control device and vehicle |
JP2021103350A (en) * | 2019-12-24 | 2021-07-15 | パナソニックIpマネジメント株式会社 | Vehicle control device and vehicle |
CN114153237A (en) * | 2021-10-25 | 2022-03-08 | 河北汉光重工有限责任公司 | Servo stabilized platform speed prediction control method and device |
CN114153237B (en) * | 2021-10-25 | 2024-05-31 | 河北汉光重工有限责任公司 | Servo stabilized platform speed prediction control method and device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4575508B1 (en) | Servo control device for dual position feedback control | |
CN106873506B (en) | Correction device, control method for correction device, information processing program, and recording medium | |
JP4043996B2 (en) | Servo motor drive control device | |
JP2004288164A (en) | Synchronous control device | |
JPWO2006011519A1 (en) | Servo control device | |
US7224141B2 (en) | Position controller of motor | |
JP2012104047A (en) | Servo controller | |
JP2008299573A (en) | Digital control device | |
JP2007336705A (en) | Motor controller | |
JP2006018431A (en) | Servo control device | |
JP6469320B1 (en) | Servo control device | |
JP2003169488A (en) | Controller of servo motor and control method | |
JP2009015575A (en) | Two-degree of freedom digital controller | |
JP2002091570A (en) | Servo control method | |
JP2003330510A (en) | Synchronous control method of numerical control apparatus | |
JP2010086395A (en) | Two-degree-of-freedom digital controller | |
JP2006217746A (en) | Motor controller | |
JP3063562B2 (en) | Moving body speed control method and its control device | |
JP2007299122A (en) | Servo controller and method for adjusting the same | |
JPS63276604A (en) | Process controller | |
JP2005285030A (en) | Servo control apparatus | |
JP2003274684A (en) | Servo controlling apparatus | |
JP2000020104A (en) | Method and device for speed control gain adjustment | |
JPH0876811A (en) | Process controller | |
JPH09289788A (en) | Synchronous control device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070515 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090204 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090212 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20090618 |