JP2018005729A - Servo control device, servo control method, and servo control program - Google Patents
Servo control device, servo control method, and servo control program Download PDFInfo
- Publication number
- JP2018005729A JP2018005729A JP2016134274A JP2016134274A JP2018005729A JP 2018005729 A JP2018005729 A JP 2018005729A JP 2016134274 A JP2016134274 A JP 2016134274A JP 2016134274 A JP2016134274 A JP 2016134274A JP 2018005729 A JP2018005729 A JP 2018005729A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- servo motor
- value
- command value
- proportional gain
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Abstract
Description
本発明は、サーボ制御装置、サーボ制御方法、及びサーボ制御用プログラムに関する。 The present invention relates to a servo control device, a servo control method, and a servo control program.
サーボモータは送り軸を駆動する用途等に使用される。サーボモータの速度を制御する速度制御ループには、一般的にPID制御が制御則として採用され、比例ゲインと積分ゲイン、場合によっては微分ゲインが存在する。
速度制御ループゲインの最適値は、モータ単体だけではなく、サーボモータに接続される機械の特性(負荷イナーシャ比や共振周波数など)にも依存して決まる。
Servo motors are used for purposes such as driving a feed shaft. In a speed control loop for controlling the speed of the servo motor, PID control is generally adopted as a control law, and there are a proportional gain, an integral gain, and in some cases a differential gain.
The optimum value of the speed control loop gain is determined depending not only on the motor alone but also on the characteristics of the machine connected to the servo motor (load inertia ratio, resonance frequency, etc.).
サーボモータはさまざまな機械の駆動軸等として使用されるため、予め最適値を決めておくことができない。そこで、モータ単体である応答性になるように速度制御ループゲインの初期値を決め、その初期値に定数を乗算することで機械に合わせた応答性が得られるように調整が行われている。速度制御ループゲインの初期値は、速度制御ループがモータ単体である応答性になるようにモータ毎に決められている。 Since the servo motor is used as a drive shaft of various machines, an optimum value cannot be determined in advance. Therefore, the initial value of the speed control loop gain is determined so that the responsiveness of the motor alone is obtained, and the initial value is multiplied by a constant so that the responsiveness matched to the machine is obtained. The initial value of the speed control loop gain is determined for each motor so that the speed control loop is responsive to a single motor.
例えば特許文献1に、制御系に遅れ時間が存在しない場合に、減衰特性を一定に保ちながら応答性を大きくするために、積分ゲインを比例ゲイン倍率の2乗で大きくしていくことの開示がある。 For example, Patent Document 1 discloses that when there is no delay time in the control system, the integral gain is increased by the square of the proportional gain magnification in order to increase the response while keeping the damping characteristic constant. is there.
しかし、速度制御ループには、速度制御ループの内側にある電流制御ループの応答性による遅れ、速度検出器の通信の遅れ、速度制御ループの計算周期による遅れ等の遅れが存在するため、積分ゲインを比例ゲイン倍率の2乗で大きくしていくと、速度ゲインは積分ゲインのみによる限界で制限されてしまい、比例ゲインを十分に高くとることができないことになる。 However, in the speed control loop, there are delays such as delay due to the response of the current control loop inside the speed control loop, communication delay of the speed detector, delay due to the calculation period of the speed control loop, etc. Is increased by the square of the proportional gain magnification, the speed gain is limited by the limit of only the integral gain, and the proportional gain cannot be made sufficiently high.
本発明は、制御系に遅れ時間が存在する場合において、遅れ時間に応じて適正な倍率を積分ゲインに掛けることで、応答性を高めることができる、サーボ制御装置、サーボ制御方法、及びサーボ制御用プログラムを提供することを目的とする。 The present invention relates to a servo control device, a servo control method, and a servo control that can enhance responsiveness by multiplying an integral gain by an appropriate magnification according to the delay time when the control system has a delay time. The purpose is to provide a program.
本発明に係るサーボモータ制御装置は、サーボモータを駆動するための速度指令値を作成する速度指令作成部と、
前記サーボモータの速度を検出する速度検出部と、
前記速度指令作成部が作成した速度指令値と前記速度検出部が検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令作成部と、
を具備し、
速度制御ループは前記速度検出部と前記トルク指令作成部とを有し、
前記トルク指令作成部は前記差がそれぞれ入力される積分ゲインと比例ゲインとを有し、
前記積分ゲインと前記比例ゲインは、モータモデルごとにあらかじめ決められた初期値に、前記サーボモータのロータイナーシャに対する機械の負荷イナーシャの比を用いた係数を乗算したものに対して、それぞれ積分ゲイン倍率と比例ゲイン倍率をさらに乗算して得られ、
前記積分ゲイン倍率を前記速度制御ループの遅れ時間に応じて前記比例ゲイン倍率の2乗よりも小さい値とすることを特徴とするサーボモータ制御装置である。
The servo motor control device according to the present invention includes a speed command creating unit that creates a speed command value for driving the servo motor,
A speed detector for detecting the speed of the servo motor;
A torque command creating unit that creates a torque command value to the servo motor using a difference between a speed command value created by the speed command creating unit and a speed detected value detected by the speed detecting unit;
Comprising
The speed control loop includes the speed detector and the torque command generator.
The torque command generator has an integral gain and a proportional gain to which the difference is input,
The integral gain and the proportional gain are obtained by multiplying an initial value predetermined for each motor model by a coefficient using a ratio of the load inertia of the machine to the rotor inertia of the servo motor. Obtained by further multiplying by the proportional gain magnification,
The servo motor controller according to claim 1, wherein the integral gain magnification is set to a value smaller than the square of the proportional gain magnification in accordance with a delay time of the speed control loop.
本発明に係るサーボモータ制御方法は、サーボモータを駆動するための速度指令値を作成する速度指令値作成ステップと、
前記サーボモータの速度を検出する速度検出ステップと、
作成した前記速度指令値と、検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令値作成ステップと、を備え、
該トルク指令値によって、前記サーボモータを制御する、サーボモータ制御装置のサーボモータ制御方法において、
速度制御ループで少なくとも前記速度検出ステップと前記トルク指令作成ステップを行い、
前記トルク指令作成ステップは前記差にそれぞれ積分ゲインと比例ゲインとを乗算するステップを含み、
前記積分ゲインと前記比例ゲインは、モータモデルごとにあらかじめ決められた初期値に、前記サーボモータのロータイナーシャに対する機械の負荷イナーシャの比を用いた係数を乗算したものに対して、それぞれ積分ゲイン倍率と比例ゲイン倍率をさらに乗算して得られ、
前記積分ゲイン倍率は前記速度制御ループの遅れ時間に応じて前記比例ゲイン倍率の2乗よりも小さい値であることを特徴とするサーボモータ制御方法である。
The servo motor control method according to the present invention includes a speed command value creating step for creating a speed command value for driving the servo motor,
A speed detecting step for detecting the speed of the servo motor;
A torque command value creating step for creating a torque command value to the servo motor using a difference between the created speed command value and the detected speed detected value;
In a servo motor control method of a servo motor control apparatus for controlling the servo motor according to the torque command value,
Performing at least the speed detection step and the torque command generation step in a speed control loop;
The torque command generating step includes multiplying the difference by an integral gain and a proportional gain, respectively.
The integral gain and the proportional gain are obtained by multiplying an initial value predetermined for each motor model by a coefficient using a ratio of the load inertia of the machine to the rotor inertia of the servo motor. Obtained by further multiplying by the proportional gain magnification,
The servo motor control method according to claim 1, wherein the integral gain magnification is a value smaller than the square of the proportional gain magnification in accordance with a delay time of the speed control loop.
本発明に係るサーボモータ制御用プログラムは、サーボモータを制御するサーボモータ制御装置としてのコンピュータに、
前記サーボモータを駆動するための速度指令値を作成する速度指令値作成処理と、
前記サーボモータの速度を検出する速度検出処理と、
作成した前記速度指令値と、検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令値作成処理と、を実行させ、
速度制御ループで少なくとも前記速度検出処理と前記トルク指令作成処理を行い、
前記トルク指令作成処理は前記差にそれぞれ積分ゲインと比例ゲインとを乗算し、
前記積分ゲインと前記比例ゲインは、モータモデルごとにあらかじめ決められた初期値に、前記サーボモータのロータイナーシャに対する機械の負荷イナーシャの比を用いた係数を乗算したものに対して、それぞれ積分ゲイン倍率と比例ゲイン倍率をさらに乗算して得られ、
前記積分ゲイン倍率は前記速度制御ループの遅れ時間に応じて前記比例ゲイン倍率の2乗よりも小さい値であることを特徴とする、サーボモータ制御用プログラムである。
The servo motor control program according to the present invention is stored in a computer as a servo motor control device that controls a servo motor.
A speed command value creating process for creating a speed command value for driving the servo motor;
A speed detection process for detecting the speed of the servo motor;
A torque command value creating process for creating a torque command value to the servo motor using a difference between the created speed command value and the detected speed detected value;
Perform at least the speed detection process and the torque command generation process in a speed control loop,
The torque command creation process multiplies the difference by an integral gain and a proportional gain,
The integral gain and the proportional gain are obtained by multiplying an initial value predetermined for each motor model by a coefficient using a ratio of the load inertia of the machine to the rotor inertia of the servo motor. Obtained by further multiplying by the proportional gain magnification,
The integral gain magnification is a servo motor control program characterized in that the integral gain magnification is a value smaller than the square of the proportional gain magnification in accordance with a delay time of the speed control loop.
本発明によれば、速度制御ループに遅れ時間が存在する場合において、遅れ時間に応じて適正な倍率を積分ゲインに掛けることで、応答性を高めることができる。 According to the present invention, when there is a delay time in the speed control loop, the response can be improved by multiplying the integral gain by an appropriate magnification according to the delay time.
以下、本発明の一実施形態について図面を用いて詳細に説明する。
速度制御ループに遅れ時間が存在しない場合の、本発明の実施形態の前提となる技術について説明する。
従来は機械の剛性が高くなかった点と、高周波の機械共振を回避するためのフィルタ技術が十分でなかった点から、速度制御ループゲインの初期値に掛かる倍率はそれほど高く設定されていなかった。
Hereinafter, an embodiment of the present invention will be described in detail with reference to the drawings.
A technique which is a premise of the embodiment of the present invention when there is no delay time in the speed control loop will be described.
Conventionally, the magnification applied to the initial value of the speed control loop gain has not been set so high because the rigidity of the machine was not high and the filter technology for avoiding high-frequency mechanical resonance was insufficient.
しかし、機械の剛性が高くなり、機械共振を回避するフィルタ技術の向上により速度制御ループゲインの初期値からの倍率が高くなってきた。
制御系に遅れ時間がまったく存在しないとすると、制御系のブロック図は図5に示すようなブロック図である。
外乱dから出力yまでの伝達関数は、数式1(数1として示す)となる。
If there is no delay time in the control system, the block diagram of the control system is a block diagram as shown in FIG.
The transfer function from the disturbance d to the output y is expressed by Equation 1 (shown as Equation 1).
モータモデルごとに、ある基準の応答性であらかじめ決められた、積分ゲインの初期値は以下の数式4(数4として示す)のように決め、比例ゲインの初期値は数式5(数5として示す)のように決める。
従来は比例ゲインと積分ゲインとを同じ倍率で上げることで調整を行っていた。負荷イナーシャ比を考慮するためであればこれで良いが、これによって応答性も調整すると、減衰特性がゲイン倍率によって変わってしまうという課題があった。また、速度ゲインの限界は比例ゲインのみで制限されるため、積分ゲインを高くとることができなかった。 Conventionally, adjustment is performed by increasing the proportional gain and the integral gain at the same magnification. This is sufficient if the load inertia ratio is taken into account. However, if the response is also adjusted by this, there is a problem that the attenuation characteristic changes depending on the gain magnification. Further, since the limit of the speed gain is limited only by the proportional gain, the integral gain cannot be increased.
速度制御ループに遅れ時間が存在しない場合に、既に説明したように、特許文献1では、減衰特性を一定に保ちながら応答性を大きくするために、積分ゲインは比例ゲイン倍率の2乗で大きくしていた。
しかし、速度制御ループの内側にある電流制御ループの応答性による遅れ、速度検出器の通信の遅れ、速度制御ループの計算周期による遅れ等の遅れが存在するため、積分ゲインを比例ゲイン倍率の2乗で大きくしていくと、速度ゲインは積分ゲインのみによる限界で制限されてしまい、比例ゲインを十分に高くとることができなかった。
In the case where there is no delay time in the speed control loop, as described above, in Patent Document 1, in order to increase the response while keeping the attenuation characteristic constant, the integral gain is increased by the square of the proportional gain magnification. It was.
However, since there are delays due to the response of the current control loop inside the speed control loop, communication delay of the speed detector, delay due to the calculation period of the speed control loop, etc., the integral gain is set to 2 of the proportional gain magnification. As the power gain is increased, the speed gain is limited only by the integral gain, and the proportional gain cannot be made sufficiently high.
以下、本発明の実施形態について図面を用いて詳細に説明する。
図1は本発明の一実施形態のサーボモータ制御装置及びサーボモータを示すブロック図である。図1に示すサーボモータ制御装置は、サーボモータ10の回転の速度を検出して速度値を出力する速度検出部20、サーボモータ10に対する速度指令を作成して出力する速度指令作成部30、トルク指令作成部40及び速度指令値と速度値との差を求める減算器50を備えている。トルク指令作成部40は、減算器50と接続される、比例ゲイン401及び積分ゲイン402、積分ゲイン402と接続される積分器403、速度指令と検出された速度とを用いて、速度制御ループで生ずる遅れ時間を検出する遅れ検出部404、比例ゲイン401と積分ゲインのゲインを調整するゲイン制御部405、及び比例ゲイン401の出力と積分器403の出力とを加算し、トルク指令としてサーボモータ10に出力する加算器406を備えている。積分ゲイン402は入力に係数を乗算し、積分器403は積分ゲイン402の出力を積分する。比例ゲイン401は入力に係数を乗算する。ゲイン制御部405は検出された遅れ時間に応じて、積分ゲイン倍率を比例ゲイン倍率の2乗よりも小さい値とするように積分ゲイン402を制御する。サーボモータ10は工作機械、産業機械の軸を駆動する。
Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.
FIG. 1 is a block diagram showing a servo motor control device and a servo motor according to an embodiment of the present invention. The servo motor control device shown in FIG. 1 includes a
速度制御ループに遅れ時間が存在する場合は、積分ゲイン倍率を比例ゲイン倍率の2乗で大きくすると、倍率を大きくするにつれて積分ゲインが過剰になることが分かった。積分ゲインが過剰になると、オーバシュートが大きくなり、振動的になってしまう。本発明者は遅れ時間に応じて比例ゲイン倍率の2乗よりも小さい値を積分ゲインに掛けることで(積分ゲイン倍率<比例ゲイン倍率の2乗とする)、減衰特性をあまり変えずに、応答性を高めることができることを見出した。 When the delay time exists in the speed control loop, it has been found that if the integral gain magnification is increased by the square of the proportional gain magnification, the integral gain becomes excessive as the magnification is increased. If the integral gain is excessive, the overshoot becomes large and becomes oscillating. The present inventor multiplies the integral gain by a value smaller than the square of the proportional gain magnification according to the delay time (integral gain magnification <square of the proportional gain magnification), and does not change the attenuation characteristic so much. We found that it can improve the sex.
積分ゲイン倍率を比例ゲイン倍率の2乗よりも小さい値とするために、本実施形態では、(積分ゲイン倍率)=(比例ゲイン倍率)β(1≦β<2)で求める。ただし、本実施形態で示したこれらの方法は一例であり、その他の方法により積分ゲイン倍率を比例ゲイン倍率の2乗よりも小さい値としてもよい。値βは速度制御ループで生ずる遅れ時間を用いて決めることができる。速度制御ループで生ずる遅れ時間は、既に説明したように、電流制御ループの応答性による遅れ、速度検出器の通信の遅れ、速度制御ループの計算周期による遅れ等によって生ずるが、この遅れはモータ特性や速度制御ループを構成する回路の特性で決まり、予め決めることができる。よって、値βも予め決めることができる。 In order to set the integral gain magnification to a value smaller than the square of the proportional gain magnification, in this embodiment, (integral gain magnification) = (proportional gain magnification) β (1 ≦ β <2). However, these methods shown in the present embodiment are merely examples, and the integral gain magnification may be set to a value smaller than the square of the proportional gain magnification by other methods. The value β can be determined using the delay time generated in the speed control loop. As described above, the delay time generated in the speed control loop is caused by the delay due to the response of the current control loop, the communication delay of the speed detector, the delay due to the calculation period of the speed control loop, etc. It is determined by the characteristics of the circuits constituting the speed control loop and can be determined in advance. Therefore, the value β can also be determined in advance.
本実施形態では速度制御ループで生ずる遅れ時間の変動を考慮して、速度指令と検出された速度とを用いて、遅れ検出部404によって速度制御ループで生ずる遅れ時間を検出している。速度指令に対する、フィールドバックされる速度の遅れ時間を測定することで、速度制御ループで生ずる遅れ時間を検出することができる。値βを予め決める場合には、図1の遅れ検出部404は不要である。
In the present embodiment, in consideration of the fluctuation of the delay time generated in the speed control loop, the delay time generated in the speed control loop is detected by the
積分ゲイン倍率を比例ゲイン倍率のβ乗で大きくする場合、積分ゲインki、比例ゲインkpは数式6(数6として示す)で表すことができる。
数式3、数式5に示した、ωn/ωn0は速度ゲイン倍率VGである。比例ゲイン倍率は速度ゲイン倍率VG(VG=ωn/ωn0)、積分ゲイン倍率は速度ゲイン倍率VGのβ乗(VGβ=(ωn/ωn0)β)となる。積分ゲイン倍率の減算量やβの値は出荷時に予め決めておくことができるが、速度ゲイン倍率VGは機械特性の影響を受けるため、出荷時に予め決めておくことはできないので、サーボモータに接続される工作機械等の特性に従って適宜設定する。
When the integral gain magnification is increased by the β power of the proportional gain magnification, the integral gain k i and the proportional gain k p can be expressed by Equation 6 (shown as Equation 6).
Ω n / ω n0 shown in Equation 3 and Equation 5 is the speed gain magnification VG. The proportional gain magnification is the speed gain magnification VG (VG = ω n / ω n0 ), and the integral gain magnification is the β power of the speed gain magnification VG (VG β = (ω n / ω n0 ) β ). The subtraction amount and β value of the integral gain magnification can be determined in advance at the time of shipment, but the speed gain magnification VG is affected by the mechanical characteristics and cannot be determined in advance at the time of shipment. Set as appropriate according to the characteristics of the machine tool to be used.
図2は図1に示されたサーボモータ制御装置の動作を示すフローチャートである。
まず、ステップS101において、速度指令作成部30が速度指令を作成し、ステップS102において速度検出部20が速度を検出する。次に、ステップS103において、モータモデルごとに予め決められた初期値に、ロータイナーシャに対する機械の負荷イナーシャの比を用いた係数(1+JL/Jm)(図2のステップ103においては、負荷イナーシャ比として示している)を乗算し、調整された積分ゲイン倍率と比例ゲイン倍率をそれぞれ乗算して、積分ゲイン倍率と比例ゲイン倍率とを求める。次に、ステップS104において、速度指令値と速度値との差を求め、その差を用いて、積分ゲイン402の出力値を積分した積分器403の出力値と、比例ゲイン401の出力値とを加算器406で加算してトルク指令を作成し、出力する。
FIG. 2 is a flowchart showing the operation of the servo motor control apparatus shown in FIG.
First, in step S101, the speed
図3は速度ゲインを求める方法を示すフローチャートである。値βを、モータ特性や速度制御ループを構成する回路の特性から求める(ステップS201)。次にゲインの安定余裕があるかないかを判断する(ステップS202)。安定余裕がある場合には速度ゲイン倍率を大きくし(ステップS203)、ステップS202に戻る。安定余裕がない場合には初めに設定された速度ゲイン倍率を維持する。 FIG. 3 is a flowchart showing a method for obtaining the speed gain. The value β is obtained from the motor characteristics and the characteristics of the circuits constituting the speed control loop (step S201). Next, it is determined whether or not there is a gain stability margin (step S202). If there is a stability margin, the speed gain magnification is increased (step S203), and the process returns to step S202. When there is no stability margin, the initially set speed gain magnification is maintained.
図4は速度指令作成部、位置検出部、位置指令作成部、及びサーボモータを示すブロック図である。
位置指令作成部70は位置指令を作成し、位置検出部60はサーボモータ10の回転の位置を検出する。位置指令値と位置との差を減算器80で求め、その差を位置制御ゲイン301と微分部302とに入力する。加算器304は、微分部302の出力に係数を乗算する係数部303の出力と、位置制御ゲイン301の出力との加算値を速度指令として出力する。
FIG. 4 is a block diagram showing a speed command creation unit, a position detection unit, a position command creation unit, and a servo motor.
The position
以上、本発明の実施形態について説明したが、サーボモータ制御装置はその機能の全部又は一部をハードウェア、ソフトウェア又はこれらの組み合わせにより実現することができる。ここで、ソフトウェアによって実現されるとは、コンピュータがプログラムを読み込んで実行することにより実現されることを意味する。 Although the embodiments of the present invention have been described above, the servo motor control device can realize all or part of its functions by hardware, software, or a combination thereof. Here, “realized by software” means realized by a computer reading and executing a program.
ソフトウェアによって実現する場合、サーボモータ制御装置の一部又は全部を、CPUとプログラムを記憶したハードディスク、ROM等の記憶部とを含むコンピュータで構成して、図1のブロック図及び図2、図3のフローチャートに沿ったプログラムに従い、演算に必要な情報をRAM等の第2の記憶部に記憶し、処理を実行することでサーボモータ制御装置の一部又は全部の動作をプログラムで実行ことができる。プログラムは、プログラムが記録されたCD−ROM、DVD、フラッシュメモリ等の外部記憶媒体からハードディスク等の記憶部に読み込むことができる。 When realized by software, a part or all of the servo motor control device is configured by a computer including a CPU and a storage unit such as a hard disk and a ROM storing programs, and the block diagram of FIG. 1 and FIGS. According to the program in accordance with the flowchart, information necessary for calculation is stored in a second storage unit such as a RAM, and a part or all of the operation of the servo motor control device can be executed by the program by executing the process. . The program can be read into a storage unit such as a hard disk from an external storage medium such as a CD-ROM, DVD, or flash memory in which the program is recorded.
10 サーボモータ
20 速度検出部
30 速度指令作成部
50 減算器
60 位置検出部
70 位置指令作成部
80 減算器
401 比例ゲイン
402 積分ゲイン
403 積分器
404 遅れ検出部
405 ゲイン制御部
406 減算器
DESCRIPTION OF
Claims (9)
前記サーボモータの速度を検出する速度検出部と、
前記速度指令作成部が作成した速度指令値と前記速度検出部が検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令作成部と、
を具備し、
速度制御ループは前記速度検出部と前記トルク指令作成部とを有し、
前記トルク指令作成部は前記差がそれぞれ入力される積分ゲインと比例ゲインとを有し、
前記積分ゲインと前記比例ゲインは、モータモデルごとにあらかじめ決められた初期値に、前記サーボモータのロータイナーシャに対する機械の負荷イナーシャの比を用いた係数を乗算したものに対して、それぞれ積分ゲイン倍率と比例ゲイン倍率をさらに乗算して得られ、
前記積分ゲイン倍率を前記速度制御ループの遅れ時間に応じて前記比例ゲイン倍率の2乗よりも小さい値とすることを特徴とするサーボモータ制御装置。 A speed command generator for generating a speed command value for driving the servo motor;
A speed detector for detecting the speed of the servo motor;
A torque command creating unit that creates a torque command value to the servo motor using a difference between a speed command value created by the speed command creating unit and a speed detected value detected by the speed detecting unit;
Comprising
The speed control loop includes the speed detector and the torque command generator.
The torque command generator has an integral gain and a proportional gain to which the difference is input,
The integral gain and the proportional gain are obtained by multiplying an initial value predetermined for each motor model by a coefficient using a ratio of the load inertia of the machine to the rotor inertia of the servo motor. Obtained by further multiplying by the proportional gain magnification,
The servo motor control device according to claim 1, wherein the integral gain magnification is set to a value smaller than a square of the proportional gain magnification according to a delay time of the speed control loop.
前記サーボモータの位置を検出する位置検出部と、
を具備し、
前記速度指令作成部は、前記位置指令作成部が作成した位置指令値と、前記位置検出部が検出した位置検出値との差を用いて速度指令値を作成することを特徴とする請求項1から3のいずれか1項に記載のサーボモータ制御装置。 A position command creating unit for creating a position command value of the servo motor;
A position detector for detecting the position of the servo motor;
Comprising
2. The speed command generation unit generates a speed command value using a difference between a position command value generated by the position command generation unit and a position detection value detected by the position detection unit. 4. The servo motor control device according to any one of items 1 to 3.
前記サーボモータの速度を検出する速度検出ステップと、
作成した前記速度指令値と、検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令値作成ステップと、を備え、
該トルク指令値によって、前記サーボモータを制御する、サーボモータ制御装置のサーボモータ制御方法において、
速度制御ループで少なくとも前記速度検出ステップと前記トルク指令作成ステップを行い、
前記トルク指令作成ステップは前記差にそれぞれ積分ゲインと比例ゲインとを乗算するステップを含み、
前記積分ゲインと前記比例ゲインは、モータモデルごとにあらかじめ決められた初期値に、前記サーボモータのロータイナーシャに対する機械の負荷イナーシャの比を用いた係数を乗算したものに対して、それぞれ積分ゲイン倍率と比例ゲイン倍率をさらに乗算して得られ、
前記積分ゲイン倍率は前記速度制御ループの遅れ時間に応じて前記比例ゲイン倍率の2乗よりも小さい値であることを特徴とするサーボモータ制御方法。 A speed command value creating step for creating a speed command value for driving the servo motor;
A speed detecting step for detecting the speed of the servo motor;
A torque command value creating step for creating a torque command value to the servo motor using a difference between the created speed command value and the detected speed detected value;
In a servo motor control method of a servo motor control apparatus for controlling the servo motor according to the torque command value,
Performing at least the speed detection step and the torque command generation step in a speed control loop;
The torque command generating step includes multiplying the difference by an integral gain and a proportional gain, respectively.
The integral gain and the proportional gain are obtained by multiplying an initial value predetermined for each motor model by a coefficient using a ratio of the load inertia of the machine to the rotor inertia of the servo motor. Obtained by further multiplying by the proportional gain magnification,
The servo motor control method according to claim 1, wherein the integral gain magnification is a value smaller than a square of the proportional gain magnification according to a delay time of the speed control loop.
前記速度制御ループの遅れ時間に応じて1以上で2より小さい値をとる定数であることを特徴とする請求項5に記載のサーボモータ制御方法。 6. The integral gain magnification is a β power of the proportional gain magnification, and β is a constant that is 1 or more and less than 2 according to a delay time of the speed control loop. Servo motor control method.
前記サーボモータの位置を検出する位置検出ステップと、
を具備し、
前記速度指令作成ステップは、前記位置指令作成部が作成した位置指令値と、前記位置検出部が検出した位置検出値との差を用いて速度指令値を作成することを特徴とする請求項5から7のいずれか1項に記載のサーボモータ制御方法。 A position command creating step for creating a position command value of the servo motor;
A position detecting step for detecting the position of the servo motor;
Comprising
6. The speed command creation step creates a speed command value using a difference between a position command value created by the position command creation unit and a position detection value detected by the position detection unit. 8. The servo motor control method according to any one of items 1 to 7.
前記サーボモータを駆動するための速度指令値を作成する速度指令値作成処理と、
前記サーボモータの速度を検出する速度検出処理と、
作成した前記速度指令値と、検出した速度検出値との差を用いて前記サーボモータへのトルク指令値を作成するトルク指令値作成処理と、を実行させ、
速度制御ループで少なくとも前記速度検出処理と前記トルク指令作成処理を行い、
前記トルク指令作成処理は前記差にそれぞれ積分ゲインと比例ゲインとを乗算し、
前記積分ゲインと前記比例ゲインは、モータモデルごとにあらかじめ決められた初期値に、前記サーボモータのロータイナーシャに対する機械の負荷イナーシャの比を用いた係数を乗算したものに対して、それぞれ積分ゲイン倍率と比例ゲイン倍率をさらに乗算して得られ、
前記積分ゲイン倍率は前記速度制御ループの遅れ時間に応じて前記比例ゲイン倍率の2乗よりも小さい値であることを特徴とする、サーボモータ制御用プログラム。 To a computer as a servo motor control device that controls the servo motor,
A speed command value creating process for creating a speed command value for driving the servo motor;
A speed detection process for detecting the speed of the servo motor;
A torque command value creating process for creating a torque command value to the servo motor using a difference between the created speed command value and the detected speed detected value;
Perform at least the speed detection process and the torque command generation process in a speed control loop,
The torque command creation process multiplies the difference by an integral gain and a proportional gain,
The integral gain and the proportional gain are obtained by multiplying an initial value predetermined for each motor model by a coefficient using a ratio of the load inertia of the machine to the rotor inertia of the servo motor. Obtained by further multiplying by the proportional gain magnification,
The servo motor control program according to claim 1, wherein the integral gain magnification is a value smaller than a square of the proportional gain magnification according to a delay time of the speed control loop.
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016134274A JP6557185B2 (en) | 2016-07-06 | 2016-07-06 | Servo control device, servo control method, and servo control program |
US15/639,851 US10012961B2 (en) | 2016-07-06 | 2017-06-30 | Servo control device, servo control method, and computer readable recording medium |
CN201710534068.1A CN107589664B (en) | 2016-07-06 | 2017-07-03 | Servo control device and servo control method |
DE102017211380.4A DE102017211380B4 (en) | 2016-07-06 | 2017-07-04 | Servo control device, servo control method, and servo motor control program |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016134274A JP6557185B2 (en) | 2016-07-06 | 2016-07-06 | Servo control device, servo control method, and servo control program |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018005729A true JP2018005729A (en) | 2018-01-11 |
JP6557185B2 JP6557185B2 (en) | 2019-08-07 |
Family
ID=60676531
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016134274A Active JP6557185B2 (en) | 2016-07-06 | 2016-07-06 | Servo control device, servo control method, and servo control program |
Country Status (4)
Country | Link |
---|---|
US (1) | US10012961B2 (en) |
JP (1) | JP6557185B2 (en) |
CN (1) | CN107589664B (en) |
DE (1) | DE102017211380B4 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7124761B2 (en) * | 2019-02-26 | 2022-08-24 | オムロン株式会社 | Adjustment support device, servo driver, control parameter adjustment method and program for multiple servo motors |
AU2019476749A1 (en) * | 2019-12-05 | 2022-07-21 | Kone Corporation | A drive system and method for controlling a drive system |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06319284A (en) * | 1992-12-10 | 1994-11-15 | Matsushita Electric Ind Co Ltd | Apparatus and method for regulating control parameter of servomotor |
JP2010250509A (en) * | 2009-04-14 | 2010-11-04 | Mitsubishi Electric Corp | Drive controller |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5245528A (en) * | 1989-03-20 | 1993-09-14 | Hitachi, Ltd. | Process control apparatus and method for adjustment of operating parameters of controller of the process control apparatus |
US5475291A (en) | 1992-12-10 | 1995-12-12 | Matsushita Electric Industrial Co., Ltd. | Adjustment device for adjusting control parameters of a servo motor and an adjustment method therefor |
SG82592A1 (en) * | 1998-12-30 | 2001-08-21 | Univ Singapore | A novel predictive and self-tuning pi control apparatus for expanded process control applications |
JP4327880B2 (en) * | 2008-01-04 | 2009-09-09 | ファナック株式会社 | Servo motor controller with automatic gain adjustment function |
FR2933249B1 (en) * | 2008-06-30 | 2010-07-30 | Schneider Toshiba Inverter | METHOD FOR ADJUSTING THE SPEED LOOP OF A SPEED DRIVE |
US7922094B2 (en) * | 2009-01-09 | 2011-04-12 | 3M Innovative Properties Company | RFID packaging and attachment methods and devices |
CN101902187B (en) * | 2010-06-11 | 2012-06-27 | 中国科学院上海技术物理研究所 | Control system for low-speed running of permanent magnet motor |
KR101252250B1 (en) * | 2011-10-10 | 2013-04-08 | 주식회사 만도 | Electronically controllable brake booster |
CN104932250B (en) * | 2015-04-30 | 2018-02-16 | 南京航空航天大学 | A kind of new PI controller architectures and its parameter tuning method |
CN105242526A (en) * | 2015-10-30 | 2016-01-13 | 中国兵器工业集团第二O二研究所 | Servo system position controller setting method considering time lag |
-
2016
- 2016-07-06 JP JP2016134274A patent/JP6557185B2/en active Active
-
2017
- 2017-06-30 US US15/639,851 patent/US10012961B2/en active Active
- 2017-07-03 CN CN201710534068.1A patent/CN107589664B/en active Active
- 2017-07-04 DE DE102017211380.4A patent/DE102017211380B4/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06319284A (en) * | 1992-12-10 | 1994-11-15 | Matsushita Electric Ind Co Ltd | Apparatus and method for regulating control parameter of servomotor |
JP2010250509A (en) * | 2009-04-14 | 2010-11-04 | Mitsubishi Electric Corp | Drive controller |
Also Published As
Publication number | Publication date |
---|---|
US10012961B2 (en) | 2018-07-03 |
CN107589664A (en) | 2018-01-16 |
JP6557185B2 (en) | 2019-08-07 |
DE102017211380B4 (en) | 2021-03-18 |
CN107589664B (en) | 2020-04-28 |
US20180011453A1 (en) | 2018-01-11 |
DE102017211380A1 (en) | 2018-01-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4837558B2 (en) | Motor control device | |
CN105849663B (en) | The control device and friciton compensation gain determination method of mechanical device | |
CN105027013B (en) | The feeding shaft control method and feeding axle controls device of lathe | |
JP2007156699A (en) | Load inertia estimation method for motor | |
JP2004213472A (en) | Control device | |
JP5098863B2 (en) | Synchronous control device | |
JP6386492B2 (en) | Servo control device, servo control method and servo control program with filter added to proportional term calculated at high speed | |
JP6412071B2 (en) | Motor control device, motor control method, and motor control program | |
JP6444948B2 (en) | Servo motor control device, servo motor control method, and servo motor control program | |
JP2012104047A (en) | Servo controller | |
JP6557185B2 (en) | Servo control device, servo control method, and servo control program | |
JP6531682B2 (en) | Motor control device, motor control method, program, and recording medium | |
JP6930868B2 (en) | Servo control device, servo control method and system | |
JP2018041333A (en) | Servo motor control device, servo motor control method, and program for servo motor control | |
JP7469476B2 (en) | Control support device, control system, and control support method | |
Kong et al. | Output saturation in electric motor systems: identification and controller design | |
KR102240723B1 (en) | Controller comprising position predict unit and a control method thereof | |
JP4922954B2 (en) | Position control device | |
WO2015177912A1 (en) | Command generation device and method | |
Aghababa | Controlling fluctuated chaotic power systems with compensation of input saturation: application to electric direct current machines | |
JP2020004023A (en) | Control device, control method, information processing program, and recording medium | |
JP2019021098A (en) | Servo motor control device | |
CN112448638B (en) | Permanent magnet brushless direct current motor speed regulation control system and method based on continuous sliding mode | |
Zina et al. | Tracking control for induction motor using Takagi-Sugenou approach | |
JP2003084839A (en) | Motor controller with function of overshoot suppression |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20180620 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20180710 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20180831 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20190129 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190412 |
|
A911 | Transfer to examiner for re-examination before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20190422 |
|
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: 20190611 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190711 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6557185 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |