Longitudinal Control of A Fixed Wing Uav
Longitudinal Control of A Fixed Wing Uav
Figure 3: Body clamped frame (colour) and wind 2.2 External strengths and torques
frame (grey)
The relative vehicle’s forward airspeed Va exerts an
2.1 Equations of motion in the body frame aerodynamic strength due to the variance of pressure
is applied to obtain those strengths in the body frame: Finally, the craft weight in the earth frame responds to
0
𝐹𝑎𝑋 𝐅𝒘𝐄 = [ 0 ] (12)
𝐅𝑎 = 𝐑 B←W
𝐅𝑎W = [𝐹𝑎𝑌 ] ( 7) −𝑚 𝑔
𝐹𝑎𝑍
where m is the mass of the aircraft and g is the gravity.
The application point of 𝐅𝑎 can slightly change Then, this force is conveniently rotated to the body
depending on the attack and sweep angles. In frame giving
order to simplify the problem, the application point is
−𝑚 𝑔 𝑠𝑖𝑛𝜃
considered fixed and roll (L), pitch (M) and yaw (N)
moments 𝐅𝒘 = [ 𝑠𝑖𝑛𝜙 𝑐𝑜𝑠𝜃 ]
𝑔 (13)
𝑔 𝑐𝑜𝑠𝜙 𝑐𝑜𝑠𝜃
𝐿 −𝑏 𝐶𝑙
𝐌𝒂 = [𝑀] = 12𝜌𝑉𝑎2 𝐴 [ 𝑐 𝐶𝑚 ] (8) 2.3 Non-linear model
𝑁 −𝑏 𝐶𝑛
Substituting external forces and moments (Section
are added to correct this assumption; b and c are the 2.2) in generic forces and moments
wing span and chord, respectively; Table 1 details Fx , Fy , Fz , M x , M y , M z in (1) and (2), and
their values for this work prototype. 𝐶𝑙 , 𝐶𝑚 , 𝐶𝑛 are rearranging, it yields the dynamic non-linear model of
aerodynamic coefficients in each axis. They depend motion in the body frame:
on the attack angle (), the flap deflection ( E , A )
2
𝑘𝑡 (𝑤𝑗 ) 𝐹𝑎𝑋
and the angular velocities [ p, q, r ]T . Translational (5) −𝑔 𝑠𝑖𝑛𝜃 + − + 𝑣𝑟 − 𝑞𝑤 = 𝑢̇
𝑚 𝑚
and rotational (8) aerodynamic coefficients have been 𝐹𝑎𝑌
calculated following the equations in [3]. 𝑔 𝑠𝑖𝑛𝜙 𝑐𝑜𝑠𝜃 + + 𝑝𝑤 − 𝑟𝑢 = 𝑣̇
𝑚
𝐹𝑎𝑍
𝑔𝑐𝑜𝑠𝜙 𝑐𝑜𝑠𝜃 − + 𝑢𝑞 − 𝑣𝑝 = 𝑤̇
A tail propeller rotates at j, which provides a thrust 2 1
𝑚
𝐼𝑗𝑋 𝜔̇𝑗 𝑘𝑑 (𝑤𝑗 ) 𝜌𝑉 2 𝑆𝑐𝑙 𝑏 (𝐼𝑥𝑥 −𝐼𝑧𝑧 )𝑞𝑟 (14)
force along the X-body axis + − 2
− = 𝑝̇
𝐼𝑥𝑥 𝐼𝑥𝑥 𝐼𝑥𝑥 𝐼𝑥𝑥
1
𝐼𝑗𝑋 𝜔𝑗 𝑟 𝜌𝑉 2 𝑆𝑐𝑚 𝑐
T j = k t ( j )2 (9) +2 −
(𝐼𝑧𝑧 −𝐼𝑥𝑥 )𝑝𝑟
= 𝑞̇
𝐼𝑦𝑦 𝐼𝑦𝑦 𝐼𝑦𝑦
1
−𝐼𝑗𝑋 𝜔𝑗 𝑞 𝜌𝑉 2 𝑆𝑐𝑛 𝑏 (𝐼𝑥𝑥 −𝐼𝑦𝑦 )𝑝𝑞
to get the plane sustentation force. However, the 2
{ − − = 𝑟̇
𝐼𝑧𝑧 𝐼𝑧𝑧 𝐼𝑧𝑧
friction between the propeller and the air also causes a
parasitical drag moment around the X-body axis
The linear velocities [u, v, w]T can be transferred to the
earth frame by multiplying them by matrix (see [5])
j = k d ( j )2 , (10)
𝐑E←B = 𝐑E←B
𝑥 ∙ 𝐑E←B
𝑦 ∙ 𝐑E←B
𝑧 , (15)
which hampers the plane controllability. Thus, it is
worth investing time to find the best motor-propeller And after integration, it yields absolute position [x, y
combination. For this work prototype, we have opted z]T. Expression (15) uses Euler angles that can be
for a motor Racestar BR2205, 2300Kv, with a 3-blade calculated integrating
𝛼(𝑠) −10.95 𝑠3 −2964 𝑠2 −569.6 𝑠−334.3
= 𝑠4 +30.37𝑠3 +3987𝑠2 +787.8 𝑠+658.7 (20)
𝜙̇ 1 𝑠𝑖𝑛 𝜙 𝑡𝑎𝑛𝜃 𝑐𝑜𝑠 𝜙 𝑡𝑎𝑛𝜃 𝑝̇ 𝛿𝐸 (𝑠)
[ 𝜃̇ ] = [0 𝑐𝑜𝑠 𝜙 − 𝑠𝑖𝑛 𝜙 ] ∙ [𝑞̇ ] (16)
are of interest in the longitudinal control strategies.
𝜓̇ 0 𝑠𝑖𝑛 𝜙 𝑠𝑒𝑐 𝜃 𝑐𝑜𝑠 𝜙 𝑠𝑒𝑐𝜃 𝑟
Only the strengths in X and Z axes, and the moments Figure 4 depicts the pitch control architecture. Block
in Y axis will be studied, since they are the only ones a(s) represents the actuator dynamic, which is here
deemed to intervene in longitudinal stability. With the discarded (a(s)=1) in comparison with the rigid solid
coefficients obtained following [7], it yields the dynamics (s)/E(s). The pure derivative in the inner
longitudinal linear model: loop is actually a mathematical resource, since q is the
measurable variable in practice. Thus, gain Kq is the
𝑋𝑢 + 𝑋𝑇𝑈 𝑋𝑎 0 −𝑔 𝑋𝛿𝐸 controller in the feedback path of the inner loop. The
𝑢̇ 𝑍𝑞 + 𝑈0
𝑢
𝑍𝑢 𝑍𝛼 𝑍 𝛿𝐸
𝛼̇ 0 𝛼 outer loop provides the feedback controller C(s) in
( )= 𝑈0 𝑈0 𝑈0 (𝑞 ) + 𝑈0 𝛿𝐸
𝑞̇ the direct path. The control design process is
𝑀𝑢 + 𝑀𝑇𝑈 𝑀𝛼 + 𝑀𝑇𝛼 𝑀𝑞 0 𝑀𝛿𝐸
𝜃̇ 𝜃
performed from the inner to the outer loop, as it is
( 0 0 1 0) ( 0 )
(17) following detailed.
is obtained for the fixed wind prototype in this work. Figure 4: Pitch control architecture
Accordingly, the following input-output transfer
functions From a pure mathematical point of view the
diferenciator in the inner loop mitigates the under-
𝜃(𝑠) −2985 𝑠2 −18820 𝑠−3487
= (19) damping (0.244) of dominant poles in (s)/E(s) of
𝛿𝐸 (𝑠) 𝑠4 +30.37𝑠3 +3987𝑠2 +787.8 𝑠+658.7
(19). Figure 5 depicts this effect in the frequency
domain response of /E. Then, Kq is tuned to achieve
a suitable control bandwidth BW; acceptable values
are between 1 and 10 rad/s. Finally, a value of which achieves a PM of 90º at gc of 9.78 rad/s, as
Figure 7 depicts. Finally, the closed-loop frequency
𝐾𝑞 = −0.25 (21) response /c reaches -3dB above BW=5.5 rad/s.
Figure 5: Open-loop frequency response /E The altitude control consists of another feedback
control loop above the pitch control structure /c of
Figure 4, as Figure 8 shows. C h (s) is the feedback
controller to be designed. The path angle
(t ) (t ) (t ) (23)
h U 0 sin U 0 , (24)
Regarding the outer loop design, a proportional- Figure 8: Altitude control architecture
integral (PI) controller is attempted: first, an integrator Considering (23) (19) and (20), it is obtained
to remove the position error and later on a zero to
mitigate the integrator effect over medium frequencies (s) -0.003667( s + 39.77)(s - 41.91)(s + 0.1727)
guaranteeing enough phase margin (PM) -higher than = ,(25)
(s) (s + 6.115)(s + 0.191)
40º-. The PI controller gain modulates the gain cross
over frequency gc (values between 1 and 10 rad/s are
acceptable). Negative control gain is necessary since which can be approximated by
/c has inverse gain as phase plot reveals in Figure 6.
(s) 5.4189
The final controller at the outer loop is (26)
(s) s 6.115
(1 + 5s)
C (s) = -0.632
s (22)
in order to simplify the design process. Finally, h/c with the symmetric and asymmetric flap deflection as
presents the frequency response in Figure 9. control inputs, and the three Euler Angles and altitude
as controlled outputs. Using this block, the
A PI controller cannot achieve acceptable PM (above aforementioned control loops (Sections 3.1 and 3.2)
45º) for good stability and high enough cross over- have been also implemented in the script. Besides,
frequencies (1-10 rad/s) for a good performance. yaw must be controlled to zero, using a similar control
However, the final controller structure (Figure 11) as in the height control, let us
note as it includes inner roll control loops, similar to
0.05 (1 s / 0.9)( s 1) the pitch control architecture.
Ch ( s) (27)
s (1 s / 2.4)
A longitudinal stability model has been used to design [3] David K. Schmidt. (2012) “Modern Flight
feedback control loops of a cascade structure. Dynamics”, McGraw-Hill International Edition.
Frequency domain techniques were used to design
PID type controllers. An inner feedback loop [4] Guidelines for XFLR5 V0.03. (2009) “XFLR5
controlled the pitch angle by conveniently acting on Analysis of foils and wings operating at low
the flap deflection. Then, an outer loop allowed Reynolds numbers”.
tracking the desired altitude.
[5] R.Rico, P. Maisterra, M. Gil-Martínez, J. Rico-
Achieving this controlled model is the start of a way Azagra, S. Nájera (2015). “Identificación
for improvement and allows us to contribute to the experimental de los parámetros de un
creation of navigation systems, laying the foundations cuatrirrotor”. In XXXVI Jornadas de
of new work lines. Automática.
The development of the model and its control is the [6] Smetana,Frederick O. Delbert C. Summery and
first step to design optimized control strategies and to W. Donlad Johnson (1972), “Riding and
explore new possibilities in the field. Handling Qualities of light Aircraft-A Review
and Analysis”. National aeronautics and space
administration. Washington D.C