You are on page 1of 7

JOURNAL OF GUIDANCE, CONTROL, AND DYNAMICS

Vol. 25, No. 1, January – February 2002

Aggressive Longitudinal Aircraft Trajectory


Tracking Using Nonlinear Control
Saif A. Al-Hiddabi¤
Sultan Qaboos University, Muscat-Al-Khod 123, Sultanate of Oman
and
N. Harris McClamroch†
University of Michigan, Ann Arbor, Michigan 48109-2140

Flight-control system designs are complicated if the aircraft dynamics are nonlinear and nonminimum phase.
The nonminimum phase property can result from the choice of output vector and coupling between the moment
generating actuators and the aerodynamic forces on the aircraft. In this paper we study a  ight-control problem
for a conventional aircraft longitudinal dynamic model that explicitly includes the coupling between the moment
generating actuators and the aerodynamic forces. In particular, we study the execution of a maneuver for which
the aircraft is intended to track a given motion in a vertical plane. We formulate the problem as a nonlinear
tracking control problem. Controllers are developed for an aggressive maneuver that requires the use of a two-
degrees-of-freedom controller design. We demonstrate the value of this control architecture in order to achieve
aggressive maneuvering with good tracking performance. Our approach throughout is to make use of nonlinear
control theory. Our analysis is complicated by the nonminimum phase characteristics of the  ight model.

Introduction the essential features of the longitudinal dynamics of a conventional


Ž xed-wing aircraft.
H
IGHLY maneuverable aircraft provide examples of nonlin-
ear nonminimum phase dynamic systems. The nonminimum Our approach is based on a system decomposition, after suitable
phase property is a result of aerodynamic body forces that are di- state and control coordinate transformations, into two parts: a linear
rectly produced by aerodynamic control surfaces and of the choice input-output subsystem with trivial internal dynamics (the minimum
of tracking outputs. phase part) and an input-output subsystem with unstable internal
In recent years nonlinear decoupling theory and dynamic inver- dynamics (the nonminimum phase part). A requirement for this
sion approaches1;2 have been applied to design  ight-control sys- decomposition to be effective is that the nonminimum phase part
tems. However, it has been shown that straightforward application of is stabilizable in the Ž rst approximation. The tracking problem, in
inversion approaches to nonlinear nonminimum phase  ight-control error coordinates, can be treated as a stabilization problem of a
models can result in a system with a linear input/output response nominal time-invariant system perturbed by terms that depend on the
but unstable zero dynamics.3 5 In- ight6 8 controls are designed
¡ ¡
tracking commands and their derivatives. These perturbation terms
using nonlinear inversion, but no attempt is made to investigate the appear only in the internal dynamics of the nonminimum phase part.
stability of the resulting zero dynamics. A feedback control law, which solves the original tracking problem,
Progress has been made in3 and5 in which a weakly nonminimum is then designed in two parts. First, a fast stabilizing control law is
phase system is approximated by a minimum phase one. Recent designed based on dynamic inversion for the minimum phase part.
progress in output tracking of nonlinear systems has been achieved Second, a robust locally stabilizing linear feedback control law is
based on development of an output regulation theory.9 Output reg- designed for the nonminimum phase part. The robust controller for
ulation ensures internal stability with asymptotic output tracking the nonminimum phase part provides a tradeoff between the class
for a class of nonlinear systems but requires solving a set of par- of commands that can be tracked and the achievable performance
tial differential equations, and it is limited to reference trajectories of the closed loop.
generated by an exosystem. For linear nonminimum phase systems with feedback con-
Unlike previous work on  ight-control problems where the main trol only, there exist fundamental limitations in the achievable
emphasis was on stabilization or tracking constant commands, this performance 10 ;11 of the closed-loop system. Thus, for nonlinear non-
paper addresses position tracking for  ight vehicle models that can minimum phase systems we expect that feedback control can only
be characterized as multi-input, multi-output, nonlinear, nonmini- track trimmed and near trimmed commands (nonaggressive track-
mum phase systems. The objective is to design a tracking control law ing). To solve the aggressive trajectory tracking problem, we modify
such that outputs of the closed-loop system satisfy certain maneuver the control design for the nonminimum phase part by including a
performance objectives with internal stability. feedforward control part as well as a feedback control part. The feed-
In this paper we develop a nonlinear tracking controller for a con- forward control is computed using an iterative numerical procedure
ventional Ž xed-wing aircraft. The  ight model provides a challeng- called noncausal stable inversion.12 The use of feedforward control
ing example for nonlinear  ight-control studies. The model captures is essential to achieve good tracking performance when dealing with
nonminimum phase systems.
There is a large literature that illustrates the application of vari-
ous nonlinear control approaches to various  ight control problems.
Received 5 June 2000; revision received 30 November 2000; accepted for There are fewer papers that treat output tracking for  ight control
publication 5 April 2001. Copyright © 2001 by the American Institute of problems, see, for example, Ref. 13. One widely studied problem is
Aeronautics and Astronautics, Inc. All rights reserved. Copies of this paper the planar vertical takeoff and landing problem, see, for example,
may be made for personal or internal use, on condition that the copier pay
Refs. 4, 14, and 15. The present paper represents a nontrivial exten-
the $10.00 per-copy fee to the Copyright Clearance Center, Inc., 222 Rose-
wood Drive, Danvers, MA 01923; include the code 0731-5090/02 $10.00 in
sion of our paper16 treating the approximated longitudinal aircraft
correspondence with the CCC. model introduced by Tomlin et al. in Ref. 17. The present paper also
¤
Lecturer, Department of Mechanical and Industrial Engineering, P.O. introduces a new nonlinear control design approach that, we believe,
Box 33. leads to improved closed-loop properties, especially in performing

Professor, Department of Aerospace Engineering. Senior Member AIAA. aggressive  ight maneuvers.

26
AL-HIDDABI AND M C CLAMROCH 27

u x D T = . mg/ , u m D M = I y , and ² D ² 0 I y = . mg/ . Then the rescaled


dynamics become
xR D ¡ D cos °
0
¡ L sin °
0
C u x cos µ (6)

zR D ¡ D sin °
0
C L cos °
0
C u x sin µ ¡ 1 (7)

µR D um (8)

where L and D are dimensionless lift and drag forces given by


0 0

2
al v . 1 C c® / ¡ K 1 cos ° K 1 u x sin ®
0
L D ¡ . K 2 = m /v µP C ²um ¡

(9)
¡ ¯ ¢ £

D ad v 2 [1 C b . 1 C c ®/ 2 ] C 2K 3 v 2 al v 2 . 1 C c® /
0
D
Fig. 1 Longitudinal aircraft model in  ight. ¤

¡ K 1 cos ° ¡ . K 2 = m /v µP .² u m ¡ K 1 u x sin ® /
Equations of Motion of the Flight Vehicle
¡ ¯ ¢ ©
2 2 2
C K3 v .² u m ¡ K 1 u x sin ® / C [K 1 cos ° C . K 2 = m /v µP ]
We develop a nonlinear model, which describes the longitudinal ª
2
dynamics of an aircraft in forward  ight. The longitudinal aircraft ¡ 2al v . 1 C c ® / [K 1 cos ° C . K 2 = m /v µP ] (10)
model provides a challenging example for nonlinear  ight-control where
studies. The aircraft model includes aerodynamic forces as well as
coupling between the aerodynamic pitch moment and the aerody- V ½ g S CQ l 0 ½ g SC d 0
v D ; al D ; ad D
namic translational forces. Figure 1 shows a prototype longitudinal g 2m 2m
aircraft in  ight. The aircraft state is the position X , Z of the aircraft
2
center of mass, the pitch angle µ of the aircraft, and the correspond- CQ l ® K CQ l 0 2m K
ing velocities XP , ZP , µP . The control inputs T and M are, respectively, c D ; b D ; K3 D
Cl 0 Q Cd 0 ½gS
the thrust along the aircraft body Ž xed x axis and the pitching mo-
ment about the aircraft center of mass. The longitudinal aircraft model is not linear afŽ ne in the control,
De ecting an elevator upward produces a small negative lift force and this is obvious from the expressions for the aerodynamic lift and
which generates a positive pitching moment about the center of mass drag forces in Eqs. (9) and (10). DeŽ ne new control variables (v x ,
of the aircraft. The presence of this parasitic aerodynamic force v z ) in terms of (u x , u m ) by the following invertible transformation:
makes the longitudinal aircraft model nonminimum phase. In this
vx D ¡ D cos °
0
¡ L sin °
0
C u x cos µ (11)
case nonlinear control design method such as dynamic inversion is
not directly applicable to this  ight-control problem.18 In this section (12)
D sin ° L cos ° u x sin µ 1
0 0
vz D ¡ C C ¡
we provide detailed expressions for the effects of the aerodynamic
pitch moment on the aerodynamic translational forces. We express Using Eqs. (9), (11), and (12), we obtain
the aerodynamic lift and drag in terms of the aerodynamic pitch
² um D . 1 C K 1 / u x sin ® C .v z C K1 C 1/ cos °
moment.
The full longitudinal equations of motion of an aircraft can be ¡ v x sin ° ¡ al v . 1 C c ® / (13) 2

written as
By using the relation D D ad v 2 C . K 3 =v 2 / L 2 with Eqs. (11 – 13), 0 0

(1) we obtain after some algebraic manipulations


m XR D ¡ D cos ° ¡ L sin ° C T cos µ
±. xN / u 2x C b. xN ; vN /u x C c. xN ; v/
N D 0 (14)
¡ m ZR D D sin ° ¡ L cos ° ¡ T sin µ C mg (2)
where xN D . x ; xP ; z ; zP ; µ ; µP / , vN D .v x ; v z / , and
I y µR D M (3)
±. xN / D K 3 . sin ® = v / 2 cos ®

The aerodynamic lift force L and the aerodynamic drag force D,


¡ ¯ ¢
2 2
b . xN ; vN / D K 3 v sin 2® [.v z C 1/ cos ° ¡ v x sin ° ] ¡ cos ®
which are functions of the aerodynamic pitching moment M ,19 are
given by
¡ ¯ ¢
2 2
c . xN ; vN / D K 3 v [.v z C 1/ cos ° ¡ v x sin ° ] cos ®
L D Q s .CQ l 0 C CQ l ® ® / ¡ mg K 1 cos ° ¡ K 1 T sin ® ¡ K 2 V µP C ²0 M C [.v z C 1/ cos ° ¡ v x sin ° ] sin ® C .v z C 1/ sin µ
(4)
£ ¡ ¯ ¢ ¤
C v x cos µ C ad v 2 cos ®
D D Q s Cd0 C K Q 2s L 2 (5)
The output tracking control problem is deŽ ned in terms of speciŽ ed
where command functions
¯ ¡ ¯ ¢ ¯ xc D X c =g; zc D Z c =g
²0 D Cl ± e cN C m ±e ¡ cC
N l ± e C m ® ½ S 4m ;
P K1 D ² 0 cN 2 C m ®P ½ S 4m
¯
which are assumed to be twice differentiable.
K2 D ² 0 cN 2 ½ S . C mq C C m ® / 4;
P CQ l 0 D . 1 C K 1 /C l0 C ² 0 cC
N m0 Using the preceding control transformation, Eqs. (6– 8) can be
written in the error dynamics normal form as
CQ l ® D . 1 C K 1 / Cl ® C ² 0 cC
N m® eR x D vQ x (15)

Equations (4) and (5) show the relation between the aerodynamic eR z D vQ z (16)
lift L and drag D and the aerodynamic pitching moment M . The £ ¤

parameter ² 0 in Eq. (4) gives the explicit coupling between the aero- ² µR D . 1 C K 1 / u x sin ® ¡ al . eP x C xP c / 2 C . eP z C zP c / 2 . 1 C c ® /
dynamic forces and the aerodynamic control moment. This param-
eter represents approximately the ratio between the aerodynamic C . vQ z C zR c C K1 C 1/ cos ° ¡ . vQ x C xR c / sin ° (17)
lift force and the aerodynamic moment generated by the elevator. where ex D x ¡ xc , e z D z ¡ z c , vQ x D v x ¡ xR c , and vQ z D v z ¡ zR c .
We scale the longitudinal aircraft model by dividing Eqs. (1) and The zero dynamics of the longitudinal aircraft system can be
(2) by mg and dividing Eq. (3) by I y . DeŽ ne x D X = g, z D ¡ Z = g, obtained by assuming that the aircraft is  ying with a constant
28 AL-HIDDABI AND M C CLAMROCH

commanded horizontal speed xP c at a constant altitude so that zP c D 0.


¤
eR z D vQ z (24a)
In this case xR D zR D zP D ° D 0 and ® D µ . Without lost of generality,
we linearize Eq. (17) around µ D µP D 0 to obtain the zero dynamics Ṕ D A 11 Ń C A 12 eN z C B11 vQ z (24b)
equation:
£ ¡ ¯ ¢ ¤
with perturbation g .´; eP x ; eP z ; vQ x ; vQ z ; Yc / .
2 2
. 1=² / . 1 C K 1 / K 3 xP c (18)
¤ ¤
µR D C . ad ¡ al c / xP c µ
Control of the Minimum Phase Dynamics
For conventional aircraft [. 1 C K 1 /. K 3 = xP c 2 / C . ad ¡ al c / xP c 2 ] and ¤ ¤
Based on the preceding decomposition, feedback inversion can
² are negative constants. Hence the origin of Eq. (18) is an unstable be used to solve the output tracking problem for the minimum phase
saddle equilibrium, which indicates that the longitudinal aircraft dynamics (19). We choose a high gain controller
system is nonminimum phase. ¡ ¯
2
¢

vQ x D ¡ .¯ 1 = ² 1 / eP x ¡ ¯ 2 ²1 ex (25)
Control System Design
We consider the longitudinal aircraft model given by Eqs. (15 – where ² 1 > 0 is a timescale parameter and ¯ i , i D 1; 2 are constants to
17). The driven dynamics (17) is time invariant when xR c D zR c D 0. be chosen such that the closed-loop system is exponentially stable.
All commands for which the driven dynamics is time invariant are If ¯ i > 0, i D 1, 2, the closed-loop minimum phase part is exponen-
trimmed commands, and accordingly we deŽ ne all trajectories that tially stable for any ² 1 > 0, and hence for any differentiable output
are generated by trimmed commands as trimmed trajectories. On command x c , x ¡ x c ! 0 as t ! 1 .
the other hand, all trajectories that are generated by nontrimmed
commands are called nontrimmed trajectories. A nontrimmed tra- Control of the Nonminimum Phase Dynamics
jectory can be either aggressive or nonaggressive. Nonaggressive Following the development in Refs. 19 – 21 we use an linear
trajectories are those generated by small xR c and zR c commands. Ag- quadratic regulator (LQR) approach to design a stabilizing feed-
gressive trajectories are those trajectories that correspond to either back law for the nominal system (24):
large acceleration commands or small acceleration commands but
with high tracking accuracy requirement. vQ z D ¡ k1 ez ¡ k 2 eP z ¡ k3 .µ ¡ µ / ¡ k4 µP
¤
(26)
1
where [k1 ; k2 ; k3 ; k4 ] D R ¡
B T P and P is the solution of the alge-
Tracking Control System Design Using Feedback
Minimum Phase/Nonminimum Phase Decomposition
braic Riccati equation
We treat the longitudinal aircraft system (15 – 17), as an intercon- AT P C PA C Q ¡ PBR
¡ 1
BTP D 0 (27)
nection of two subsystems; a minimum phase part deŽ ned by the
horizontal  ight dynamics where Q is positive deŽ nite matrix, R > 0, B D . 0; 1; 0; 1/ and
(19)
2 3

e
Rx D v
Q x
0 1 0 0
0 0 0 0
6 7

and a nonminimum phase part deŽ ned by the vertical and pitching 6 7

 ight dynamics A D
6

6 0 0 0 1
7

@f @f
4 5
¡ ¢ ¡ ¢

eR z D vQ z (20) 0 ´ ; 0; 0; 0; 0; Yc
¤ ¤
´ ; 0; 0; 0; 0; Yc
¤ ¤
0
£ ¤
²@ zP ²@ µ
² µR D . 1 C K 1 / u x sin ® ¡ al . eP x C xP c / 2 C . eP z C zP c / 2 . 1 C c ® /
Tracking Control Result
C . vQ z C zR c C K1 C 1/ cos ° ¡ . vQ x C xR c / sin ° (21) We now substitute the controllers given by Eqs. (25) and (26) into
Eqs. (15), (16), and (23) to obtain the exact closed loop:
¡ ¯ ¢

It is clear that there is one-way coupling between the two sub- eR x D ¡ .¯ 1 = ² 1 / eP x ¡ ¯ 2 ² 1 ex


2
(28)
systems, namely, from the minimum phase part to the nonminimum
phase part. The driven dynamics of Eq. (21) can be written as zPO D A c zO C gO . ex ; eP x ; zO ; Yc / (29)
Ṕ D f .´; eP x ; eP z ; vQ x ; vQ z ; Yc / (22)
Here zO D . ez ; eP z ; ´/ and A c D A ¡ BK, where K D [k1 ; k2 ; k 3 ; k4 ].
Assumption 1: The matrix Ac is Hurwitz.
where ´ D .µ ; µP / and Yc D . xP c ; zP c ; xR c ; zR c / . Suppose we write Eq. (22)
Assumption 2: The perturbation term gO . ex ; eP x ; zO ; Yc / satisŽ es the
as
following inequality on k zO k 2 < r :
Ṕ D A11 Ń C A12 eN z C B11 vQ z C g .´; eP x ; eP z ; vQ x ; vQ z ; Yc / (23)
k O g . 0; 0; zO ; Yc / k · ° . Yc / k zO k C ±. Yc / (30)
where
where ° [Yc . t / ]: R ! R and ± [Yc . t / ]: R ! R are nonnegative, con-
@f ¡ ¢

tinuous functions that satisfy the following inequalities:


´ ; 0; 0; 0; 0; Yc
¤ ¤
eN z D . ez ; eP z /; A 11 D
@´ Z
t

@f ¡ ¢
@f ¡ ¢ ° [Yc .¿ // d¿ · kt C c; t ¸ 0
A 12 ´ ; 0; 0; 0; 0; Yc ; B11 ´ ; 0; 0; 0; 0; Yc
¤ ¤ ¤ ¤
D D 0
@ eN z @ vz
¸ min . P /® r
g .´; eP x ; eP z ; vQ x ; vQ z ; Yc / D f .´; eP x ; eP z ; vQ x ; vQ z ; Yc / sup ± [Yc . t / ] <
t ¸ 0 ¸ max . P /½
¡ A 11 Ń ¡ A e 12 N z ¡ B v 11 Q z
for some nonnegative constants k, c, ® , and ½ , where
µ ¶

Here Yc D . xP c ; 0; 0; 0/ , Ń D ´ ¡ ´ , and ´
¤ ¤ ¤ ¤
D .µ ; 0/ , where µ is an
¤ ¤
¸ min . P /¸ min . QO / 1 ¸ min . QO / 2¸ max . P /
equilibrium pitch angle satisfying k< ; ® D ¡ k >0
2¸ 2max . P / 2 ¸ max . P / ¸ min . P /
¡ ¢

f µ ; 0; 0; 0; 0; Yc 0
¤
D µ ¶

¸ max . P / c
½ D exp ¸ 1
Therefore, the nonminimum phase dynamics described by ¸ min . P /
Eqs. (20) and (21) can be viewed as a perturbation of the nominal
1
system where QO D Q C PBR ¡
BT P .
AL-HIDDABI AND M C CLAMROCH 29

We use Assumptions 1 and 2 for the remainder of this paper. We


consider two cases for which conclusions can be made about the
closed-loop system deŽ ned by Eqs. (28) and (29):
1) Assume the horizontal acceleration commanded xR c D 0 and the
vertical acceleration command zR c D 0. There exists ² 1 such that if
¤

0 < ² 1 < ² 1 then the origin is an asymptotically stable equilibrium


¤

of the closed-loop deŽ ned by Eqs. (28) and (29). The origin corre-
sponds to exact output tracking; and for any initial state sufŽ ciently
close to the origin, x ¡ x c ! 0, and z ¡ z c ! 0 as t ! 1 .
2) Assume the commanded vertical position z c and the com-
manded horizontal position xc are such that the following robust
stability inequalities are satisŽ ed on k zO 1 ¡ zO 2 k 2 < r :

k O g . 0; 0; zO 1 ; Yc / ¡ gO . 0; 0; zO 2 ; Yc / k · ° . Yc / k zO 1 ¡ zO 2 k 2 (31)

g . ex ; eP x ; zO ; Yc / ¡ gO . 0; 0; zO ; Yc / k < . c2 =c1 / k . ex ; eP x / k 2 (32)


k O

Then x ¡ x c ! 0 as t ! 1 , and the tracking error z ¡ z c is uni-


formly ultimately bounded with ultimate bound
¸ max . P /½¯ Fig. 3 Control responses: feedback control only.
b>
2¸ min . P /
tracking is required. In this case the near-trimmed  ight controllers
Proofs of these results follow from Refs. 19 – 21. The preceding that are based on static state feedback can be expected to fail or to
bounds on the vertical and horizontal acceleration commands are lead to poor tracking performance. To solve the aggressive trajectory
conservative as a consequence of a worst-case analysis. tracking problem, we must modify the nonminimum phase control
design by including feedforward control as well as a feedback con-
Tracking Simulations Using Feedback trol. We show that this controller leads to asymptotic tracking of
We consider a DC8 aircraft to illustrate the preceding control aggressive commands with closed-loop stability.
design for the longitudinal aircraft model. The controller is de-
signed for a nominal value of ² D 0: 23, which corresponds to re- Our Conceptual Approach to Tracking Aggressive Maneuvers
alistic aerodynamic data.22 The controller parameters R D 0: 1, Q D In the case of nonaggressive trajectory tracking design, the non-
diag. 0: 5; 5; 1; 1/ , ¯ 1 D 0: 01, ¯ 2 D 0:2, and ² 1 D 0:1. minimum phase controller uses feedback of the states of the internal
Figure 2 shows the total error in the aircraft response to a step dynamics in order to stabilize the zero dynamics. For nonaggres-
command from 100 to 130 m/s for the horizontal velocity and to sive commands the inputs (output commands and derivatives) to
a vertical position command corresponding to a nap of the Earth the driven dynamics are small, and hence the states of the driven
(NOE) maneuver given by z c D . 250 2 /
¤ [1 ¡ cos .¼ ¤ t =60 / ]. m / ; dynamics remain bounded.
Figure 2 shows the total error over the maneuver period of 120 s. It For aggressive maneuvers the inputs to the driven dynamics are
can be seen that the total error is not zero. This is expected because large, and in this case the feedback controller is often unable to main-
we have shown that exact tracking is not possible if the vertical tain bounded driven dynamics. This in turn can lead to instability.
or horizontal acceleration is not zero. Figure 3 shows the control To overcome this problem, the feedforward control counterbalances
signals required to execute the NOE maneuver only over the initial the large perturbations induced by the aggressive commands. The
transient period of 2 s. In the following sections we consider tracking overall control design approach for aggressive tracking has the merit
the same NOE maneuver, but the objective this time is to achieve that it results in a tracking controller with feedforward terms and
exact tracking or zero error tracking with internal stability. Thus we constant gain feedback terms.
will consider an aggressive trajectory control design approach to Our approach in solving the tracking problem is to compute Ž rst
achieve such objectives. a bounded feedforward control using the noncausal stable inversion
approach.12 The feedback controller is then designed using a modi-
Tracking Control System Design Using Feedback and Feedforward Ž ed LQR approach with singular perturbation approach that allows
An aggressive  ight maneuver occurs when the maneuver cor- design of a high gain controller for the minimum phase part and an
responds to large vehicle acceleration commands or when exact LQR controller for the nominal nonminimum phase part (Fig. 4).
The LQR/singular perturbation method allows us to study the sta-
bility of the nonminimum phase part independently of the minimum
phase dynamics.
It is important to emphasize that in our approach the noncausal
stable inversion method is used after the original  ight equations are
transformed to normal form, expressed in terms of error coordinates
and decomposed into a minimum phase part and a nonminimum
phase part. In this format the noncausal inversion method is only
applied to the nonminimum phase part, which is of lower dimension
than the original nonminimum phase problem. Also our approach
avoids the complexity of using time-varying feedback gains.
We consider the  ight control problem where the aircraft performs
a NOE maneuver in a vertical plane. Previously we considered the
same maneuver, but we used a trimmed  ight controller to track a
nontrimmed trajectory. The result of the trimmed tracking controller
as seen in Fig. 2 is not satisfactory because the tracking errors are
relatively large.
In this section we use the noncausal stable inversion approach to
compute a feedforward control term that enhances the performance
of the closed-loop system. It is important to mention that the aircraft
 ight model is not linear afŽ ne in the control. This makes the com-
Fig. 2 NOE maneuver: feedback control only. putation of the feedforward control numerically more challenging.
30 AL-HIDDABI AND M C CLAMROCH

Fig. 5 Ideal driven dynamics: NOE maneuver.

K3 2
[. zR c 1/ cos ° ] cos ® [. zR c 1/ cos ° ]
¤ ¤
c .µ ; t / D C C C
xP c2 C zP 2c
Fig. 4 Block diagram of the closed loop. ¡ ¢

sin ® . zR c 1/ sin µ ad xP c2 zP c2 cos ®


¤ ¤ ¤
£ C C C C

The closed-loop system deŽ ned by Eqs. (28) and (29), in terms In the process of computing the bounded solutions µ and µP , we ¤ ¤

of the original states, is given by Ž rst solve Eq. (42) for u x assuming that µ D µP D 0, then this solu-
¤ ¤ ¤

xR D vx (33) tion is used with the assumption that µ D µP D 0 to solve Eq. (41). ¤ ¤

The updated solutions µ and µP are then used to Ž nd the new u x from
¤ ¤ ¤

z
R D vz (34) Eq. (42). The preceding procedure is repeated until convergence is
achieved.
²µ R D . 1 C K 1 / u x sin ® C .v z C K1 C 1/ cos ° For the NOE maneuver corresponding to a step command of xP c D
¡ v x sin ° ¡
2
al v . 1 C c® / (35) 130 m/s for the horizontal velocity and to a vertical position com-
mand given by
where 250
¡ ¯ ¢
z c .t / D
2 [1
¡ cos.¼ t = 60/ ] (43)
vx D xR c ¡ .¯ 1 = ² 1 /. xP ¡ xP c / ¡ ¯2 ² 12 .x ¡ xc / (36)
the bounded solutions µ and µP are obtained numerically using the¤ ¤

vz D zR c ¡ k 1 . z ¡ z c / ¡ k2 . zP ¡ zP c / ¡ k 3 .µ ¡ µ / ¡ k4 µ
¤
P (37) iterative method introduced in Ref. 12. The results are shown in
Fig. 5.
1 T
Here ¯ 1 > 0, ¯ 2 > 0, and [k1 ; k 2 ; k3 ; k 4 ] D R B P and P is the so- ¡

lution of Eq. (27). The thrust u x can be obtained by solving Eq. (14). Tracking Control Result
The resulting tracking controller, including feedforward and feed-
Computation of the Feedforward Control back terms, has the form:
Following the approach of Ref. 19, we add a feedforward control ±. xN / u 2x C b . xN ; vN / u x C c . xN ; vN / D 0 (44a)
term to the nonminimum phase part so that
zR D vz C vff (38) ² um D . 1 C K 1 / u x sin ® C .v z C K1 C 1/ cos °
2
¡ v x sin ° ¡ al v . 1 C c® / (44b)
² µR D . 1 C K 1 / u x sin ® C .v z C K1 C 1/ cos °
where
¡ v x sin ° ¡ al v 2 . 1 C c® / (39)
±. xN / D K 3 . sin ® = v / 2 cos ®
To determine the feedforward term v f f , we set x D x c , xP D xP c , xR D xR c ,
z D z c , zP D zP c , zR D zR c in Eqs. (37) and (39) to obtain
¡ ¯ ¢

b . xN ; vN / D K 3 v 2 sin 2® [.v z C 1/ cos ° ¡ v x sin ° ] ¡ cos 2 ®


vff D k3 µ
¤
C k4 µP
¤
(40) ¡ ¯ ¢

c . xN ; vN / D K 3 v 2 [.v z C 1/ cos ° ¡ v x sin ° ]2 cos ®


where µ and µP are bounded solutions of
¤ ¤

C [.v z C 1/ cos ° ¡ v x sin ° ] sin ®


. 1 C K 1 / u x sin ® . zR c K 1 C 1/ cos °
¤ ¤ ¤
² µR D C C

¡ ¢
C .v z C 1/ sin µ C v x cos µ C ad v 2 cos ®
2
¡ al x zP 2c .1 C c® / (41)
¤ ¡ ¯ ¢
Pc C
vx D xR c ¡ .¯ 1 =² 1 /. xP ¡ xP c / ¡ ¯ 2 ² 12 . x ¡ xc /
Here ° D tan 1 . zP c = xP c /, ®
¡ ¤
D µ¤ ¡ ° , and u ¤x satisŽ es
zR c k1 .z z c / ¡ k 2 . xP zP c / ¡ k3 .µ µ / ¡ k 4 . µP
¤ ¤
vz D ¡ ¡ ¡ ¡ ¡ µP /
±.µ ; t / u x 2 b.µ ; t / u x c.µ ; t / 0 (42)
¤ ¤ ¤ ¤ ¤
C C D
The feedback controller gains are chosen as follows: ² 1 D 1; ¯ 1 D 6;
where ¯ 2 D 8; [k 1 ; k2 ; k3 ; k4 ] D [¡ 2:2361 ;¡ 12: 2245; ¡ 51: 9616; ¡ 8: 6262].
³ ´
2 DeŽ ne en D . ez ; eP z / ; ´ s D .µ ; µP / ; Ń D ´ ¡ ´ s ; and zN D . en ; Ń / . The
¤ ¤

sin ®
¤

±.µ ; t /
¤
D K3 p cos ®
¤ exact closed loop using the two-degrees-of-freedom controller (44)
xP c2 C zP 2c can be written as
¡ ¯ ¢

eR x D ¡ .¯ 1 = ² 1 / eP x ¡ ¯ 2 ² 12 ex (45)
K3 2
sin 2® [. zR c 1/ cos ° ] ¡ cos ®
¤ ¤ ¤
b .µ ; t / D C
xP c2 C zP 2c zPN D Ac zN C gO . e x ; eP x ; en ; Ń C ´ s ; Yc / ¡ gO . 0; 0; 0; ´ s ; Yc / (46)
AL-HIDDABI AND M C CLAMROCH 31

Assumption 3: The incremental perturbation term in Eq. (46) maximum of 12 m (see Fig. 2) to a maximum of 0.12 m (see Fig. 6)
satisŽ es the following inequality over k zN k 2 < r : after the feedforward control is added. Figure 7 shows the control
signals required to execute the maneuver.
g . 0 ; 0 ; en ;
k O Ń C ´ s ; Yc / ¡ gO . 0; 0; 0; ´ s ; Yc / k · ° . Yc / k zN k (47)

where ° : R ! R is nonnegative, continuous function satisŽ es the Conclusions


following inequality: In this paper we studied a  ight-control problem for a conven-
Z
t tional aircraft using a longitudinal dynamics model that explicitly
° [Yc .¿ /] d¿ · kt
N C c; t ¸ 0 (48) includes the coupling between the moment generating effectors and
0 the aerodynamic forces. We showed that this coupling is a major
source of difŽ culty in the design of control systems that accomplish
for some nonnegative constants k,
N
c, where aggressive maneuvers deŽ ned in terms of a speciŽ ed inertial motion
¸ min . P /¸ min . QO / in a vertical plane. In particular, this is the source of the fact that the
kN < model is nonminimum phase if the outputs are selected as the hori-
2¸ 2max . P / zontal and vertical position of the center of mass of the aircraft. The
tracking problem consists of the execution of a maneuver for which
where QO D Q C PBR 1 B T P. ¡

the aircraft tracks a given motion in a vertical plane. We formulated


We use Assumptions 1 and 3. There exist ² 1 > 0 such that for all ¤

the problem as a nonlinear tracking control problem. Controllers


0 < ² 1 < ² 1 the following is true:
¤

were developed for an aggressive maneuver that requires the use of


1) If [e x . 0/; eP x . 0/; en . 0/; ´. 0/ ] D [0; 0; 0; ´ s .0/ ], the output re-
a two-degrees-of-freedom controller design. An important feature
sponse satisŽ es ´.t / D ´ s .t/ , t ¸ 0, and hence x .t/ D x c .t / and z .t/ D
of the feedforward control is that its computation requires knowl-
z c . t / , t ¸ 0.
edge of “future” tracking commands. We demonstrated the value of
2) If k [ex . 0/; eP x . 0/; en . 0/; ´.0/ ] ¡ [0; 0; 0; ´ s . 0/ ]k is small, the
this control architecture by showing that it can achieve aggressive
output response satisŽ es ´. t / ¡ ´ s . t / ! 0, x . t / ¡ x c . t / ! 0, and
maneuvering with good tracking performance.
z . t / ¡ z c . t / ! 0 as t ! 1 .
Proofs of these results follow from Ref. 19.
Acknowledgment
Tracking Simulations Using Feedback and Feedforward Support from the National Science Foundation Grant ECS-
Figure 6 shows the tracking errors corresponding to an initial state 9906018 is gratefully acknowledged.
(0, 130, 0, 0, 0.0227, 0). The total tracking error is reduced from a
References
1
Meyer, G., Su, R., and Hunt, L. R., “Application of Nonlinear Trans-
formation to Automatic Flight Control,” Automatica, Vol. 1, No. 20, 1984,
pp. 103 – 107.
2
Lane, S. H., and Stengle, R. F., “Flight Control Using Nonlinear Inverse
Dynamics,” Automatica, Vol. 24, No. 4, 1988, pp. 471 – 483.
3
Hauser, J., Sastry, S., and Meyer, G., “Nonlinear Controller Design for
Slightly Nonminimum Phase Systems: Application to V/STOL Aircraft,”
Automatica, Vol. 28, No. 4, 1992, pp. 665 – 679.
4
Martin, P., Devasia, S., and Paden, B., “A Different Look at Output
Tracking: Control of A VTOL Aircraft,” Automatica, Vol. 32, No. 1, 1996,
pp. 101 – 107.
5
Benvenuti, L., Benedetto, M. D. D., and Grizzle, J. W., “Approximate
Output Tracking for Nonlinear Non-Minimum Phase System with an Ap-
plication to Flight Control,” International Journal of Robust and Nonlinear
Control, Vol. 4, No. 2, 1994, pp. 397 – 414.
6
Azzam, M., and Singh, S. N., “Invertibility and Trajectory Control for
Nonlinear Maneuvers of Aircraft,” Journal of Guidance, Control, and Dy-
namics, Vol. 17, No. 1, 1994, pp. 192 – 200.
7
Zhiqiang, Z., “Nonlinear Decoupling Control of Aircraft Motion,” Jour-
nal of Guidance, Control, and Dynamics, Vol. 18, No. 4, 1995, pp. 812 – 816.
8
Snell, S. A., Enns, D. F., and Garrard, W. L., Jr., “Nonlinear Inversion
Flight Control for a Supermaneuverable Aircraft,” Journal of Guidance,
Fig. 6 NOE maneuver: feedback plus feedforward control. Control, and Dynamics, Vol. 15, No. 4, 1992, pp. 976 – 980.
9
Isidori, A., and Byrnes, C., “Output Regulation of Nonlinear Systems,”
IEEE Transactions on Automatic Control, Vol. 35, No. 2, 1990, pp. 131 – 140.
10
Freudenberg, J. S., and Looze, D. P., “Right Half Plane Poles and Ze-
ros, and Design Tradeoffs in Feedback Systems,” IEEE Transactions on
Automatic Control, Vol. 30, No. 6, 1985, pp. 555 – 565.
11
Qiu, L., and Davison, E. J., “Performance Limitations of Non-Minimum
Phase Systems in Servomechanism Problem,” Automatica, Vol. 29, No. 2,
1993, pp. 337 – 349.
12
Devasia, S., Chen, D., and Paden, B., “Nonlinear Inversion-Based Out-
put Tracking,” IEEE Transactions on Automatic Control, Vol. 41, No. 7,
1996, pp. 930 – 942.
13
Kaminer, I., Pascoal, A., Hallberg, E., and Silvestre, C., “Trajectory
Tracking for Autonomous Vehicles: An Integrated Approach to Guidance
and Control,” Journal of Guidance, Control, and Dynamics, Vol. 21, No. 1,
1998, pp. 29 – 38.
14
Al-Hiddabi, S. A., and McClamroch, N. H., “Output Tracking for Non-
linear Non-Minimum Phase VTOL Aircraft,” Proceedings of the 1998 37th
IEEE Conference on Decision and Control, Vol. 4, Inst. of Electrical and
Electronics Engineers, New York, 1998, pp. 4573 – 4577.
15
Al-Hiddabi, S. A., Shen, J., and McClamroch, N. H., “A Study of Flight
Maneuvers for the PVTOL Aircraft Model,” Proceedings of the 1999 Ameri-
can Control Conference, Vol. 4, Inst. of Electrical and Electronics Engineers,
Fig. 7 Control responses: feedback plus feedforward control. New York, 1999, pp. 2727 – 2731.
32 AL-HIDDABI AND M C CLAMROCH

16
Al-Hiddabi, S. A., and McClamroch, N. H., “Study of Longitudinal Vehicles Using Non-Linear Control,” Ph.D. Dissertation, Dept. of Aerospace
Flight Maneuvers for the CTOL Aircraft Model,” Proceedings of the 1999 Engineering, Univ. of Michigan, Ann Arbor, MI, April 2000.
20
Inst. of Electrical and Electronics Engineers International Conference on McClamroch, N. H., and Al-Hiddabi, S., “A Decomposition Based
Control Applications, Vol. 2, Inst. of Electrical and Electronics Engineers, Control Design Approach to Output Tracking for Multivariable Non-
New York, 1999, pp. 1199 – 1204. linear Non-Minimum Phase Systems,” Inst. of Electrical and Electron-
17
Tomlin, C., Lygeros, J., Benvenuti, L., and Sastry, S., “Output Tracking ics Engineers Conference on Control Applications, Paper FP06, Sept.
for a Non-Minimum Phase Dynamic CTOL Aircraft Model,” Proceedings 1998.
21
of the 34th Inst. of Electrical and Electronics Engineers Conference on Al-Hiddabi, S. A., and McClamroch, N. H., “A Decomposition Ap-
Decision and Control, 1995, pp. 1867 – 1872. proach to Output Tracking for Multivariable Nonlinear Non-Minimum Phase
18
Ridgely, D. B., and McFarland, M. B., “Tailoring Theory to Practice in Systems,” American Control Conference, Inst. of Electrical and Electronics
Tactical Missile Control,” IEEE Control Systems Magazine, Vol. 19, No. 6, Engineers, New York, 1998, pp. 1128 – 1132.
22
Dec. 1999, pp. 49 – 55. McRuer, D., Ashkenas, I., and Graham, D., Aircraft Dynamics and
19
Al-Hiddabi, S. A., “Position Tracking and Path Following for Flight Automatic Control, Univ. Press Princeton, Princeton, NJ, 1973.

You might also like