A New Mechanical Resonance Suppression Method by ADRC
A New Mechanical Resonance Suppression Method by ADRC
ABSTRACT Aiming at solving the problem of the multi-low-frequency mechanical resonances appearing
in the large optical telescope control system, this paper proposes a novel control method based on nonlinear
active disturbance rejection control (NADRC) and proportional–integral (PI) control. In the proposed control
framework, a nonlinear tracking differentiator (NTD)-based feedforward control is designed to improve
the tracking performance of the system. Then, the principle of suppression of mechanical resonance of
this method is analyzed. Compared with the most commonly used acceleration feedback control (AFC)
method, the theoretical analysis shows that the proposed method is more effective for suppressing the
low-frequency mechanical resonance. Finally, the proposed method is applied to a large optical telescope,
and the experimental results show that the proposed method is better than AFC.
INDEX TERMS Mechanical resonance suppression, active disturbance rejection control (ADRC), acceler-
ation feedback control (AFC), nonlinear tracking differentiator (NTD), optical telescope.
94400 This work is licensed under a Creative Commons Attribution 4.0 License. For more information, see http://creativecommons.org/licenses/by/4.0/ VOLUME 7, 2019
X. Li et al.: New Mechanical Resonance Suppression Method for Large Optical Telescope by Using NADRC
ignored.
TM kT
Gacr (s) = = 2 (3)
Iref Tf s + 1
Substitute (3) into (2), the transfer function from Iref to ωM
can be induced
GPlant (s)
ωM
= = GModel · GASR
Iref
1 kT 1 JL s2 + bs s + Ks
= 2 · · · (4)
Tf s + 1 (JM + JL ) s JM JL
(JM +JL ) s
2 + bs s + Ks
Let
FIGURE 2. Measured telescope FRD model (from reference current Iref
to motor speed ωM ). 1 1
G1 (s) = · (5)
s Tf s + 1 2
kT JL s2 + bs s + Ks
G2 (s) = · (6)
(JM + JL ) JM JL
(JM +JL ) s
2 + bs s + Ks
G1 (s) is an ideal rigid body, whereas G2 (s) is a com-
pliance of the transmission component, which corrupts the
ideal plant. The anti-resonant frequency (ωA ) and resonant
FIGURE 3. Two-inertia model.
frequency (ωN ) of the system can be calculated as
s
Ks
ωA = J
s L (7)
Ks Ks
ωN =
+
JL JM
When in the low frequency band, s → 0, so G2 (s) ≈
kT (JM + JL ), (4) can be simplified to (8), in this case the
kT 1 JL s2 + bs s + Ks
= · · (10)
(JM + JL ) s2 JM JL 2
(JM +JL ) s + bs s + Ks
Considering the external disturbance w, (10) can be rewrit-
ten as
.... ...
JM JL θ M + bs (JM + JL ) θ M + Ks θ̈M
= kT JL Ïref + bs İref + Ks Iref + w (11)
FIGURE 5. Bode diagram of two-inertia model and tested model. Integrating (11) twice on both sides, the fourth-order sys-
tem with a relative degree of two becomes a second-order
system as below
III. ACTIVE DISTURBANCE REJECTION CONTROL FOR
θ̈M = b0 · Iref + f (12)
TWO-INERTIA MODEL
From the above discussion, we can see that if G2 (s) can be where
compensated, GPlant (s) becomes an ideal rigid plant which kT
is easy to control. ADRC is that kind of method that can b0 = (13)
JM Z
treat G2 (s) as disturbance, which can be estimated and com- kT bs kT Ks
ZZ
bs (JM + JL )
pensated in real time [25]. Based on this theory, this section f = Iref + Iref − θM
JM JL JZM JL JM JL
firstly presents the methodology of the framework and pro-
Ks (JM + JL )
ZZ
posed controller, and then the stability of the closed loop con- − θM + w (14)
trol system is proved. Secondly, based on frequency domain JM JL
analysis, the principles of suppressing mechanical resonance Here f , including both external disturbance and the res-
of LADRC and AFC are discussed. Finally, the comparison onance, represents the ‘‘ total disturbance’’ to be estimated
between ADRC and AFC is theoretically analyzed, and the and compensated. Based on (12), it is better to choose a
advantages and disadvantages of ADRC are discussed. third-order ESO [22]. With x1 and x2 denoting θM and ωM ,
and x3 denoting f , (12) can be rewritten as
A. PROPOSED METHOD FOR TELESCOPE
ẋ1 0 1 0 x1 0 0
The control method proposed in this paper is shown in Fig. 6. ẋ2 = 0 0 1 x2 + b0 u + 0 f˙
This scheme consists of three elements: the position loop con- ẋ3 0 0 0 x 3 0 1
troller, the speed loop controller, and the NTD feedforward. (15)
x1
The position loop controller is traditional PI controller. The y = 1 0 0 x2
speed loop controller is NADRC which consists of NESO and x3
a proportional feedback control law. The NTD feedforward
So the corresponding NADRC control law is constructed
controller consists of an acceleration feedforward controller
as
and a speed feedforward controller.
ε1 = z1 − θM
ż1 = z2 − β01 · ε1
1) SPEED LOOP CONTROLLER DESIGN
The principle of the speed loop NADRC is shown in Fig. 6. 1
ESO : ż = z − β · fal ε , , δ + b̂0 Iref
Ignoring the Tf in (4), the transfer function from Iref to θM is
2 3 02
1
2
1
ż3 = −β03 · fal ε1 , , δ
θM 1 4
Gvplant (s) = = Gplant (s) ·
Iref s (16)
(ε1
|ε1 | 6 δ
fal (ε1 , a, δ) = δ (1−a) (17)
sign (ε1 ) |ε1 |a |ε1 | > δ
u0 = kp ωref − z2
(18)
z3
u = u0 − (19)
b̂0
According to [26], the anti-windup of NADRC is designed
as
Imin
u < Imin
Iref = u Imin < u < Imax (20)
u > Imax
Imax
Therefore, speed and acceleration feedforward controllers constants λ2i (i = 1, 2, 3, 4), β2 , and positive continuous
can be designed as NTD: differentiable function V2 , W2 :Rn+1 → R such that
λ21 kvk2 6 V2 (v) 6 λ22 kvk2 , λ23 kvk2 6 W2 (v) 6 λ24 kvk2
θref _f (k + 1)
= θref _f (k) + hωf (k)
(31)
ω f (k + 1)
n−1
∂V2 (v) ∂V2 (v)
X
+ ϕ (v1 , v2 , . . . , vn ) 6 −W2 (v)
vi+1
= ω (k) + hfhan θ
ref _f (k) − θref (k) , ωf (k) , r, h0
f ∂vi ∂vn
i=1
ωref _f (k + 1) (32)
= ωref _f (k) + haf (k) ∂V2 (v)
6 β2 kvk , ∀v = (v1 , v2 , . . . , vn ) ∈ Rn
(33)
f (k + 1)
a ∂vn
= af (k) + hfhan ωref _f (k) − ωref (k) , af (k) , r, h0
.
Let Kω = 1, Ka = 1 b̂0 , (30) can be rewritten as
(29)
Z
θref (k) is the position reference signal, θref _f (k) is the 1
−b̂0 kp k 0 i θM − θref dt
Iref =
state tracking θref (k), ωf (k) is feedforward speed, ωref _f (k) b̂0
is the state tracking ωf (k), af (k) is feedforward acceleration,
+ −b̂0 kp k 0 p θM − θref
Kω and Ka are parameters to be tuned.
+ −b̂0 kp z2 − ωf + af − z3
(34)
4) THE FINAL CONTROLLER
Based on the above design, the control algorithm proposed We can see from (30) that the controller of proposed
in this paper can be divided into three parts: 1) The first method is linear, and the corresponding ϕ (·) in Assumption 3
part is NESO, as shown in (16). 2) The second part is the is
feedforward part, which consists of two NTDs in series, ϕ (x1 , x2 , x3 ) = −b̂0 kp ki0 x1 − b̂0 kp kp0 x2 − b̂0 kp x3 (35)
as shown in (29). 3) The third part is speed loop controller
and position loop PI controller. Ignoring the saturation effect, Apparently ϕ (x1 , x2 , x3 ) is Lipschitz continuous.
(18)(19)(21) (24) can be written as Let
ADRC : Iref = kp k 0 p θref − θM
0 1 0
Z A = 0 0 1 (36)
+ kp k 0 i θref − θM dt + kp Kω ωf
−b̂0 kp k 0 i −b̂0 kp k 0 p −b̂0 kp
z3 With appropriate parameters, A can be Hurwitz.
+ Ka af − kp z2 − (30)
b̂0 Let
B. THE PRINCIPLE OF ADRC AND AFC SUPPRESSING ωo is the observer bandwidth. By Laplace transformation,
MECHNIACL RESONANCE the disturbance observed is
1) THE PRINCIPLE OF ADRC SUPPRESSING MECHNIACL −b0 ωo2 ωo2 s
RESONANCE Z̃2 (s) = · Iref (s) + · M (s) (45)
(s + ωo ) 2
(s + ωo )2
The ESO is the core of ADRC, which improves the con-
trol performance through observing and compensating the If Tf = 0, combining (4) and (45), using the Masonąŕs
internal and external disturbances. This section focuses on gain formula (MGF), the transfer function of the enhanced
the principle of ESO suppressing mechanical resonance. plant can be expressed as
Fig.8 shows the disturbance observing and compensating part ωM kT
GLESO (s) = =
ωo2
of the ESO. Since the NESO cannot be analyzed by transfer u0 JM + 1 − · JL
function, a linearized ESO is used here for analysis. And in (s+ωo )2
order to simplify the discussion, it is assumed that there is JL · s2 + bs · s + Ks 1
· ·
a speed sensor in the system, so a second-order ESO will be JM · JL · s2 + bs · s + K s s
ωo2
used. All parts f0 that corrupt the ideal integral component are JM + 1−
(s+ωo ) 2 ·JL
regarded as ‘‘disturbance’’. If the estimated disturbance z̃2 of (46)
ESO rapidly converges to f0 ,then the disturbance encountered
by the ideal plant can be well compensated. Let
JM
fLESO (s) = (47)
ωo2
JM + 1 − · JL
(s+ωo )2
Within the observer bandwidth of ωo , we can get
ωo2 (s + ωo )2 = 1, so fLESO (s) = 1, Then equation (46) can
be simplified to
kT 1
GLESO (s) = · (48)
JM s
GLESO (s) is an ideal plant. Therefore, as long as the
observer bandwidth of the ESO satisfies ωo > ωN ,the
mechanical resonance of the system can be well suppressed,
and the system becomes an ideal plant. Fig. 9 shows the Bode
diagram of GLESO (s) under different observer bandwidth.
It indicates that the ADRC method can effectively suppress
mechanical resonance. The larger the observer bandwidth is,
FIGURE 8. Block diagram LESO. the closer the plant is to l2 (s), and the better the suppress
effect.
According to the above assumptions, and ignoring Tf and
saturation in Fig. 8, (4) can be written as follows
where
Z ZZ
kT bs kT Ks
f0 = Iref + Iref
JM JL JM JL
bs (JM + JL ) Ks (JM + JL )
Z ZZ
− ωM − ωM + w
JM JL JM JL
(43)
discussed.
As shown in Fig. 10, assuming that the transfer
function of
the ideal acceleration observer is Gas (s) = ro 2 (s + ro )2 ,
ro is the observer bandwidth of the acceleration observer,
feedback gain is a, and Tf ≈ 0. The estimated acceleration is
feed back to the current loop. Using the MGF, we can get
ωM kT
GAFC (s) = =
Iref a·ro 2
1+ · JM + JL
(s+ro )2
JL · s2 + bs · s + Ks 1
× 2
×
1+ a·ro 2 ·JM s
(s+ro )
2
· JL · s2 + bs · s + Ks
1+ a·ro 2 ·JM +JL
(s+ro )
FIGURE 12. Bode diagram of GLESO (s) and GAFC (s), the parameters are
(49) shown in the Table 1 and ro = ωo = 2000, a = 10, 2a = 20.
Let
As shown in Fig. 13, when ro = ωo = 2000 and
a·ro 2 load inertia JL increases from JL to 10JL , the magnitude of
1+ · JM
(s+ro )2 fAFC2 (s) decrease, thus the performance of AFC decreases.
fAFC (s) = (50)
a·ro 2 Fig. 14 indicates that LESO still has very good effects. The
1+ · JM + JL
(s+ro )2
feedback gain a of AFC needs to be tuned larger to obtain an
The principle of AFC for suppressing the mechanical reso- effect similar to LESO. From the above discussion, we can
nance is raising the inertia of the motor by electronic means, conclude that for low-frequency mechanical resonance, ESO
effectively reduces the amplitude of the transfer function in is better; whereas for higher mechanical resonance, AFC is
the high frequency band, thereby suppressing the mechanical better.
resonance. Theoretically, if we want to change the plant to an As shown in Fig. 15, the ESO improves the open loop
ideal pure integral by AFC, the observer bandwidth ro needs gain at the low frequency and reduces the open loop gain
to be infinite and the value of a needs to be large enough. at the high frequency, thus a simple proportional controller
FIGURE 15. Bode diagram of LESO and AFC (from Iref to ωM ), the
parameters are shown in the Table 1 ro = ωo = 2000, a = 10.
FIGURE 13. Bode diagram of fLESO (s) and fAFC (s), the parameters are
shown in the Table 1 and ro = ωo = 2000, a = 10.
TABLE 2. Main parameters used in the experiment. FIGURE 18. Enhanced plant comparison (from u0 to ωM ).
FIGURE 21. Position error sensitivity comparison (from θref to θerr ). FIGURE 24. Position error of sinewave tracking.
V. CONCLUSION
This paper studies the use of the ADRC technique to sup-
press the multi low mechanical resonances appearing in the
large optical telescope. First, a simplified physical model
was established. Concerned about the control of the motor
position, a third-order NESO was designed to estimate and
compensate the original plant to an ideal rigid plant, which
decouples the compliance between the motor and the load.
Moreover, a PI controller was used to achieve a high precision
FIGURE 23. Position trapezoidal wave tracking comparison. position tracking of the telescope. Then based on the NTD,
a speed and acceleration feedforward is established such that
the tracking performance can be improved. The principle
low frequency range and boosted slightly in higher frequency of suppression mechanical resonance of ESO is analyzed in
range where the disturbance is small in telescope control frequency domain. Comparing with AFC, it can be concluded
system. By this way, the tracking accuracy is improved. that the ADRC is better than AFC at suppressing the low
Fig. 22 is closed-loop Bode diagram of position loop, it can frequency mechanical resonance, whereas for higher fre-
be seen that the resonance peak of the proposed method is the quency mechanical resonance, AFC is better. As confirmed
smallest. The presence of a resonant peak will cause position by the experimental results, the proposed control system
overshoot, whereas, for telescope, the reference signal is has good low-frequency mechanical resonances suppressing
often a low-frequency sinusoidal like signals. Fig. 23 shows effect, command-following performance and is robust against
the trapezoidal wave tracking curve of the telescope. The all kinds of disturbances.
n−1
X ∂V2 (v) ∂V2 (v) TABLE 4. Nomenclatures.
vi+1 + ϕ (v1 , v2 , . . . , vn ) 6 −W2 (v)
∂vi ∂vn
i=1
(62)
∂V2 (v)
6 β2 kvk , ∀v = (v1 , v2 , . . . , vn ) ∈ Rn (63)
∂vn
The Assumption 4 is for TD in (54).
Assumption 4: Both υ (t) and υ̇ (t) are bounded in [0 , ∞),
and ψ (·) is locally Lipschitz continuous, and system (54)
with υ (t) ≡ 0, R ≡ 1 is globally asymptotically stable.
_
Theorem 5: Let x i (t) (1 6 i 6 n) and (1 6 i 6 n + 1) be
the solutions of closed-loop system combined of (51) (52).
_
∗
Let x n+1 (t) be the extended state defined in (52), and let
z1R (t) be the solution of (54). Under Assumptions A1-A4,
the following statements hold true for any given initial values
of (51) and the closed-loop system.
(1) For any σ > 0 and τ > 0, there exists a constant R0 > 0
such that |z1R (t) − ν (t)| < σ uniformly in t ∈ [τ , ∞) for
all R > R0 .
(2) For every R > R0 , there are an R-dependent constant
ε0 > 0 for any ε ∈ (0, ε0 ), and an ε− dependent constant
tε > 0 such that for all t > tε ,
_ _
∗
x i (t) − x i (t) 6 01 εn+2−i , i = 1, 2, . . . , n + 1
and
_
x i (t) − ziR (t) 6 02 ε, i = 1, 2, . . . , n
APPENDIX B
NUMBERICAL ANALYSIS
If let b̂0 = 2011, kp = 0.014, kp0 = 12, ki0 = 2.3. Then the
Lipschitz continuous function ϕ (x1 , x2 , x3 ) is
ϕ (x1 , x2 , x3 ) = −64.8x1 − 337.8x2 − 28.1x3 (64)
And
0 1 0
A = 0 0 1
−64.8 −337.8 −28.1
2.9676 1.3827 0.0077
PA = 1.3827 6.2266 0.0056
JUN LUO received the B.S. degree from Northeast PING JIANG graduated from the Sichuan
Normal University and the Ph.D. degree from the University, China. He is currently a Research
Changchun Institute of Optics, Fine Mechanics Fellow with the Institute of Optics and Electron-
and Physics (CIOMP), Chinese Academy of Sci- ics (IOE), Chinese Academy of Sciences (CAS),
ences (CAS), where he is currently a Research China. His research interests include photoelectric
Associate with the Institute of Optics and Elec- detection, precision machinery, and large photo-
tronics (IOE). His research interests include high electric telescope.
precision sensor and motion control systems.
WENLI MA graduated from the University of YONGKUN FAN graduated from the Chang’an
Electronic Science and Technology of China. He is University, China. He is currently an Associate
currently a Research Fellow and a Doctoral Super- Professor with the Sichuan Vocational and Tech-
visor with the Institute of Optics and Electron- nical College of Communications. His research
ics (IOE), Chinese Academy of Sciences (CAS), interests include PMSM, new energy electric vehi-
China. His research interests include photoelectric cles, and robust control.
detection, precision machinery, and large photo-
electric telescope.