Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
FPT
TPF
FPT
TPF
FPT
I. Introduction
powered paraglider (PPG), shown in Fig. 1, can be a useful unmanned aerial vehicle (UAV) for land
observation, surveillance, space vehicle retrieval, etc. Although it is subject to wind, its light and foldable wing
or canopy makes it portable equipment for both civil and military uses. Actually PPG-type UAVs have been
developed and sold on a commercial basis. Such a UAV needs an autonomous/automatic flight control system, and
in order to design a control system we need a dynamic model of a PPG, unless we take an empirical design approach,
which is often employed for a black-box plant. However, a PPG is not a totally unknown plant. In fact, many papers
have been reported on modeling of PPG or paraglider (PG) nonlinear/linear dynamics.1-10 The authors also proposed
a nonlinear dynamic model with eight degrees of freedom, where all the internal forces between the canopy and the
suspended payload are analytically eliminated to obtain a model in the form of state equation.11 Its validity was
demonstrated through numerical simulation and comparison of the results with flight experiment data of a manned
paraglider.
In this paper, first we derive a linear model from the nonlinear model by analytical first-order approximation of
Taylor series expansion as well as numerical partial differential. Since the original nonlinear model is described with
the state variables of the canopy, the linear model also explicitly expresses motion of the canopy. However,
measurement sensors such as accelerometers and gyros are mounted on the payload; hence, it would be more
convenient in dynamics analysis and/or control system design, if the model is expressed by the state variables of the
payload. This motivated us to derive a linear transformation matrix between the canopy states and the payload states.
With the state transformation, we can obtain a payload-state linear model from a canopy one, and vice versa. Then,
we consider designing a flight control system for the PPG using the linear model. Although a number of studies on
PPG or PG flight control have been reported, many of them employ complicated control methods such as model
predictive control12 or inversely consider just open-loop control.13, 14 In our study, we employed PID (proportionalintegral-derivative) control, which is most commonly used in industry. The authors are proposing a new design
method of a PID controller15 based on integral-type optimal servomechanism (IOS), which is a derivative of the
linear quadratic regulator or LQR. In the design method, first we reduce a given linear plant model to a second-order
P
PT
2
TP
PT
TP
PT
Copyright 2009 by the American Institute of Aeronautics and Astronautics, Inc. All rights reserved.
system so that -gap16 between the original plant and the reduced plant becomes as small as possible. The plant
parameters are determined by parameter-space search, since the number of parameters is just two or three. Of course,
the three-term controller cannot always stabilize any plant; however, when stabilizable, it usually provides a set of
control gains with good control performance and substantial stability margins, which would be attributed to the
properties of the LQR. Moreover, the control gains can be adjusted through selection of weighting matrices for
trade-off between control performance and robust stability. In application to a PPG, three PID controllers are
designed to control the altitude by thrust, the forward speed by collective brake deflection of the canopy, and the
heading angle by differential brake deflection. Time responses to appropriate reference outputs are computed as well
as stability margins for each control loop, where other loops are closed.
This paper is organized as follows. In the next section, we describe an outline of the linear model and
transformation between the canopy-state model and the payload-state model. Then we present the design method of
a PID controller based on the IOS and the -gap metric. In Sections IV and V, numerical analysis and simulation
results are presented, followed by summary and conclusions in Section VI.
P
Canopy
Air-Intake
Suspension
lines
Propelling unit
Control line
Payload
Figure 1. Configuration of PPG
2
American Institute of Aeronautics and Astronautics
PB
PB
PB
where f(xc) 121 and g(xc) 123 are nonlinear functions of xc.
Let the equilibrium state and input vectors be x* and u*, i.e.,
f(xc*) + g(xc*)u* = 0.
(2)
Under the assumption of symmetry of the PPG with respect to the XZ-plane, the non-trivial equations in Eq. (2) are
four equations corresponding to forward and downward force trim and pitching moment trim of the canopy and the
payload. Defining small perturbations of the state and control variables around the equilibrium point (xc*, u*) as xc
= xc xc* and u = u u*, and applying the first-order approximation of Taylor series expansion, we obtain the
linearized state equation,
(3)
x& c = Ac x c + Bc u ,
B
PB
PB
PB
PB
where Ac1212 is a constant matrix given by partial differentiation of f(xc) + g(xc)u with respect to xc at the trim
point (xc*, u*), and Bc123 is given by g(xc*). We have analytically derived the linear state equation, although we
have no space to show details here. Since the velocity of the PPG is small and its angle of attack is relatively large in
trim flight, we approximate small perturbation of the angle of attack by
(cos c* ) 2
(4)
(wc tan c* uc ) ,
c =
u c*
where c = tan1(wc/uc). This approximation provides a better correspondence of the system matrix Ac between the
analytical linearization and the numerical one.
Appropriately rearranging the elements of the state vector makes the matrices Ac and Bc block-diagonal, so that
Eq. (3) is separated into two state equations, i.e., for the longitudinal motion we have
(5)
x& clong = Aclong xclong + Bclong ulong
B
PB
PB
(6)
where xclong = [uc wc qc c qpc pc] , ulong = [Fbth e] , xclat = [vc pc rc c rpc pc c] and
ulat = r.
T
C. State Transformation
Since the canopy generates most of the aerodynamic forces and moments, using the canopy states makes the
derivation of the dynamic equation easier and straightforward. However, sensors such as accelerometers, gyros,
camera, etc. are mounted on the payload; hence, expressing the state equation in terms of the payload states, which
are defined below, would be more convenient for analysis and synthesis of a flight control system. Although we
could derive a nonlinear payload-state equation, we choose to derive a linear payload-state equation, considering
application of a linear control method.
The following relations hold between the canopy states and the payload states. First, the velocity of the payload
expressed in c is given by
(7)
Vpc = Vc + Kpc1c + Kpc2pc.
In Eq. (7), when we define lc (lp) to be the distance between Om and Oc (Op), Kpc1 and Kpc2 are defined, respectively,
as
B
3
American Institute of Aeronautics and Astronautics
l p cos pc + lc
0
= (l p cos pc + lc )
0
l p sin pc sin pc l p sin pc cos pc
K pc1
l p sin pc sin pc
l p sin pc cos pc
(8)
and
cos pc cos pc
= l p cos pc sin pc
sin pc
sin pc sin c
K pc 2
sin pc cos pc .
T
Defining the velocity of the payload expressed in p as Vp = [up vp wp] , we can also write Vpc as
Vpc = TpcVp
where Tcp is a coordinate transformation matrix from p to c and defined as
cos pc cos pc sin pc sin pc cos pc
sin pc
0
cos pc
Eliminating Vpc from Eqs. (7) and (10), we have the first relation:
Vc = TcpVp Kpc1c Kpc2pc.
Second, the relation between the angular velocities is given by
c = Tcpp Kpc3pc,
where p = [pp qp rp]T is the angular velocity vector of the payload in p, and Kpc3 is defined by
sin pc 0
K pc 3 = cos pc 0 .
0
1
B
(10)
(11)
(9)
(13)
(12)
(14)
Third, from the definition of Euler angles and relative attitude angles between the canopy and the payload, we have
the identical equation
TcI(c, c, c) =Tcp(pc, pc)TpI(p, p, p),
(15)
where c is the yaw angle of the canopy, and p, p, and p are the roll, pitch, and yaw angles of the payload,
respectively. TpI (TcI) is the coordinate transformation matrix from the inertial coordinates to p (c).
Thus, we have obtained three relations, which are given by Eqs. (12), (13), and (15). Applying the first-order
approximation of Taylor series expansion to the equations yields a linear relation between the canopy state vector
and the payload one as follows.
First, from Eq. (12) we have
(16)
Vc + Kpc1*c + Kpc2*pc = Tpc*Vp +Kpc4*[pc pc]T,
where the superscript * means that the functions and the variables are evaluated at the trim states, and Kpc4* is
defined as
*
sin( *p pc
)
0
(17)
*
*
* ,
K pc 4 = V p
0
cos( *p pc
)
*
cos( *p pc
)
0
*
1
*
*
where p = tan (wp /up ). Next, Eq. (13) is linearized as
(18)
c = Tpc*p Kpc3*pc.
Finally, from Eq. (15) the following linear equations are obtained:
(19)
p = c+pc
c
*
*
0
p
1 cos c sin c
(20)
.
pc
*
*
*
*
sin
cos
cos
cos
p
pc
pc
p
p
c
B
PB
PB
PB
PB
PB
PB
PB
PB
PB
PB
Adding c to the state vector xc, defining the payload state vector as xp = [VpT pT pcT pc pc p p p]T, and
combining Eqs. (16), (18), (19), and (20), we obtain the relation
xp = Txc,
(21)
where xp =xp xp* and T 1313 is a constant transformation matrix.
With Eq. (21), Eq. (3) is transformed into the equation expressed by the payload state as
B
PB
PB
4
American Institute of Aeronautics and Astronautics
PB
PB
x& p = Ap x p + B p u ,
(22)
where Ap = TAcT and Bp = TBc. As Eqs. (5) and (6) resulted from Eq. (3), Eq. (22) is rewritten into the
longitudinal state equation
(23)
x& plong = Aplong x plong + B plong ulong
B
(24)
where xplong = [up wp qp p qpc pc] and xplat = [vp pp rp p rpc pc p] . This means that the
state transformation matrix itself becomes block-diagonal by rearranging the state variables.
T
d 0 d1
n0
B
PB
d x& A
=
dt e C
0 x& B .
+
u&
0 e 0
(30)
(31)
(32)
(33)
Defining Kx = [KP KD] and KI = Ke, we can rewrite the control law as
u = K P y + K D y& + K I ed .
B
(34)
This is exactly the I-PD (proportional and derivative preceded integral) control law, which means that the PID gains
are determined at a time as optimal state feedback gains. Once the I-PD control law is obtained, it can be arbitrarily
converted to the PID, PI-D or generic 2-DOF form.18 Note that any of the controller forms has the same closed-loop
property such as stability. In practical use, the pure derivative of y is replaced with an approximate one s/(TDs+1),
where TD is an appropriate constant.
P
5
American Institute of Aeronautics and Astronautics
Specifically, we search plant parameters of GC(s) that minimize the -gap between GP(s) and GC(s). It is known that
if the -gap is small, closed-loop properties for the two plants are close to each other.19, 20 Reference 21 also uses this
method in conjunction with LMI to find a reduced-order plant for controller design. In our study, parameter-space
search is adopted, since the number of parameters is small.
Before giving the definition of -gap, let us define the following function
B
G P ( s ) GC ( s )
(G P ( s), GC ( s)) =
(35)
1 + G P ( s)G P ( s) 1 + GC ( s)GC ( s)
(36)
1+GC(j)GP(j) 0,
(37)
wno (1+GC(j)GP(j))+(GP(s)) (GC(s)) 0(GC(s)) = 0,
where (GP(s)) denotes the number of poles of GP(s) in the open right-half complex plane and 0(GC(s)) the number
of imaginary axis poles of GC(s). wno denotes the winding number valuated on the standard Nyquist contour
indented around any imaginary axis poles of GP(s) and GC(s). With the definitions, the -gap is defined as
(GP , GC )
if Eqs. (36) and (37) are satisfied.
(38)
(GP , GC ) =
otherwise.
1
From our design experience, we have found that d0 of GC(s) can be set to zero for GP(s) having integral element
1/s. This also reduces the number of parameters to be searched. Note that depending on GP(s), there exists no GC(s)
for which the -gap is small. In that case, we cannot design a PID controller that possesses good closed-loop
properties or even stability. However, this is natural, since the three-term controller cannot stabilize all plants.
B
6
American Institute of Aeronautics and Astronautics
relative pitching motion and the latter to the pitching motion of the canopy. Figure 5 shows time responses of the
yaw rate of the canopy computed using the payload-state model for pc(0) = 0.1 rad. We can also see from the
figure that the relative yaw rate has a faster, oscillatory mode, and that the canopy yaw rate has a slower, less
oscillatory mode. The former mode corresponds to the relative yawing motion and the latter to the Dutch-roll motion
of the canopy.
2
0
-2
canopy-state system
payload-state system
-4
-6
10
20
time, s
Figure 3. Time responses of the canopy pitch angle for pc(0) = 0.1
B
relative pitching
3.89
0.863
3.361.97i
canopy pitching
0.983
0.290
0.285 0.941i
first-order modes
121, 1.35, 0
relative yawing
5.03
0.0297
0.1505.03i
Dutch-roll
0.755
0.297
0.2240.721i
qc
qpc
2
0
-2
-4
0
10
20
time, s
Figure 4. Time responses of the canopy pitch rate for pc= 0.1 rad
30
20
10
0
-10
-20
-30
rc
rpc
10
20
time, s
Figure 5. Time responses of the canopy yaw rate for pc= 0.1 rad
B
7
American Institute of Aeronautics and Astronautics
10
5
0
-5
0
10
20
time, s
Figure 6. Time responses of the roll rate to step input, r = 0.1 rad
B
8
American Institute of Aeronautics and Astronautics
Stability margins are summarized in Table 2. The margins are computed by opening each closed-loop, while
other loops are closed. The controllers have large gain and phase margins. The margin of gain increase is for the
speed controller.
controller
altitude
speed
heading
u ( s ) = K P K D s + I e ( s ) .
s
(46)
y ref ( s) =
2
nref
2
s 2 + 2 ref nref s + nref
r.
(47)
B. Simulation
We conducted computer simulation, applying the controllers to the nonlinear model of the PPG. The reference
outputs are 0 m for the altitude variation, 8 m/s for the forward speed, and 90 deg for the heading angle. The initial
condition is the steady-state gliding, where the forward speed is 9.22 m/s and the heading angle is 0 deg. As seen
from the initial and the target outputs, this simulation considers the case where the PPG changes its flight from the
steady-state gliding to level flight with thrust, while turning to the right by 90 deg. Figures 7 through 11 show time
histories of the outputs. The altitude undergoes undershoot about 2.4 m, since the PPG is going down at the initial
time; however, it recovers to zero by increasing thrust to achieve level flight. Also, as is expected, the forward speed
is controlled to 8 m/s, and the heading angle is changed by 90 deg. Time histories of the control inputs are shown in
Figs. 12 and 13. Note that the brake deflection angles are saturated, since the neutral deflection angle is zero and the
inputs cannot take negative angle. In this design example, we have added the anti-reset windup compensator and it
really works. In fact, without it control performance considerably degrades as Fig. 14 shows. The thrust converges to
about 200 N, which is required to maintain level flight.
9
American Institute of Aeronautics and Astronautics
Speed, m/s
10
up
vp
wp
5
0
-5
10
20
time, s
30
40
50
30
20
10
0
-10
-20
pp
qp
rp
10
20
time, s
30
40
50
40
relative pitch rate, qpc
relative yaw rate, rpc
20
0
-20
-40
10
20
time, s
30
40
50
100
80
roll angle, p
pitch angle, p
yaw angle, p
reference for p
60
40
20
0
0
10
20
time, s
30
40
10
American Institute of Aeronautics and Astronautics
50
Altitude variation, m
0
altitude variation
reference output
-5
10
20
time, s
30
40
50
10
left deflection angle, L
right deflection angle, R
5
0
-5
10
20
time, s
30
40
50
Thrust, N
300
200
100
0
10
20
time, s
30
40
50
100
roll angle, p
pitch angle, p
yaw angle, p
reference for p
50
0
0
10
20
time, s
30
40
50
Figure 14. Time histories of the Euler angles without anti-reset windup compensation
11
American Institute of Aeronautics and Astronautics
VI. Conclusions
We have obtained a linear dynamic model of a PPG, which is analytically derived or numerically computed from
the nonlinear dynamic model. We have also derived the state transformation matrix between the canopy states and
the payload states. With the matrix we can obtain a linear model expressed by the payload states from the linear
model by the canopy states, and the payload-state linear model facilitates dynamical analysis and controller design,
since the measurement sensors and cameras are mounted on the payload. The design example of PID controllers and
the simulation results illustrate that the design method based on the integral-type optimal servomechanism and the gap metric actually works as an efficient design tool of a PID controller with good control performance and
adequate stability margin. A problem with PPG flight control is saturation of the brake deflection angles. We may
need to add an anti-reset windup compensator, in addition to carefully giving reference outputs.
Appendix
The coefficient matrices in the linear state equations, Eqs. (5) and (6), are as follows:
2.4840
2.8799 0.2382 0.61035
1.2966 10 3
0.53697 0.071012
0.23140 1.5516
4
1.1585
0.86154 0.12228 0.38697
8.2210 10
1.4230 10 3
0.02926
0.19233 0.98936 1.0546 0.38030 0.66983 ,
Aclong =
Bclong =
0
0
1
0
0
0
0
0.29554 1.4250
2.8436
1.0502
6.7271 15.844
1.2710 10 3
0
0
0
0
1
0
0
32.647
18.646
5.2030
4.8906
0.19269
1.1958
3.2798
5.8945 10 4 0.091265 0
2.2418
0.024676
0.0059881
4
9.7908 10
0.078414 0
1.1901
0.019645 0.062424 0.77299
20.311
529.09
0.64332
0 ,
152.59
122.48 2.5409 10 4 7.9074 10 3
Aclat =
0
0
1
0.060345
0
0
0
0 Bclat =
20.339
529.04
152.59
123.07
0.48119
0.31324
26.106 0
0
0
0
0
0
1
0
0
0
0
0
1.0018
0
0
0
0
Rearranging the state variables appropriately, we can also make the state transformation matrix diagonal; namely,
by the same transformation from Ac to block-diag(Along, Alat), we can transform T in Eq. (21) to a block-diagonal
matrix. Thus, we obtain the following state transformation matrices for the longitudinal states and the lateraldirectional states, respectively,
0.084212
6.8278
0 0.33200 1.6954
0.99645
0.084212 0.99645 0.54898 0
0
9.3928
0
0
1
0
1
0 and
Tlong =
0
0
0
1
0
1
0
0
0
0
1
0
0
0
0
0
0
1
0
0.027958 9.2167
1 6.8498 0.027958
0
0.99645
0.084212
0
0.084212
0
0 0.084212
0.99645
0
0.99645
0
Tlat = 0
0
0
0.99847
0
0.060252
0
0
0
0
1
0
0
0
0
0
1
0
0
0
0
0
.
084236
0
0
.
99674
12
American Institute of Aeronautics and Astronautics
0
0
0 ,
0
0
0
1
References
1
13
American Institute of Aeronautics and Astronautics