Académique Documents
Professionnel Documents
Culture Documents
DETC2017-67126
ABSTRACT x Distance from the initial position to the center of mass of the
In this article, the output reference trajectory tracking con- cart
trol of a non-differentially flat, underactuated, system is ap- θ Angle for the pendulum respect to the vertical
proached from the perspective of Active Disturbance Rejection
Control (ADRC) including a suitable Extended State Observer
(ESO). The class of underactuated systems, which are non-
1 INTRODUCTION
differentially flat, constitutes the most challenging area for test-
ing the effectiveness of robust feedback control algorithms, spe- The inverted pendulum on a cart and the convey-crane con-
cially under output trajectory tracking requirements. The prob- stitute nonlinear underactuated fourth order systems. From a lin-
lem, however, is substantially alleviated and feasibly approached ear perspective the control of these systems represents a chal-
provided the tangent linearization of the system is found to be lenging control problem. In addition, these nonlinear systems
controllable around an arbitrary equilibrium point. The flatness are not feedback linearizable. In this work, the controller design
of the tangent system is taken advantage of for the design of an for the underactuated systems is performed using their control-
observer-based feedback controller taking the tangent system op- lable tangent linearization model placed in terms of a simplified
eration substantially far from the operating point. The ADRC dynamics, typical of the ADRC approach, where the neglected
scheme robustly takes efficient care of the excited (endogenous) nonlinearities are regarded as part of a total of disturbance term,
nonlinearities, which were neglected in the linearization process, lumped with possible exogenous perturbations effects. The ex-
as well as any other external (exogenous) disturbances. Here, we ogenous disturbances represent, generally speaking, the effects
take the gantry crane and its closely associated system: the in- of unmodeled dynamics and the presence of exogenous, unstruc-
verted pendulum on a cart, as working laboratory examples to tured, unknown but bounded time varying inputs.
illustrate the effectiveness of the proposed approach. The ADRC scheme, via its suitably designed Extended State
Observer (ESO), simultaneously estimates the flat output related
phase variables as well as the total disturbance effects. It then
proceeds to approximately cancel the adverse disturbance ef-
NOMENCLATURE fects via a stabilizing feedback law using the observer infor-
F Force applied on the cart mation. For the ESO, we use a variation of Han’s ESO ( [1]),
g Acceleration due to gravity which constitutes a unique feature, or consequence, of the flat-
m Mass of the pendulum. ness property and the underlying Hamiltonian structure of the
M Mass of the cart. linear tangent model. Such observer allows for a natural decou-
1 Copyright
c 2017 by ASME
pling property, for the estimation of odd order flat output time
derivatives. In fact, the differential parameterization, provided
by flatness, makes it clear that it is unncecessary to estimate even
order time derivatives of the flat output. Other variations of Han’s
observers, known as Generalized Proportional Integral (GPI) ob-
servers, have been used in the control of underactuated systems
with flat linearizations (See [2]). Experimental applications of
ADRC via GPI observers are found in diverse control system
areas: ((see Ramı́rez-Neria et al. [3–6], J. Linares et al. [7, 8],
Cortés-Romero et al. [9].). The rigorous mathematical features
of the ESO based ADRC approach are thoroughly discussed in
the works of Zhao and Guo ( [10–12]), in the articles by Gao et
al. ( [13–15]), in Sira-Ramı́rez et al. [7] and in the survey article
by Madoński and Herman in ( [16]).
The rest of the paper is organized as follows: The mathe-
matical models of the inverted pendulum on a cart system and of
FIGURE 1. AN INVERTED PENDULUM ON A CART SYSTEM.
the convey crane system are presented in Section 2. The tangent
linearization models around, respectively, the unstable and sta-
ble equilibrium points, are found to be controllable and, hence, and the corresponding incremental variables depicting variations
flat. Section 3 contains the problems formulations and the main from the equilibrium point:
results. The experimental results including trajectory tracking
tasks are presented, for both systems, in Section 4. The conclu- xδ = x− x̄ = x, θδ = θ − θ̄ , ẋδ = ẋ, θ̇δ = θ̇ , Vd elta = V − V̄ = V
sions of the work are presented in Section 5. (4)
All the incremental state and input variables coincide, then,
with the actual measured variables. The linearized system,
2 THE INVERTED PENDULUM ON A CART AND THE around the unstable equilibrium point, is written as,
CONVEY CRANE SYSTEMS.
2.1 Mathematical model of the inverted pendulum on
kt
a cart. (M + m)ẍδ − mLθ̈δ = V (t) (5)
Consider an inverted pendulum on a cart system system, as Rr δ
shown in figure 1. The mass of the cart is M, while L is the −mLẍδ + mL2 θ̈δ = mgLθδ (6)
length of the pendulum with concentrated mass m. The variable
θ denotes the angle between the pendulum rod and the vertical The linearized system (5) can be rewritten in the matrix
direction. The input force (F) is obtained from a DC motor. The form:
motor torque can be expressed as a function of the motor volt-
kt
age through the relation: F = rR V (t) where R is the armature
resistance of the motor, kt is the motor torque constant and r is ẋ = Ax + bVδ (7)
the radius of the mesh that is used to move the cart. The math-
ematical model is obtained, via the Euler-Lagrange formalism, where:
as:
xδ 01 0 0 0
0 0 mg k
ẋδ M 0
; b = rRM ;
θδ ; A = 0 0
x= (8)
(M + m)ẍ − mLθ̈ cos(θ ) + mLθ̇ sin(θ ) = F
2
(1) 0 1 0
−mL cos(θ )ẍ + mL2 θ̈ − mgL sin(θ ) = 0 (2) θ̇δ 00 (M+m)g
LM 0 k
rRLM
All position variables, x, θ are assumed to be available for The flat output of a linear controllable system in state space form
measurement. None of the corresponding velocity variables are is given, modulo a constant factor, by the linear combination of
available. the states obtained from the last row of the inverse of the Kalman
Consider the unstable equilibrium point of the system, controllability matrix [17]. For the inverted pendulum we have:
2 Copyright
c 2017 by ASME
Then, the flat output of the system is given by:
where ξ (t) represents the total disturbance. It will be assumed y = xδ − Lθδ ; ẏ = ẋδ − Lθ̇δ ; ÿ = gθδ ; y(3) = gθ̇δ
that, both, ξ (t) and its first order time derivative ξ̇ (t) are abso- gkt g2 (M + m)
lutely uniformly bounded. y(4) = Vδ − θδ (21)
rRLM LM
3 Copyright
c 2017 by ASME
The control input, in terms of the flat output and its time
derivatives, is just:
ëy = ÿ − ÿ∗ (t) = geθ ;
rRLM (4) rR(M + m) (2)
d 2 ey
Vδ = y − ÿ (22) (4)
ey = = β eV + ξ (t) (25)
gkt kt dt 2
The input-output dynamics of the linearized system is, thus, Remark The above set of relations involving flat output
given by tracking error derivatives, may be viewed as a set of two second
order dynamical sub-systems, with inputs given, respectively, by
a linear combinations of the position tracking error variables and
gkt g(M + m) by the control tracking error variable. The first relation is used
y(4) = V + ÿ (23)
rRLM δ LM to build an ESO observer for the un-measured, first order time
derivative of the incremental flat output tracking error, ėy while
For ADRC scheme, the simplified input-output dynamic is the second relation is used for building an ESO for the total dis-
taken to be: turbance and the third order time derivative of the tracking error
ey . This important “decoupling” feature, which results in no need
for estimating even order time-derivatives, is due, in general, to
an intimal relation between the flatness property of the tangent
gkt g(M + m) system and the underlying Hamiltonian nature of the plant de-
y(4) = β Vδ + ξ (t), β = , ξ (t) = − ÿ(24)
rRLM LM void of damping terms. This issue will be further exploited else-
where; as it not only improves the efficiency of the fourth order
with ξ (t) representing, once more, the total disturbance effects. observer counterpart, but it also yields superior noise rejection
properties.
Let êy0 denote the redundant estimate of the measured flat
output tracking error ey = y − y∗ (t). The first observer is devised
3 PROBLEM FORMULATION AND MAIN RESULT. as follows:
3.1 Problem formulation
Suppose it is desired to have the output y track a given d
smooth output reference trajectory y∗ (t), oriented by the need êy0 = êy1 + k1 (ey − êy0 )
dt
to stabilize the cart and the pendulum at a given constant posi- d
tion, away from the equilibrium point, without remaining oscil- êy1 = geθ + k0 (ey − êy0 ) (26)
dt
lations of the pendulum. Define ey = y − y∗ (t), eV = (V −V ∗ (t))
where V ∗ (t) is the nominal control input obtained from (12)
This observer produces an estimate êy1 of the first order time
and (22). Similarly, we let eθ = θδ − θδ∗ (t) = θ − θ ∗ (t) and
derivative of ey .
ex = xδ − x∗δ (t) = x − x∗ (t). The incremental position variables
A second relation, obtained from (25), prompts an ESO that
nominal trajectories: (x∗ (t), θ ∗ (t)), are easily obtained from the
simultaneously estimates the third order time derivative of the
flat output nominal trajectory thanks to the flatness property; (3)
which allows for a differential parametrization of all system state flat output tracking error, here denoted by êy , and the possible
variables in terms of the flat output and a finite number of its time unknown disturbances ξ (t), represented here by the extension
derivatives. variable z. This observer variable z estimates the lumped effects
of the neglected non-linearities and of the exogenous perturba-
tions (un-modeled dynamics, force disturbances etc). We have,
3.2 A flatness based ADRC scheme
The simplified inverted pendulum on a cart and the con-
vey crane systems have the same input-output expressions. We, d
êy2 = êy3 + k4 (geθ − êy2 )
therefore, consider the design of a single feedback control input dt
law. For implementation purposes, however, it is necessary to d
êy3 = ẑ + β V + k3(geθ − êy2 )
use the required flat output conformation for the plant at hand. dt
Consider the following relations satisfied by the even order time d
z = k2 (geθ − êy2 )
derivatives of the incremental flat output trajectory tracking er- dt
rors: (27)
4 Copyright
c 2017 by ASME
The output observation error, e0 = ey − êy0 , and its time
derivatives e1 = geθ − êy2 generate the following set of recon-
struction error dynamics,
ë0 + k1 ė0 + k0 e0 =0
(3)
e1 − k4 ë1 − k3 ė1 − k2 e1 = ξ̇ (t)
PINION
RAILS
The output tracking controller is synthesized with the aid of a
canceling strategy based on the on-line estimated values of the PENDULUM
5 Copyright
c 2017 by ASME
PENDULUM
CAR
Control Signal
Encoder 2 Encoder 1
Inverted Pendulum
on a car System
FIGURE 8. REFERENCE TRAJECTORY TRACKING COM-
PARED WITH THE ESTIMATE FLAT OUTPUT, SYSTEM VARI-
ABLES AND APPLIED CONTROL INPUT.
6 Copyright
c 2017 by ASME
FIGURE 9. TRACKING, CONTROL INPUT VOLTAGE
7 Copyright
c 2017 by ASME
TABLE 1. EXPERIMENTAL SETUP PARAMETERS systems”. In Society of Instrument and Control Engineers
of Japan (SICE), 2015 54th Annual Conference of the,
Parameter Value Parameter Value pp. 554–559.
Armature resistance R 2.4 Ω Cart mass 1.672 kg [6] Sira-Ramı́rez, H., Ramı́rez-Neria, M., and Rodrı́guez-
Angeles, A., 2010. “On the linear control of nonlinear me-
Torque constant kt 0.35 Nm/A Pendulum mass 0.278 kg
chanical systems”. In 49th IEEE Conference on Decision
Radius of the pinion 0.03 m Pendulum length 0.56 m and Control, pp. 1999–2004.
[7] Sira-Ramirez, H., Linares-Flores, J., Garcia-Rodriguez, C.,
and Contreras-Ordaz, M., 2014. “On the control of the per-
manent magnet synchronous motor: An active disturbance
ness property of the tangent model, a controller is easily devised, rejection control approach”. IEEE Transactions on Control
for the simplified input-to-flat output dynamics, on the basis of Systems Technology, 22(5), September, pp. 2056–2063.
a flat output reference trajectory depicting a desirable state be- [8] Sira-Ramı́rez, H., Linares-Flores, J., Luviano-Juarez, A.,
havior. Our interest lied in providing flat output reference trajec- and Cortés-Romero, J., 2015. “Ultramodelos globales y el
tories which took the system substantially away from the equi- control por rechazo activo de perturbaciones en sistemas
librium point in a relatively short period of time. The ADRC- no lineales diferencialmente planos”. Revista Iberoameri-
ESO scheme perfectly complements the flatness based controller cana de Automática e Informática Industrial RIAI, 12(2),
in providing an accurate estimate of those, nonlinear, neglected pp. 133–144.
terms, which are excited by the demands of the reference tra- [9] Cortés-Romero, J., Rojas-Cubides, H., Coral-Enriquez, H.,
jectory. The on-line canceling of these effects, practically ren- Sira-Ramı́rez, H., and Luviano-Juárez, A., 2013. “Active
ders the controlled system as a purely linear closed loop system. disturbance rejection approach for robust fault-tolerant con-
In this article, a variation of the ESO was used, which entitled trol via observer assisted sliding mode control”. Mathemat-
a set of decoupled lower order observers for the velocity vari- ical Problems in Engineering, 2013.
ables alone. This was achieved thanks to a unique feature of [10] Guo, B.-Z., and Zhao, Z.-L., 2013. “On convergence of the
the flatness property present in the tangent models of the treated nonlinear active disturbance rejection control for mimo sys-
systems. Two experimental cases were successfully studied and tems”. SIAM Journal on Control and Optimization, 51(2),
experimented upon, comprising structurally analogous feedback pp. 1727–1757.
control schemes. [11] Guo, B.-Z., and Zhao, Z.-l., 2011. “On the convergence
of an extended state observer for nonlinear systems with
uncertainty”. Systems & Control Letters, 60(6), pp. 420–
REFERENCES 430.
[1] Han, J., 2009. “From pid to active disturbance rejec- [12] Zheng, Q., Gao, L., and Gao, Z., 2007. “On stability anal-
tion control”. IEEE transactions on Industrial Electronics, ysis of active disturbance rejection control for nonlinear
56(3), pp. 900–906. time-varying plants with unknown dynamics”. In Proceed-
[2] Sira-Ramı́rez, H., Luviano-Juárez, A., and Cortés-Romero, ings of the IEEE Conference on Decision and Control, New
J., 2012. “On the observer assisted sliding mode creation: Orleans, LA, Dec, pp. 12–14.
An active disturbance rejection approach”. In Variable [13] Huang, Y., Xue, W., Zhiqiang, G., Sira-Ramirez, H., Wu,
Structure Systems (VSS), 2012 12th International Work- D., and Sun, M., 2014. “Active disturbance rejection con-
shop on, IEEE, pp. 57–62. trol: Methodology, practice and analysis”. In Control Con-
[3] Ramirez-Neria, M., Garcia-Antonio, J., Sira-Ramirez, H., ference (CCC), 2014 33rd Chinese, IEEE, pp. 1–5.
Velasco-Villa, M., and Castro-Linares, R., 2013. “An active [14] Zhao, S., Sun, L., Li, D., and Gao, Z., 2014. “Tracking
disturbance rejection control of leader-follower thomson’s and disturbance rejection in non-minimum phase systems”.
jumping rings”. Control Theory & Applications, 30(12), In Control Conference (CCC), 2014 33rd Chinese, IEEE,
pp. 1564–1572. pp. 3834–3839.
[4] Ramı́rez-Neria, M., Sira-Ramı́rez, H., Garrido- [15] Zheng, Q., and Gao, Z., 2010. “On practical applications of
Moctezuma, R., and Luviano-Juarez, A., 2014. “Linear active disturbance rejection control”. In Proceedings of the
active disturbance rejection control of underactuated sys- 29th Chinese Control Conference, IEEE, pp. 6095–6100.
tems: The case of the furuta pendulum”. ISA transactions, [16] Madoński, R., and Herman, P., 2015. “Survey on methods
53(4), pp. 920–928. of increasing the efficiency of extended state disturbance
[5] Ramı́rez-Neria, M., Sira-Ramı́rez, H., Garrido- observers”. ISA transactions, 56, pp. 18–27.
Moctezuma, R., and Luviano-Juárez, A., 2015. “Active [17] Sira-Ramı́rez, H., and Agrawal, S. K., 2004. Differentially
disturbance rejection control of singular differentially flat flat systems. Marcel Dekker.
8 Copyright
c 2017 by ASME