Beruflich Dokumente
Kultur Dokumente
Abstract—We consider the problem of controlling the vertical signals of unknown frequency, amplitude and phase. This situa-
motion of a nonlinear model of a helicopter, while stabilizing the tion corresponds, for instance, to the case in which a helicopter
lateral and horizontal position and maintaining a constant attitude. is required to land autonomously on the deck of a ship subject
The reference to be tracked is given by a sum of a constant and
a fixed number of sinusoidal signals, and it is assumed not to be to wave-induced oscillations. The trajectory in question is not
available to the controller. This represents a possible situation in available in real time: rather only the tracking error and its rate
which the controller is required to synchronize the vehicle motion of change are assumed to be available in real time. A similar
with that of an oscillating platform, such as the deck of a ship in problem has been previously considered and solved for a sim-
high seas. We design a nonlinear controller which combines recent plified model of a VTOL aircraft [9]. With respect to the former,
results on nonlinear adaptive output regulations and robust sta-
bilization of systems in feedforward form by means of saturated however, the present case is more challenging, due to the higher
controls. Simulation results show the effectiveness of the method complexity of the vehicle dynamics which renders the stabiliza-
and its ability to cope with uncertainties on the plant and actuator tion onto the desired trajectory a difficult task. We propose a so-
model. lution which combines recent results on nonlinear adaptive reg-
Index Terms—Nonlinear systems, output regulation, robust con- ulation and robust stabilization of systems in feedforward form
trol, saturated controls, vertical takeoff and landing. by means of saturated controls. The focus of this paper is mostly
on the stabilization technique. Due to the intrinsic robustness of
I. INTRODUCTION the method, we expect the controller to perform satisfactorily
despite the effect of parametric uncertainties and unmodeled dy-
where
Moreover
(2)
Fig. 1. Model of the approximated system dynamics.
where is the external wrench in body-fixed co-
ordinates and and the mass and the inertia tensor of the
As far as the external torque is concerned, under the previous
body. We will parametrize the group of rotation matrices by
hypotheses, it is seen from [2] that
means of unit quaternions , where and
denote respectively the scalar and the vector
(7)
parts of the quaternion, satisfying the constraint
in which and are, respectively, a matrix and a
vector of affine functions of the thrust , whose coefficients
Accordingly, the rotation matrix is given as depend on the geometry of the helicopter and on the coefficients
which characterize the aerodynamic forces. A sketch of the po-
sition/attitude dynamics is reported in Fig. 1.
One of the goals of the paper is to design a controller able to
(3) deal with possibly large parameter uncertainties, including the
The second equation in (1) is then replaced by the quaternion mass of the vehicle, its inertia tensor , and the aerodynamic
propagation equation coefficients in (7). Collecting all possible parameters subject to
uncertainty in a single vector , we let stand for its nominal
value and for the additive uncertainty. It is assumed
that , a given compact set. Accordingly, we set
while the motion of the center of mass of the rigid body is ex-
pressed in inertial coordinates as and, bearing in mind the fact that and are func-
(4) tions of
the synchronization error. This trajectory, denoted in what fol- such that the tracking objectives
lows by , is modeled as the sum of a fixed number of si-
nusoidal signals of unknown amplitude, phase and frequency,
namely as and for all
are attained within a semiglobal domain of attraction (that is,
(9) from initial conditions for the plant states in an arbitrarily large
compact set), for all admissible values of the parameters of the
plant and the exosystem. It is worth noting that the controller is
In this setting, the uncertainty on the reference trajectory
allowed to process the tracking error of the center of mass
consists in uncertainty on the exact value of the parameters
and its derivative , but not the state of the exosystem
, . Consequently, one of the main
and the vertical position . Finally, note that the steady-state
goals to be accomplished in the design is to let the center of
value of the main thrust needed to keep the helicopter on
mass of the helicopter asymptotically track, as accurately as
the reference trajectory (10) and (11) is given by
possible, the reference motion
. Since we require to be positive, we must
(10) have
It is also appropriate to require that the vehicle’s attitude asymp- (12)
totically tracks, as accurately as possible, the constant refer-
ence , which corresponds to the following possible which gives an upper bound to the admissible initial conditions
choice for the quaternion1 of the exosystem.
(11)
IV. STABILIZATION OF THE VERTICAL ERROR DYNAMICS
The problem of having to track can be naturally The first step in the regulator design is the computation of
cast in the framework of nonlinear adaptive output regulation the feedforward control signal that must be imposed to achieve
theory (see [11], [12]), as the signal is generated by a zero error in steady state. In the terminology of output regula-
linear time-invariant exosystem tion theory, this amounts in solving the regulator equations for
the problem under investigation (see [10], [11]). To this end,
consider the equation for , readily obtained from (1), (6),
and (3)
in which
To compensate for the nominal value of the gravity force, let us
choose the preliminary control law
with
(13)
1It is worth stressing that this desired attitude configuration is compatible with
The steady-state behavior of is the superposition of a term
the steady state requirement (10) because we are assuming the simplified model meant to enforce the vertical reference acceleration and a term
(6) for the force generation. In the general case, assuming the force generation meant to compensate the residual gravity force.
model as presented in [2], the desired motion (10) is achieved with a steady state
attitude motion different from (11), as described in [10]. 2Note that 2q + 2q c implies (q ) = 1.
416 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 48, NO. 3, MARCH 2003
It is clear that, as depends on unknown parameters and and consider, as an internal model for our problem, the system
on the unmeasurable state , the steady-state control (15) is not
directly implementable as a “feedforward” control. However, it
can be asymptotically reproduced by means of a linear internal
model, as is a linear function of . Accordingly, we choose
the control as the sum of a stabilizing control and the output of
an internal model, i.e., . The internal model will where
be designed on the basis of adaptive output regulation theory
(see [9] and [12]). In fact, (14) is a two-dimensional system
having relative degree 2. Hence, the hypotheses presented in
[12] for the design of an adaptive internal model, hold. Define
the observable pair as in which , and is a row vector.
The control system is rewritten in the form
(19)
in which
with . In case the vector is known, we set
. Otherwise, we consider to be a vector of parameter
estimates to be adapted, and we choose the update law (see [12])
and note that, by construction, the map
(20)
(21)
(17)
(23)
is controllable, and the matrix is Hurwitz. From [12], it is
where . This system, setting
known that, for any vector , there exists a
row vector , of the form (24)
coincides with the origin in case all the modes of the exosystem
are excited. Without loss of generality, we henceforth assume
that this is the case.
This result concludes the stabilization of the vertical dy-
namics. In particular, in case the attitude is kept sufficiently
close to the desired one so that , the -order
controller (13), (19) and (21) with adaptation law (20) is able to
steer asymptotically the vertical error to zero. In Sections V
and VI we will show how to design a control law for the input
to simultaneously achieve the condition in finite Fig. 2. Overall approximated system dynamics.
time, and stabilize the lateral and longitudinal dynamics.
The dynamics are viewed as a system interconnected to
V. DESIGN OF THE STABILIZER the attitude and vertical dynamics, according to the structure
A. Lateral and Longitudinal Dynamics depicted in Fig. 2. Basically, the choice of the control input
able to stabilize the overall system will rely upon the following
We start by deriving the expression of the lateral and longitu- considerations. We look at the subsystem as a system
dinal dynamics resulting from the choice of the main thrust with “virtual control” and exogenous input . The latter, ac-
performed in Section IV. First, note that the term cording to the results presented in Section IV and by virtue of
reads as (28) and (29), is an asymptotically vanishing signal, provided
that the attitude variable is kept sufficiently smallby means of
the control input . In the light of this, the control law will
which, keeping in mind the definition of in (22) and (18), be designed on one hand to force to assume sufficiently small
yields values so that in finite time and, on the other hand, to
render the subsystem input-to-state stable (ISS) with re-
(27) spect to the input . According to classical results about input
where to state stability, this will provide asymptotic stability of the lat-
eral and longitudinal dynamics. This task will be accomplished
using a partially saturated control law, obtained combining a
(28) high gain controller for the attitude dynamics and a nested sat-
uration controller for the dynamics. As it will be clari-
Note that, for all fied in Section VI, the presence of the saturation function plays
a crucial role in “decoupling” the attitude from the dy-
(29) namics, in such a way that the two actions can be performed
Bearing in mind (4), (6), we obtain the following expression for simultaneously.
the longitudinal dynamics:
B. Stabilization of the Attitude Dynamics
In this section, we deal with the problem of achieving the
(30) condition in finite time by a proper design of .
First of all, we use a preliminary control law which is meant to
where
remove the nominal part of from (7) and (8), i.e., we
(31) choose
(35)
Note that we have treated the presence of the forcing term (36)
as a time-varying entry, while plays the role of a bounded
time-varying coefficient. Likewise, the lateral dynamics can be where
put in the form
(33)
with . The control law is then
where
chosen as
(34)
sat (37)
418 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 48, NO. 3, MARCH 2003
controller will be designed using and as virtual controls In the new coordinates , the system of
for the dynamics, and then propagating the resulting con- Fig. 3, augmented with (41) and the control provided by (43),
trol law through the attitude dynamics. Keeping in mind that we can be put in the following form:
need to accomplish this goal using bounded controls, an added
difficulty is given by the presence of an unknown time-varying
coefficient in (30)–(33).
Saturation functions, on which the control law described
below is based, are functions defined in the
following way. For , is any differentiable function
satisfying
for all
for all
for
for
(44)
For
where
(42)
where and , , 1, 2, represent design parameters. Note for all . Without loss of generality, Proposition 5.1 allows
that, by the definition of saturation function, this choice of us to assume for all . With this in mind, we
renders the constraint (38) fulfilled. Finally, let have the following result.
Proposition 5.2: Let be fixed and let and ,
, be such that the following inequalities are satisfied:5
so that the overall control law (37) can be rewritten in the more (45)
compact form
5It is not difficult to show that numbers K ’s and ’s satisfying the given
(43) inequalities indeed exist (see [13]).
420 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 48, NO. 3, MARCH 2003
(50)
(51)
TABLE II
CONTROLLER PARAMETERS
for all and, hence
(52)
(53)
Again, keeping in mind (48), (53) is fulfilled if the following as well. Therefore, we are able to conclude the section stating
three conditions are satisfied: our final result.
Theorem 5.1: Consider the dynamic controller given by (13),
(36), (19)–(21), and (41)–(43). Let the design parameters be
chosen according to Propositions 5.1 and 5.2. Then, for any ini-
tial condition , ,
, , with , the state trajec-
The first inequality can be fulfilled by a sufficiently small .
tory in the coordinates is captured by a
Once has been fixed, the second and the third can be satisfied
neighborhood of the origin, which can be rendered arbitrarily
respectively choosing a sufficiently small value for the restric-
small choosing sufficiently large, and in addition
tion and a sufficiently large value of .
Fig. 7. qt
Steady–state for ( ).
z t 0 z (t) + H (t)[m].
Fig. 5. Tracking error ( )
Fig. 8. xt yt m
Longitudinal and lateral displacement ( ), ( )[ ].
Fig. 6. t
Quaternions q( ).
Initially, the update law for the adaptive internal model has been
disconnected, with the natural frequencies of the internal model
Fig. 9. Main rotor and tail rotor thrusts T (t), T (t)[N ].
set at a wrong initial guess . Then, the adaptive
law has been switched on at time s. The reported attitude does not converge to , as a result of the model un-
simulation refers to the vehicle initially at rest, with initial at- certainties. As expected, while the attitude dynamics converge
titude and position given by and rapidly to the steady state (in about 40 s), the lateral and hori-
meters respectively. Fig. 5 zontal displacements are brought to zero in a slower time scale
shows the vertical error . The vertical po- (see Fig. 8). The separation of the time scale into a faster and
sition reaches, in less than 50 s, a sizable steady-state error, due a slower dynamics is a common feature of control laws based
to the initial mismatch of the natural frequencies of the internal on a combination of high-gain and low-amplitude control, as in
model with those of the exosystem. After the adaptation law has our case. Finally, Figs. 9 and 10 show the four control variables
been turned on, the vertical error is regulated to , which de- , and , respectively. It is easy to see that the controller
creases to zero after time s. Fig. 6 shows the time history succeeds in tracking the unknown reference and in stabilizing
of the attitude parameters. Fig. 7 shows the steady-state response the vehicle configuration, despite the large uncertainties on the
of the attitude parameters : it is readily seen that the vehicle plant model.
ISIDORI et al.: ROBUST NONLINEAR MOTION CONTROL OF A HELICOPTER 423
(55)
where is the nested saturated control law specified in (42).
The overall controller depends on 11 design parameters , , for all , for all satisfying and
, , with , . We have shown for all . Thus, to prove the lemma, it suffices to show that
that, given arbitrary large compact sets of initial conditions, there is a time such that, for all
of uncertain model parameters and of data (frequencies,
amplitudes and phases) characterizing the vertical motion of for all
the landing deck, it is possible to tune the design parameters However, this is a simple consequence of the fact that system
in order to achieve the desired control objective. The overall (25) is locally Lipschitz and that is a compact set.
closed-loop system has dimension , where is the This lemma essentially guarantees that for any there
number of sinusoidal signals which approximate the vertical exist such that, if for all , then the main
motion of the ship ( in the simulation results). The thrust satisfies
tuning of the vertical regulator (namely of the parameters ,
and ) has been discussed in Section IV. In particular,
while and are arbitrary positive numbers, the value
of must be chosen sufficiently large in order to globally for all , for all and all .
asymptotically stabilize system (23) with . The Proceeding now with the proof of Proposition 5.1, note that as
tuning of the attitude/lateral/longitudinal stabilizer is indeed and represent the same orientation, without loss
424 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 48, NO. 3, MARCH 2003
(58)
Pick , , and, using lemma 1.1, choose Let , be such that . Since
in such a way that, if for all , then and , the derivative of along solutions of (40) satisfies
(57)
Furthermore, if which is always satisfied. We prove now that (59) holds every-
where on . To this end, observe that, by continuity,
inequality (59) continues to hold on an open superset of
. Note that is com-
pact and let
Let us compute the derivative of along trajectories of
(40). The first term of (56) yields the following expression:
ISIDORI et al.: ROBUST NONLINEAR MOTION CONTROL OF A HELICOPTER 425
Needless to say, . Keeping in mind that , [3] S. Lane and R. Stengel, “Flight control design using nonlinear inverse
we get dynamics,” Automatica, vol. 24, no. 4, pp. 471–484, 1988.
[4] G. Meyer and L. Cicolani, “Application of nonlinear systems inverses to
automatic flight control design: System concepts and flight evaluations,”
AGARDograph AG-251 Theory Appl. Optimal Control Aerosp. Syst., pp.
10-1–10-29, 1980.
[5] J. Prasad, M. M., and D. Schrage, “Control of a twin lift helicopter
system using nonlinear state feedback,” J. Amer. Helicopter Soc., vol.
(61) 36, no. 4, pp. 57–65.
[6] O. Shakernia, Y. Ma, T. Koo, and S. Sastry, “Landing an unmanned air
vehicle: vision based motion estimation and nonlinear control,” Asian J.
for all . It is easy to prove that there Control, vol. 1, no. 3, pp. 128–144, 1999.
exists a choice of and for which the inequality [7] H. Sira-Ramirez, R. Castro-Linares, and E. Liceaga-Castro, “A liou-
villan system approach for the trajectory planning-based control of he-
licopter models,” Int. J. Robust Nonlinear Control, vol. 10, no. 4, pp.
301–320, 2000.
[8] S. Snell, D. Enns, and W. Garrard, “Nonlinear inversion flight control
for a supermaneuverable aircraft,” AIAA J. Guid., Control, Dyna., vol.
15, no. 4, pp. 976–984, 1992.
(62) [9] L. Marconi, A. Isidori, and A. Serrani, “Autonomous vertical landing on
a oscillating platform: an internal-model based approach,” Automatica,
vol. 38, no. 1, pp. 21–32, 2001.
holds true for all . In fact (62) holds on [10] A. Isidori, L. Marconi, and A. Serrani, “Computation of the zero-error
if manifold for a problem of smooth vertical landing of a helicopter,” in
6th Eur. Control Conf., Porto, Portugal, 2001.
[11] A. Isidori and C. I. Byrnes, “Output regulation of nonlinear systems,”
IEEE Trans. Automat. Contr., vol. 35, pp. 131–140, Feb. 1990.
[12] A. Serrani, A. Isidori, and L. Marconi, “Semiglobal nonlinear output
regulation with adaptive internal model,” IEEE Trans. Automat. Contr.,
vol. 46, pp. 1178–1194, Aug. 2001.
where which can be satisfied choosing [13] L. Marconi and A. Isidori, “Robust global stabilization of a class of un-
certain feedforward nonlinear systems,” Syst. Control Lett., vol. 41, pp.
281–290, 2000.
and [14] A. Isidori, L. Marconi, and A. Serrani, “Autonomous landing of un-
manned helicopters,” Dipartimento di Elettronica, Informatica e Sis-
temistica, Univ. degli Studi di Bologna, Bologna, Italy, 2001.
where and [15] A. Teel, “A nonlinear small gain theorem for the analysis of control
systems with saturations,” IEEE Trans. Automat. Contr., vol. 41, pp.
1256–1270, Sept. 1996.
[16] A. Bacciotti, “Linear fThe local and potentially global stabilization of
cascade systems,” in 2nd IFAC Symp. Nonlinear Control Systems De-
sign, Bordeaux, France, June 1992.
[17] A. Teel and L. Praly, “Tools for semiglobal stabilization by partial and
The previous choices for and ensures that output feedback,” SIAM J. Control Optim., vol. 33, no. 5, pp. 1443–1488,
Sept. 1995.
Lorenzo Marconi (S’98–M’99) was born in Rimini, Italy, in 1970. He gradu- Andrea Serrani (S’95–M’00) received the Laurea degree (B.Eng.) cum laude
ated in electrical engineering and received the Ph.D. degree from the University in electrical engineering and the Dottorato di Ricerca (Ph.D.) in artificial intelli-
of Bologna, Bologna, Italy, in 1995 and 1998, respectively. gence systems from the University of Ancona, Ancona, Italy, and the D.Sci. de-
Since 1995, he has been with the Department of Electronics, Computer Sci- gree in systems science and mathematics from Washington University, St. Louis,
ence, and Systems at the University of Bologna. Since 1999, he has been a MO, in 1993, 1997, and 2000, respectively.
Researcher in automatic control in the same department. From August to De- From 1994 to 1999, he was a Fulbright Fellow at the Department of Systems
cember 1997, and from November to December 1998, he held visiting positions Science and Mathematics,Washington University. From 2000 to 2002, he held a
at the Department of Systems Science and Mathematics, Washington University, Research Associate position at the Department of Electronics and Automation
St. Louis, MO. His current research interests include nonlinear control, output at the University of Ancona. Since 2002, he has been an Assistant Professor
regulation, geometric approach, and fault detection. with the Department of Electrical Engineering at The Ohio State University,
Columbus. His research interests lie in the field of control and systems theory,
with emphasis on nonlinear control, nonlinear dynamical systems, and control
of autonomous vehicles.