Small Scale Helicopter Analysis and Controller Design For Non-Aggressive Flights
Small Scale Helicopter Analysis and Controller Design For Non-Aggressive Flights
Non-Aggressive Flights
Carlos Castillo, Wendy Alvis, Mauricio Castillo-Effen, Kimon Valavanis, Wilfrido Moreno
Center for Robot Assisted Search and Rescue
Department of CSE and EE
University of South Florida
Tampa FL 33620
model for such types of helicopters, common to all ROLL, PITCH, YAW ANGLES AND HEIGHT
Magnitude (dB)
output of interest. Because the system was determined to be -50
Phase (deg)
OUTPUT
G c (s)G a (s)
(s) -180
OUTPUT 10
-1 0
10 10
1
10
2
10
3 4
10
δ
Figure 5: Bode plot for yaw frequency response
In order to verify the above approach, the closed loop
transfer functions were also derived using both equation(7) While the ability to simplify the calculations of the
and Mason’s rule. The results were compared for each of transfer functions using equation(7) may not always be the
the four closed loop transfer functions. The transfer case for all controls systems, it has been found to be
functions for height were found to be mathematically sufficient for determining the phase and gain margin with
identical using both methods. This was not the case for the this particular model. Further details can be found in [15].
roll, the pitch and the yaw transfer functions. It was found
that there were differences in the transfer functions for the
yaw, the height and the pitch. A bode plot was used to 6 Classical PID/PD Control Design
compare the frequency response of the transfer function Classical PID controllers are simple to tune if the
derived with Mason’s rule and the transfer function derived dynamics of the process to control can be modeled using a
using the simplification for roll, pitch and yaw. The first or a second order transfer function. When this is not
frequency response of the systems matched extremely well. the case, as with the helicopters, it is possible to tune their
Figure 3, Figure 4 and Figure 5 displays the bode plot for parameters manually. However if a model of the controlled
the pitch, roll and yaw transfer functions respectively. system is available then a more practical approach is to use
an optimization algorithm that automatically tests different
Bode Plot for Pitch
parameter values until it finds the set of parameters that
50
0
gives the best possible value for a certain performance
function (objective function or fitness function). In this
Magnitude (dB)
-50
-200
tuning parameters of PID controllers. As it was mentioned
-250
above, the diagonal dominance of the system was less than
90
0
MIMO Transfer Function one except for the height/collective which was close to one.
SISO Transfer Function
Based on these observations, it was decided that the
Phase (deg)
-90
0
The IAE is a performance criterion that considers the
Magnitude (dB)
-50
difference between the set point and the output that exists
when a system is excited by a step input. The Optimization
-100
-150
-200
Toolbox of MATLAB 7.0 was used to obtain the
90
MIMO Transf er Function controller's gain for the PID/PD controllers.
0 SISO Transfer Function
Phase (deg)
-90
Longitudinal
REFERENCE
TO
are stable; therefore the controller gains were reduced by a
factor of 0.3 to allow for a reasonable gain margin of at
Pitch angle
set point Pitch angle cyclic INERTIAL
controller REFERENCE
least 40o. The reduction of the controller gains did not
degrade the controller response. The IAE for the altitude,
Yaw angle
set point Yaw angle Pedal
controller
both before and after the modifications, was 5.426. The
IAE for the yaw was 0.8223. The final gains and phase
Altitude
set point Altitude Collective
controller
margins for the altitude and yaw controllers are shown in
Table 2.
Table 1 presents the final inner controller values obtained PITCH 0.605 1.925 0.165
for the roll, the pitch, the yaw and the altitude controllers.
It is important to notice that cross-coupling between the 0.96 2.8 0.24
ROLL
inputs of the helicopter was neglected.
HEIGHT 1.2526 0 0.3393
For both, the height and the yaw controllers, the
optimization algorithm produced extremely small values
for the integral constant in the PID controller, KI. For this YAW 28.2370 0 0.9969
reason, it was decided to use PD controllers instead for the
height and the yaw controllers. The optimization routine
was performed a second time to determine the values of KD
and KP for each of the new PD controllers. Table 2: Controller Analysis
PHASE GAIN
Equation(7) was used to calculate the SISO transfer MARGIN MARGIN
functions for the closed loop yaw, altitude, pitch and roll. (degrees) (dB)
The Bode plots for each of the closed loop transfer
functions were obtained using MATLAB’s tools. The yaw
PITCH 51.5 5.86
was found to be stable using the gains obtained via
optimization. The height closed loop transfer was
determined to be unstable from the Bode plots using the ROLL 40.1 5.8
gains obtained from the optimization tool. In contrast with
the SISO stability analysis for the height, the MIMO HEIGHT 42.9 11.9
system behaves stably without any kind of oscillation for
overall system response time less than 1000 seconds. It is YAW ∞ 123
possible that the system is stable with the initial optimized
gains but is not determined to be stable because the
stability analysis neglects coupling. However it is
important to note that having a SISO approximation that
7 Fuzzy Logic Controllers Table 3: Optimized values of the scaling factor for the
fuzzy PD-like controllers
Fuzzy control systems have also been used to control
helicopters [3], [4], [5]. Following the analysis presented Se Sce Su
in the previous section, it was decided to use the equivalent
type of fuzzy PID/PD-like controllers [7] for the same HEIGHT 0.5704 0.3425 1.1306
controlled variables. Mann, Hu and Gosine [6] present the
three types of fuzzy structural elements needed to design a YAW 3.0386 0.6509 4.7436
fuzzy PID-like controller. Figure 7 shows the typical block
diagram of a fuzzy PD-like controller [8] and Figure 8
shows the typical block diagram of a fuzzy PID-like
controller where e(t) is the error defined as the difference
between the desired signal value, set point, and the real
value of the controlled variable; ∆e(t) is change of the Table 4: Optimized values of the scaling factors of the
error. fuzzy PID-like controller
Se Sce S1 S2
e( t ) ê
Se Fuzzy uˆPD uPD PITCH 0.6859 0.3505 3.5181 0.6159
PD Su
d
dt
Sce Ɛ rule base ROLL 0.8962 0.2546 3.5576 0.5923
Se is the scaling factor for the error, e(t). Sce is the 100
60 Desired Trajectory
40
0
-60
-40
0
100
150
20 50
Outputs
0
40 -50
-100
60 -150
ye (m)
xe (m)
Classical Fuzzy
8 Pitch Response with PID Controller
respectively. 7
12 2
1
10
Altitude (m)
8
-1
0 5 10 15 20 25
time (sec)
6
9 Conclusions
Figure 10: Comparison of the responses of the altitude
The analysis of the small scale helicopter model was
greatly simplified by the use of both zero angle and SISO
12
Yaw Response Comparison
approximations. Comparison between the simplified
transfer functions and the more complex model
Yaw Set Point
Yaw Response with Fuzzy PD-like Controller
Yaw Response with PD Conroller
8
non-aggressive flight conditions.
Yaw angle (deg)
References
[1] Bernard Mettler, Identification Modeling and
Characterization of Miniature Rotorcraft, Kluwer
Academic Publishers, 2003.
[2] Neil Munro, "Symbolic Methods in Control System [15] CRASAR VTOL technical report No. 01
Analysis and Design", The Institution of Electrical
Engineers, Londo, 1999.