Spatial trajectory control of aircraft is an important area of research. Feedback linearization1 and input-output map inversion2 of nonlinear dynamical systems have played key role in developing flight control systems.1,3–7 But these two design techniques require precise knowledge of model parameters. Researchers have developed robust dynamic inversion methods for flight control.8–10 For nonlinear uncertain systems, sliding mode control (SMC) systems were proposed.11,12 Several researchers have designed SMC systems for maneuvering aircraft.13–15 The SMC laws include switching functions (relays) for suppressing the effect of unknown disturbance inputs and uncertain parameters. But the discontinuity in the control input can cause undesirable control chattering. Subsequently, super-twisting (STW) control systems were developed.12 The STW control laws are continuous unlike the SMC laws. STW control systems have been designed for rapid large roll-coupled maneuvers of a swept wing fighter aircraft.16–18 In these articles, two sets of output variables (i) (roll angle
, angle of attack
, sideslip angle
) and (ii) (
, pitch angle
,
) have been selected for the independent control of outputs by using aileron, elevator, and rudder.
Adaptive control systems are widely used for the control of models including unknown constant parameters.19–20 Several authors have developed adaptive control laws for the flight control.21–32 These adaptive systems use parameter estimators to obtain the estimates of the unknown parameters for control law synthesis. Of course, convergence of parameter error is not essential for trajectory tracking. Also, a L1 adaptive control law has been proposed.33 In a recent paper,34 a novel composite adaptive flight control system has been designed for roll-coupled meneuvers of aircraft. Interestingly, the closed-loop system of ([34]) has achieved trajectory regulation and aircraft parameter estimation.
Research has been also done for the spatial trajectory control of different models of aircraft.35–38 A singular perturbation-based nonlinear control law for 3-D spatial trajectory tracking has been developed.35 Essentially this design method exploits the two time-scale property of the slow outer loop and fast inner loop. The trajectory control of a VTOL transition aircraft and a generic hypersonic vehicle has been presented in Refs.37–38 However, in these articles for spatial trajectory control, it has been assumed that the dynamical models are perfectly known. Here interest is in the spatial trajectory control of F/A-18 nonlinear model, which is imprecisely known. Earlier based on SMC and adaptive control techniques, control systems for the 3-D spatial trajectory control have been designed for F/A-18 model.39,40 For simplicity in design, the complete closed-loop control system was split into an outer loop controller and an inner loop controller. The outer loop controllers of ([39, 40]) are based on SMC technique, but the inner loops have distinct adaptive control laws. The computational burden of adaptive systems increases with the number of unknown model parameters. Certainly, it is desirable to explore the applicability of other robust design methods.
In this paper, robust 3-D spatial trajectory control of the F/A-18 model considered in Refs.39,40 is considered. The contribution of this paper is two-fold. First, similar to Refs.,39,40 a sliding mode control law is designed for the spatial trajectory (x, y, z) and sideslip angle control using angular velocity vector (roll rate p, pitch rate q, and yaw rate r) treated as virtual control input
and the derivative of the forward thrust Tx. The choice of as the fourth component of the controlled output vector is to keep it small during maneuver for limiting any adverse effect of the aerodynamic load. Second, an inner loop control system is formed by (i) a geometric homogeneity-based finite-time control law designed for a nominal model F/A-18 without uncertainty and (ii) a super-twisting (STW) control law for robustification in the presence of model parameter uncertainty. It is should be noted that the homogeneity-based control law and STW law for the inner loop control are continuous functions of time. The inner loop composite control system controls the actual aircraft roll, pitch, and yaw angular velocity vector
of the aircraft using aileron, elevator, and rudder control surfaces. The goal is to achieve convergence of the error
to zero in a finite time. Therefore, the combined control system (formed by the outer loop SMC law and the finite-time inner loop control law) accomplishes asymptotic 3-D spatial reference trajectory tracking. By the Lyapunov analysis, stability of the closed-loop system is examined. Simulation results for 1800 climbing turn and helical path following are presented, which confirm accurate trajectory tracking performance in spite of large parametric uncertainties.
Aircraft model and control problem
Often equations of motion of aircraft are represented in different sets of coordinates. The coordinate systems of interest are: an inertial ground axes system (Sg) fixed on (nonrotating) Earth; the local horizontal system (Sh), a translation of Sg, body fixed coordinate frame (Sb) fixed at the center of gravity of the aircraft; the wind axes system (Sw) (obtained by three successive rotations of heading angle (χ), flight path angle (
), and velocity roll angle (<math xmlns='http://www.w3.org/1998/Math/MathML'>
<semantics>
<mi>μ</mi>
<annotation encoding='MathType-MTEF'>MathType@MTEF@5@5@+=
feaagKart1ev2aqatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn
hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr
4rNCHbGeaGqk0=grViea0dXdh9vqqj=hEeeu0xXdbba9frFj0=OqFf
ea0dXdd9vqaq=JfrVkFHe9pgea0dXdar=Jb9hs0dXdbPYxe9vr0=vr
0=vqpWqaaeaabiGaciaacaqabeaadaqaaqaaaOqaaabaaaaaaaaape
GaeqiVd0gaaa@37E6@
</annotation>
</semantics>
</math>
)); and the body fixed coordinate system Sb obtained from Sw by rotation (-
) (
is the sideslip angle) and then a rotation (angle of attack). Of course, Sb is also obtained from Sh by three successive rotations of yaw angle, pitch angle
, and roll angle
. (Readers may refer to Refs.41,42 for the rotation matrices relating the coordinate frames.)
We consider here the force equations in Sw and moment equations in Sb. For a complete derivation, readers may refer to. ([41,42]) The inertial position coordinate vector of the aircraft is
(superscript T denotes matrix transposition) and define
. The force equations are described by
(1)
(2)
where denotes equality by definition; m is the mass; g0 is the gravitational acceleration; V is the velocity of aircraft; Tx is the thrust aligned with the x -axis of Sb; and L, D and Q are the lift, drag, and side forces, respectively, expressed in Sw, given by
(3)
where
and
are the perturbations from the trim values, and Sr is the reference area. The set of equations which describe
, and the angular velocity
in Sb are
(4)
(5)
where
is the vector of control surface deflections; V0 is the velocity at trim; and
and
denote the aerodynamic derivatives computed at the trim condition. B and are the reference lateral and longitudinal lengths, respectively; Ix, Iy, and Iz are the principal moments of inertia; and
,
, and
. The factor
in the rotational motion has been introduced because these parameters are proportional to the square of velocity. The parameters
,
, etc., are similarly computed at the trim condition. It is assumed that the values of aerodynamic derivatives are not known.
The twelve first-order differential equations given in equations (1) - (4) describe the motion of the aircraft, and
is the minimal set of state variables. In fact
, and
are functions of the components of X. Of course, the pitch and roll angles also satisfy
(6)
Associated with the system (4), consider the controlled output vector
(7)
Here
is included in wc, because it is desired to keep the sideslip small during maneuver. Suppose that a smooth reference trajectory
is given. We are interested in deriving a control law so that the controlled output
asymptotically tracks prescribed reference trajectory
in spite of uncertainties in the aircraft model. For simplicity the design will be done in two steps. First, an outer loop control system will be designed for the control of Wc. Then an inner loop control law will be derived to achieve convergence of the actual angular velocity w to wv. The combined control law will accomplish spatial trajectory control.
Sliding mode outer loop control system
Now an outer-loop control system is designed for the trajectory control of
using inversion algorithm.2 This requires successive differentiation of the controlled output vector
till the angular velocity ω∈R^3(treated as virtual control input) and actual input Tx appear. It is seen that X1 is a function of Tx, but it does not involve the angular velocity vector
. In the third derivative of
, w as well as Tx appear. Therefore, now the forward thrust Tx is treated as a state variable, and trajectory control of the output
by the input
is considered. Later the inner-loop control system will be designed for the control of actual
of the aircraft using control surfaces (aileron, elevator, and rudder) so that w converges to the computed virtual w (termed wv) for the outer-loop control.#
Lift, drag, and side forces are functions of the control surface deflections. However, the forces contributed by the control surfaces are small, because these are principally moment producing devices. As such, for the purpose of controller design, these small forces are neglected, but are introduced later in the model for simulation. Then using Eqs. (1) - (5), the differential equation for xp takes the form
(8)
where fp and Bp are appropriate vector function and matrix, respectively. Let
. Define the Lie derivatives of
as
(9)
Then one can easily show that
, for j = 0,1 (10)
and
for
,
.
Therefore, it follows that
has relative degree three. The relative degree of
is one since w appears in the first derivative of
.
Differentiating wc gives
(11)
For a robust control design using the VSC theory, one first selects an appropriate sliding surface on which the trajectory has desirable property. We choose here the sliding surface
, where
(12)
where
=
is the position error vector
, and
. These gains are chosen so that
yields exponentially stable responses for
and
. Integral feedback in Eq. (12) provides additional flexibility for a robust design.
For sliding mode control system design, one differentiates S1 to obtain
(13)
where t in Eq.(13) denotes the dependence of the functions on
and its derivatives. Let
and
, where
and
are the nominal functions and
and
denote the uncertain portions.
It has been shown in ([39]) that the determinant of the input matrix
is nonzero if
and
(14)
For the derivation of control law, invertibility of Bs in the region of interest is essential. It has been found in 39 that in a neighborhood
of the trim conditions Eq. (14) is satisfied. For trajectory control, maneuver through the region in which singularity lies must be avoided by a proper trajectory planning.
For VSC design, consider a Lyapunov function
(15)
The derivative of W1 along the solution of Eq. (13) is given by
(16)
Assumption 1: The uncertain functions satisfy for
,
(17)
where
denotes the infinity-norm of a vector,
And
are the induced 2 - and 1- norms of matrix, respectively. Here subscript ij denotes the ijth element of matrix. The second inequality of Eq. (17) essentially restricts the uncertainty in the matrix Bs.
The design of control law is based on a back stepping design technique. Consider a change of coordinate for the angular velocity vector w as
(18)
where
is a stabilizing signal, yet to be determined. Then
can be expressed as
(19)
where
.
Substituting Eq. (19) in Eq. (16) yields
(20)
where
In view of Eq. (20), one selects a VSC law of the form
(21)
where the gain K1 is a positive real number yet to be determined,
and
is the sign function. Substituting Eq. (21) in Eq.(20) gives
(22)
where Hölder inequality for any two vectors
and
,
(23)
Has been used. Using the bounds given in Assumption 1, one obtains from Eq. (22)
(24)
In view of Eq. (24), the gain K1 is chosen as
(25)
Using Eq. (25) in Eq. (24) yields
(26)
According to Eq. (26), for the choice of gain K1 given in Eq. (25),
if
and
. In such a case, s1 tends to zero which, in view of Eq. (12), implies that as . However, is not a control vector.
Inner loop control system
In the next section, the design of the inner loop control system is considered to force
to zero. The inner loop control system includes (i) a control subsystem based on geometric homogeneity and (ii) a super-twisting control subsystem for robustification.
Geometric homogeneity-base inner-loop control subsystem
The rotational motion of aircraft from Eq. (5) is rewritten as
(27)
where
. Here interest is in the design
of to force
to zero. The derivative <math xmlns='http://www.w3.org/1998/Math/MathML'>
<semantics>
<mover accent='true'>
<mi>ω</mi>
<mo>˜</mo>
</mover>
<annotation encoding='MathType-MTEF'>MathType@MTEF@5@5@+=
feaagKart1ev2aqatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn
hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr
4rNCHbGeaGqk0=grViea0dXdh9vqqj=hEeeu0xXdbba9frFj0=OqFf
ea0dXdd9vqaq=JfrVkFHe9pgea0dXdar=Jb9hs0dXdbPYxe9vr0=vr
0=vqpWqaaeaabiGaciaacaqabeaadaqaaqaaaOqaaabaaaaaaaaape
GafqyYdC3dayaaiaaaaa@381B@
</annotation>
</semantics>
</math>
of satisfies
(28)
where
can be obtained by differentiating
and substituting various derivatives of the state variables. To this end
, and
are decomposed as
(29)
where
and
are the nominal values, and
and
are unknown parts. It is assumed that
. Then, Eq. (28) can be written as
(30)
where
is a known part and
is an unknown function. In view of Eq. (30), the control input is chosen as
(31)
where uf is a finite-time stabilizing signal for the system with
, and ur is a signal for robustification. Substituting Eq. (31) in Eq. (30) gives
(32)
Define
and
. The homogeneity-based control input uf is selected as43
(33)
The feedback gains li are chosen such that the polynomial
(34)
is Hurwitz. The exponents
are chosen to satisfy
. Using Eq. (33) in Eq. (32), the derivative of y takes the form:
(35)
where
are positive constants and
. For
and
, the system (35) is finite-time stable; that is, its trajectory y(t) converges to the origin y=0 in a finite time.
Super-Twisting (STW) inner loop control subsystem
Now, the design of a robustifying control signal ur is considered for the system Eq. (35) when
. Define the new variables
and
, satisfying
(36)
Then differentiating s2 gives
(37)
It is of interest to design ur such that the trajectory of the system reaches the sliding surface s2 = 0 in a finite time, and subsequently remains confined to it. There exists a variety of control signals that can force the system in the sliding mode. Here, an STW control law is selected of the form:12,44
(38)
where p1 and p2 are appropriate positive constants. Substituting Eq. (38) in (37) gives
(39)
Define
. Then Eq. (39) gives
(40)
where
. It is assumed that the trajectories evolve in a region
of the state space in which the uncertain function
satisfies
(41)
where Lp is a sufficiently large positive constant. The STW control law achieves finite-time convergence of s2 to zero. Therefore, (37) implies that
becomes zero after a finite time. Then (32) simplifies to
(42)
which is finite-time stable. However, it should be noted that the SMC law designed for the outer loop accomplishes asymptotic convergence of tracking error
because the sliding surface s1=0 in (12) is linear.
Remark 1: We note that
used in Eq. (28) is a complex function of state variables. As such a practical way to obtain an approximate
is to pass
through a filter of the form
(43)
where
. Then following the similar steps of this section, inner loops can be designed. Of course, higher-order accurate differentiator can be designed following Ref. [12] for synthesis.
Simulation results
This section presents results of simulation for the flight path control of a simplified FA-18 model (see ([39]) for model parameters). The complete closed-loop system including the outer loop SMC law and inner loop robust finite-time control law is simulated. Two flight conditions, (H=30,000 (ft), M=0.7) (FC1) and (H=25,000 (ft), M=0.8) (FC2), are considered for simulation, where H is the altitude and M is the Mach number. Although, derivation of controller is based on a simplified aircraft model, neglected control forces are introduced in the model for simulation. The aerodynamic parameters of Ref.39 are used for simulation.
The feedback gains are
in Eq. (12), K1,K2=(1.5, 1.5) in Eq. (21),
= (1, 1.2, 1.3, 6/7,6/7,6/7) in Eq. (35), Lp = 0.2 in Eq. (38), and
in Eq. (43). For the purpose of illustration, reference trajectory
is generated by third order filters are
(44)
where V*, X*, and
are the command inputs. The poles of these three filters are at -0.2. The reference inertial position trajectory
, and its derivatives
are constructed using
and its derivatives generated by the filters, and the kinematic Eq. (1). Two kinds of maneuvers are considered. These are a 1800 climbing turn and climbing a helical path. For robustness analysis, control system is designed using off-nominal values of the aerodynamic derivatives. For simulation, the sign functions in the stabilizing control laws equations (35) and (39) are replaced by the saturation function (sat(.)), where sat
if
, and sat (t) = sign (t), if
. For simulation
=0.001 has been used. For
, Eq. (43) is used where is chosen as 0.005.
A1. Closed-loop control at FC1: climbing path and helical path
The complete closed-loop system using sliding mode outer loop and robust finite-time inner loop control systems is simulated. For the outer loop design, nominal values of parameters are assumed to be 70% lower than the actual values. In order to avoid control chattering a continuous approximation of sgn function by saturation function is used for simulation.
First simulation is done for FC1. The initial conditions are
[ft/s],
. Smooth velocity, heading angle, and flight path angle trajectories are generated by the third-order filters for 180degree turn using the reference input
for
and,
for
. For helical path control, reference trajectory is generated using heading angle turn rate of 6 [deg/s],
,
and
for . These signals are used to construct the reference position trajectories. The reference sideslip angle is zero. Simulated responses for 1800 turn are shown in Figure 1 and Figure 2. Those for helical path following are shown in Figure. 3 and Figure 4. In the figures,
denotes the position tracking error
. We observe smooth trajectory following in these figures.
Figure 1 Climbing 1800 turn at FC1: Top to bottom (left column), (x, y, z), V, (p, q, r), Top to Bottom (right column)
,<math display='block' xmlns='http://www.w3.org/1998/Math/MathML'>
<semantics>
<mrow>
<mo stretchy='false'>(</mo><mi>μ</mi><mo>,</mo><mi>α</mi><mo stretchy='false'>)</mo></mrow>
<annotation encoding='MathType-MTEF'>MathType@MTEF@5@5@+=
feaagKart1ev2aaatCvAUfeBSjuyZL2yd9gzLbvyNv2CaerbuLwBLn
hiov2DGi1BTfMBaeXatLxBI9gBaerbd9wDYLwzYbItLDharqqtubsr
4rNCHbGeaGqk0=grViea0dXdh9vqqj=hEeeu0xXdbba9frFj0=OqFf
ea0dXdd9vqaq=JfrVkFHe9pgea0dXdar=Jb9hs0dXdbPYxe9vr0=vr
0=vqpWqaaeaabiGaciaacaqabeaadaqaaqaaaOqaaKqzGeGaaiikai
abeY7aTjaacYcacqaHXoqycaGGPaaaaa@3BFC@
</annotation>
</semantics>
</math>
, tracking error .
Figure 2 Climbing 1800 turn at FC1: Top to bottom (left column)
, Top to bottom (right column),
, 3-D plot (x, y, Altitude).
Figure 3 Helical path control at FC1: Top to bottom (left column), (x, y, z), V, (p, q, r), Top to Bottom (right column)
,
, tracking error
.
Figure 4 Helical path control at FC1: Top to bottom (left column)
, Top to bottom (right column),
, 3-D plot (x, y, Altitude).
For 1800 turn, maximum tracking errors
, steady state tracking errors
[ft] as shown in Figure 1, maximum trust Tx(max) = 19,206[lb], maximum control deflections
= (3.8127, 1.9190, 6.2162)[deg], and steady state control deflections
= (0.0009, 0.0003, 0.0097)[deg] as shown in Figure 2 where
[sec]. For helical path following, maximum tracking errors
= (7.1885, 6.7945, 1.6778)[ft], steady state tracking errors
= (5.1728 3.5841 0.0004)[ft] as shown in Figure 3, maximum trust Tx(max) = 23,763[lb], maximum control deflections
= (2.5974, 1.3176, 7.0267)[deg], and steady state control deflections
= (0.5081, 0.2265, 6.1839)[deg] as shown in Figure 4. However we observe oscillatory x and y position tracking error for helical path tracking. This is apparently due to simplified inner loop design in which nominal function have been set to zero.
A2. Closed-loop control at FC2: climbing path and helical path
Flight condition FC2 is simulated, but the feedback gains of the outer and the inner loops designed for case A1 are retained. Simulated responses for 1800 turn are shown in Figure 5 and Figure 6. Those for helical path following are shown in Figure 7 and Figure 8. We also observe smooth trajectory following.
Figure 5 Climbing 1800 turn at FC1: Top to bottom (left column), (x, y, z), V, (p, q, r), Top to Bottom (right column)
,
, tracking error
.
Figure 6 Climbing 1800 turn at FC1: Top to bottom (left column)
, Top to bottom (right column),
, 3-D plot (x, y, Altitude).
Figure 7 Helical path control at FC2: Top to bottom (left column), (x, y, z), V, (p, q, r), Top to Bottom (right column)
,
, tracking error
.
Figure 8 Helical path control at FC2: Top to bottom (left column)
, Top to bottom (right column),
, 3-D plot (x, y, Altitude).
For 1800 turn, maximum tracking errors
= (6.9875, 7.2683, 2.52 22)[ft], steady state tracking errors
[ft] as shown in Figure 5, maximum trust Tx(max) = 16,847[lb], maximum control deflections
= ( 2.9820, 0.7925, 5.1556)[deg], and steady state control deflections
= (0.0189, 0.0020, 0.8759)[deg] as shown in Figure 6 where tf = 80 [sec]. For helical path following, maximum tracking errors
= (11.3897, 10.9421, 2.2733)[ft], steady state tracking errors
= (8.0318, 6.4432, 0.0006)[ft] as shown in Figure 7, maximum trust Tx(max) = 20,432[lb], maximum control deflections
= ( 2.1193, 0.5700, 6.1582)[deg], and steady state control deflections
= ( 0.4879, 0.0947, 5.7843)[deg] as shown in Figure 8. However we also observe oscillatory x and y position tracking error for helical path tracking.