Академический Документы
Профессиональный Документы
Культура Документы
net/publication/329654395
CITATIONS READS
0 2
4 authors, including:
All content following this page was uploaded by Mikhail Kulenko on 18 December 2018.
Abstract – The study is devoted to the position control system function W f for zeros compensation of the positioning system
synthesis for electromechanic modules with a specified dynamics
and taking into account the motor torque loop time response. TF is used at the regulator input when required.
Mathematical models in the state equations form, characteristic The most efficient structures of modified PID regulators
polynomials, and transfer matrices for systems with position [3,4] have been selected for positioning system synthesis. The
regulators are obtained. It makes possible to ensure the system output torque reference Qr is formed according to the
dynamics corresponding to the Bessel polynomials with an
acceptable bandwidth value. Synthesis and analysis of following relationships:
perfomances are carried out using the MathCAD's symbolic
mathematics. The principles of regulators fixed adjustment
providing the position control system robustness in presence of
the mechanics inertia variation are developed.
function (TF) – WQ , where kQ , TQ – the parameters of the where k p , ki , ki1 , ki 2 , kd – position regulator parameters, q –
circuit. EPCM with closed-loop position q control system rate of position change.
based on the position regulator RP ensures the control in
response to position reference signal qr under conditions of A synthesis procedure and fixed adjustment of the
positioning system according to the Bessel dynamics are
variable mechanical loads QL . The filter with a transfer proposed in [3] for regulators (1) – (3) with the assumption of
time-lag-free torque loop. The purpose of this study is to
develop an algorithm for the synthesis of regulators, taking This equation allows to assume that the system dynamics
into account the finite value of the torque loop response time. is determined only by the poles of the TF, and the zeros of the
In addition, it is necessary to investigate the characteristics of TF are absent. Then the TF of the P(D)-regulator input filter
synthesized positioning systems for the regulator fixed
adjustment determination. In presence of the mechanics inertia W f ( s) = 1 ,
variation it ensures robustness increasing the efficiency of
EPCM application in robotics. and the transfer function on the control signal is defined by the
following expression
II. THE REGULATORS SYNTHESIS
A special feature of the positioning systems synthesis is q( s )
H11+ f ( s) = = H11( s)W f ( s) = H11 ( s) . (10)
the application of the state equation that is more often used in qr ( s)
the implementation of modal control [5-7]
The 3rd order Bessel characteristic polynomial can be
choosen as a reference dynamics for P(D)-regulator system
d → → →
X = A X + BU , (4)
dt
hp* ( s ) = s3 + 3.797ω pb s 2 + 6.007ω2pb s + 3.801ω3pb , (11)
→ →
where X , U – state and input vectors, A , B – state and where ω pb – system bandwidth according to requirements for
input matrices.
electric drives of machine tools and robots [1].
For all regulators synthesis process we assume the torque
loop gain to be equal to unity. The polynomials (7) and (11) will be identical when the
factors of the same powers of s are equal. From the
Consider obtaining P(D) position regulator parameters coefficients equality the expressions for P(D)-regulator
providing the Bessel dynamics [8, 9] taking into account the parameters determination are obtained.
torque loop response time. For P(D)- regulator, the state
equation components (4) take the following form:
k p = 3.801ω3pb kinTQ ; kd = 6.007ω2pb kinTQ . (12)
q In addition the bandwidth of the system is determined. In
→ → qrf
X = q ; U = ; (5) this case it does not depend on the module inertial coefficient
Q QL ( kin ), but on the torque loop response time ( TQ )
0.2633
0 1 0 0 0 ω pb = . (13)
1 −1
TQ
0 0 0
A= kin ; B = kin . (6) Let us assume TQ = 0.001 s [1], then the system bandwidth
−k p − kd −1 kp 0
will be
TQ TQ TQ TQ
rad ω pb
ω pb = 263.36 ; f pb = = 41.92 Hz . (14)
Using state and input matrices A and B (6) it's possible to s 2π
define the characteristic polynomial (hp) and the transfer
(equivalent) matrix (TM): It should be noted that in most cases the requirements for
the position loop passband in positioning systems are in the
range of 5÷15 Hz [2]. Thus, the performed synthesis ensures
1 2 k kp the Bessel dynamics system implementation with an
hp ( s ) = det ( sE − A ) = s 3 + s + d s+ ; (7)
TQ kinTQ kinTQ acceptable level of performance.
From (8) the transfer function on the disturbance signal
H11 ( s ) H12 ( s) can be obtained
H eq ( s) = ( sE − A ) B = H 21 ( s) H 22 ( s) .
−1
(8)
H 23 ( s) H 32 ( s) H12 ( s ) =
q( s )
=
(
− TQ s + 1 ) , (15)
QL ( s ) TQ kin s + kin s 2 + kd s + k p
3
→ →
RP X U A B H11 (s) , H12 (s)
0 1 0 0 0 0
1 −1
k p s + ki
q 0 0 0 0 H11 ( s ) =
qrf kin kin TQ kin s 4 + kin s 3 + kd s 2 + k p s + ki
PI(D) q
Q
QL −k p
T
− kd −1 1 kp 0 H12 ( s ) =
(
− s TQ s + 1 )
Qi TQ TQ TQ T
Q Q TQ kin s + kin s 3 + kd s 2 + k p s + ki
4
− ki 0 0 0 ki 0
0 1 0 0 0 0 0
q 0 1 −1 k p s 2 + ki1s + ki 2
0 0 0 0
kin kin H11( s) =
q qrf TQ kin s + kin s 4 + kd s 3 + k p s 2 + ki1s + ki 2
5
PI2I(D) Q −k p −kd −1 1 kp
QL T 0 T
0
− s 2 (Tm s + 1)
Qi1 TQ TQ TQ H12 ( s ) =
Q Q Q
i2 −ki1 0 0 0 1 ki1 0 TQ kin s5 + kin s 4 + k d s3 + k p s 2 + ki1s + ki 2
− ki 2 0 0 0 0 ki 2 0
k p = 27.43ω3pbkinTQ
ki = 17.53ω 4pbkinTQ
ki 4 1 3 k kp k s 4 + 6.392ω pb s 3 + 18.359ω2pb s 2 +
PI(D) s + s + d s2 + s+ i 24.9
k p s + ki TQ kinTQ kinTQ kinTQ kd = 18.39ω2pbkinTQ
+27.428ω3pb s + 17.533ω 4pb
0.1564
ω pb =
TQ
k p = 106.91ω3pb kinTQ