Professional Documents
Culture Documents
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.
26
AL-HIDDABI AND M C CLAMROCH 27
zR D ¡ D sin °
0
C L cos °
0
C u x sin µ ¡ 1 (7)
µR D um (8)
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
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
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:
¡ ¯ ¢
@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
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)
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. ¡ ¢
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
¡ ¯ ¢
¡ ¢
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)
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.