Professional Documents
Culture Documents
Ahi 2017
Ahi 2017
I. I NTRODUCTION
TABLE I
DC M OTOR S PECIFICATIONS
TABLE II where u 0 (t) is the control law, which achieves the satisfactory
G YROSCOPE C HARACTERISTICS performance. In LADRC, this is usually chosen to be propor-
tional to estimated tracking error
u 0 (t) = k p (v(t) − x̂ 1 (t)) (21)
where v(t) is the reference signal. Regarding impeccable
observations, the closed-loop system can be derived as follows:
1
ẏ(t) + y(t) = v(t). (22)
kp
Therefore, k p can be tuned by choosing the desired 2% settling
B. Measurement Sensors Specifications time k p = −s CL ≈ 4/Tsettle, where s CL is the desired closed-
loop pole. Applying the procedure to the system (17) yields
The digital MEMS gyroscope (Table II) used in this appli-
an nth-order closed-loop system with n tuning parameters.
cation is made by Analog Devices (ADIS16137). Prior to the
Observer gains are specified via bandwidth parameteriza-
analog-to-digital converter, this rate gyro goes through a two-
tion [26], which suggests choosing observer poles at the same
pole, low-pass filter. The first pole is at 429 Hz, and the second
place
pole is at 1595 Hz. Accordingly, the gyro transfer function is
27 × 106 l1 = −2s ESO , l2 = (s ESO )2 (23)
G gyro (s) = 2 (16)
s + 12710 s + 27 × 106 in which the observer bandwidth is determined by
averaging and decimating filters are set to default. Out- s ESO = kob s CL . kob is referred to as the observer coeffi-
put data rate is 2048 SPS. Moreover, a 17-b absolute cient. Increasing kob leads to a more accurate observation,
encoder (5853FS3) from Kubler is used to measure ψ. and improved control. Practical issues that limit how much
the observer coefficient can be increased are discussed in
IV. C ONTROLLER D ESIGN Section VI.
A. Design LADRC in Continuous Time Domain
Assume the following linear system with known order n: B. Stability Analysis
α0 The expressions for closed-loop error dynamics ec (t) =
G(s) = (17)
βn s + βn−1 s
n n−1 + · · · + β1 s + 1 v(t) − x 1 (t) and eo (t) = x(t) − x̂(t) can be obtained by
an LADRC can be designed for (17) by knowing only the substituting (20) and (21) into (18) as follows:
parameter b = α0 /βn . We show that only a rough estimate of b
ėc (t) = −k p (ec (t) + eo1 (t)) − eo2 (t) + v̇(t) (24)
denoted by b0 is sufficient for LADRC to deliver a superior
performance compared with PID control. Taking the angular with reference to (19), one can show that the overall closed-
velocity as the output and comparing (13) with (17), it is loop dynamic takes the form
evident that b = (kt /R J ), implying that viscous coefficient ⎡ ⎤ ⎡ ⎤⎡ ⎤ ⎡ ⎤
has almost no effect on b, and by consequence, the control ėc (t) −k p −k p −1 ec (t) v̇(t)
⎣ėo1(t)⎦ = ⎣ 0 −l1 1 ⎦ ⎣eo1(t)⎦ + ⎣ 0 ⎦ . (25)
law. Furthermore, if the parameters kt , R, and J are known,
the LADRC can be implemented without performing any ėo2 (t) 0 −l2 0 eo2 (t) f˙(t)
system identification. Consider Since in the general case f˙(t) is not independent of the
ẋ 1 (t) = f (t) + b0 u(t) system states, it must be assessed for stability. Assuming b =
(18) b0 + b in which b is the unknown part of b, f (t) becomes
y(t) = x 1 (t)
1 b
where y(t) is the measured angular velocity, u(t) is the f (t) = (α0 d(t)−x 1(t))− (x̂ 2 (t) − k p (v(t)− x̂ 1 (t)))
β1 b0
input voltage, and f (t), referred to as the total disturbance,
(26)
is a time-varying function that depends on the states, inter-
nal uncertainties, unmodeled dynamics, and external distur- in which d(t) is the external input disturbance. Accordingly,
bances. To estimate f (t), the system is extended by defining from (25) and (26)
x 2 (t) = f (t). Taking L = [l1 l2 ]T and x̂(t) as the estimate of ⎡ ⎤ ⎡ ⎤⎡ ⎤ ⎡ ⎤
x(t) = [x 1 (t) x 2 (t)]T , the observer for an extended system is ėc (t) −k p −k p −1 ec (t) D
⎣ėo1 (t)⎦ = ⎣ 0 −l1 1 ⎦ ⎣eo1 (t)⎦ + ⎣ 0 ⎦ (27)
˙ = A x̂(t) + Bu(t) + L(y(t) − ŷ(t))
x̂(t) ėo2 (t) A B C eo2 (t) E
(19)
ŷ(t) = C x̂(t) where A, B, C, D, and E are defined as follows:
where A = 00 10 , B = b00 and C = [ 1 0 ]. Based on the kp b 2 kp b
A=− − k , B=− − l2 + k 2p + l1 k p − l2
online estimation of ESO, the control law becomes β1 b0 p β1 b0
−1 1 b α0
u(t) = (x̂ 2 (t) − u 0 (t)) (20) C = − , D = v̇(t), E = k p v̇(t) + ḋ(t).
b0 β1 b0 β1
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
1) Identification Error Effects on Set-Point Tracking: 2) Identification Error Effects on Disturbance Rejec-
Asymptotic stability of the error dynamic at the presence of tion: An external disturbance with the same characteristics
excessive identification error in coefficient b is demonstrated in Section VI-A2 is applied to the base. According to Fig. 13,
in Section IV-B. According to [15], a rough approxima- the identification error will decrease the disturbance rejection
tion of b within a ±50% range is adequate for ADRC to ability of LADRC. However, even with ±100% identification
deliver a superior performance. Here, the LADRC controller is error, the disturbance rejection ability of the LADRC is still
tuned assuming ±100% error in identification of b. Similarly, superior to the PI controller, as verified in Fig. 11.
the PI controller is tuned for an assumed ±100% error in
the identification of process time constant (β1 ). Fig. 12(a)
indicates that the tracking behavioral of LADRC controller is C. Comparison of Controllers
nearly unchanged under these excessive variations, in contrast To conclude the experimental results, simultaneous com-
to the PI controllers [Fig. 12(b)] in which β0 and β1 are, parison of tracking and disturbance rejection performance of
respectively, the identified and actual values. controllers with the assumption of square wave (with 40°/s
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.