Documente Academic
Documente Profesional
Documente Cultură
Abstract: Abstract: One of the key questions in design of the helicopter control system is attitude control. Furthermore,
it has non-linear and multi-variable coupling characteristics and so on. Therefore, it’s a big challenge with the real-time
and reliable attitude control. The three degree-of-freedom helicopter model was used as the controlled object. Through
the research of modeling, controller designing and simulating, the application of control theory and technology can be
made full use of in the complicated system. PID was introduced as the traditional method. Specific to the defects of PID,
the fuzzy control algorithm was used to conquer the defects of pure PID controller. Based on the respective advantage of
PID and fuzzy controller, PID and fuzzy controller were combined together as one controller which fit together with
switch and weighted value. It optimized the flying gesture of the helicopter. The real-time simulation results proved the
feasibility and the validity of the designed method.
Key Words: fuzzy-PID control; three degree-of-freedom helicopter; decouple; threshold switch control; weighted value
control
c
978-1-4244-5182-1/10/$26.00 2010 IEEE 1438
computer. The control relation of the 3-DOF helicopter the two propellers. While the helicopter is traveling, the
system was shown in Figure 1. pitch angle is not zero, the torque is provided by the
component power of the pitch in the vertical direction. The
torque of elevation axis is also controlled by the two
propellers. If the speeds of the two motors are different, the
elevation axis will incline. So the lateral power which made
the helicopter travel around the base was generated [5].
Ignored the disturbance torque of gravity, we can get the
dynamic equations of the three axes, as followed:
The pitch axis equation˖
J eε = K c L1 (V1 + V2 ) = K c L1Vs (1)
The elevation axis equation˖
p = K c L p (V1 − V2 ) = K c L1Vd
J p (2)
Fig.1 Control frame of the 3-Dof helicopter system The travel axis equation˖
The DC motors which have been installed at the end of the
helicopter were as the power of the two propellers. Three J r r = − F sin( p) L1 (3)
coders were fixed on the pivot point of the balance pole, the The outputs of the controllers are Vs and Vd ,
center of two propellers and the axis of the control box. The
data were feed back to the computer by the coders which Vs = V1 + V2 , Vd = V1 − V2 .
included the angle of the pitch, the elevation angle of the The parameters mentioned in the above dynamic equations
propellers and the traveling speed. According to the control have their own meanings respectively, as followed:
algorithm compiled by the users, the controlled parameters
were worked out and sent to motors. Airscrew rate can be V1 \ V2 : the voltages of the motors, the elevation power F1
controlled conveniently by the control card so that the and F2 provided by them;
attitude angle and speed of the helicopter model was
controlled. ε : the traveling angle of the elevation axis㧧
Owing to the requirement of real-time control, all kinds of J e : the elevation axis moment of inertia㧧
flight data gathered by the motion control card should be
deal with immediately in order to control the helicopter K c : the lifting power constant of the propeller motor㧧
attitude real-time. So the RTW (Real-Time-Workshop)
toolbox of MATALB/Simulink was used to perform the l1 : the length from pivot to the motor˗
task. The sensors installed on the three axes measured and l2 : the length from pivot to the balance block˗
sent the real-time data to the control card. Under the help of
the motion controller card GT-400-SV PCI, we can control ε : the acceleration of the elevation axis˗
the velocity of the propellers. The control model in
J p : the pitch axis moment of inertia˗
GT-400-SV Block Library can output the servo motor
system and get the position of the axis. The gathered data l p : the length from pitch axis to the motor˗
were feed back by the data collection card. Then, the input
voltage will be adjusted by the controller. : the acceleration of the pitch axis˗
P
2.2 The establishment of the helicopter model P : the traveling angle of the pitch axis˗
r : the rotating speed (rad/sec)˗
sin( p ) : the sine value of the pitch axis angle p . If the
angle is zero, there is no power given to the traveling axis.
Since the power of traveling axis provided by the
component power of the incline propellers in the horizontal
direction. The output of the traveling axis is the input of the
pitch axis. So if we want to get the optimal results of the
attitude, the only task is to design two controllers for the
pitch axis and elevation axis. By the instructions of the
3-DOF helicopter model and the desired controllers above
mentioned, the explanation of the model structure was
carried on theoretically, the control functional block
diagram can be established, as shown in Figure.3
Fig.2 Structure of the three axes
As shown in Figure.2, assuming that the helicopter
suspending in the air and the pitch angle is zero, the torque
of pitch axis is provided by the elevation power F1and F2 of
According to Figure.3, the voltage of the first motor was While the helicopter model is running, the controlled
determined by the pitch axis and the elevation axis together. parameters of the model changed with the different flying
If the output of the two controllers were changed, the states. But the three parameters of PID controller are
second motor’s also changed inevitably. So the system can constants, therefore the system had a bad adaptability. In
be regarded as a coupled system with 2 inputs and 2 some cases, the mathematical model of the control process
outputs. The equation of motion by Laplace transform is may not exist, or may be too difficult to work out. The
represented as follows㧦 fuzzy controller doesn’t rely on the precise mathematical
model of the controlled object. Compared with PID
63.95 controller, it’s easy to establish the control rulers based on
p(s) = (V1 ( s ) − V2 ( s )) (4)
the fuzzy linguistic variables, the controller based on
s2
empirical rules would be more effective. Fuzzy logic has
5.82
ε ( s) = (V1 ( s ) + V2 ( s )) (5) the advantage that the solution to the problem can be cast in
s2 terms that the operators will understand easily, so that their
By comparison with the 2 inputs and 2 outputs transfer working experience would be used to design the controller.
function 㧘 the dynamic equations were rewritten as the It can make mechanize tasks easier which are already
equations of state㧦 successfully performed by workers [6, 7]. Put the decoupled
matrix (8) into the system models, the simulation schematic
ª 63.95 63.95 º diagram of decoupled fuzzy control was shown in Fig.4.
−
ª pº « s2 s 2 » ªV1 º (6) Degree of membership of the output variables were shown
«ε » = « 5.82 »
5.82 » «¬V2 »¼
¬ ¼ « in Figure 5. The deviation and its variation ratio were used
«¬ s 2 s2 »¼ as the input variables, the parameters options of output is
Make a choice of F ( s) ˈlet the product of F ( s ) and G ( s ) identical with the input. Difference between the pitch axis
and the elevation axis is the range of the output variable.
be the main matrix diagonal elements of the original
The selected membership functions of the pitch axis are
transfer function, as followed:
guassmf and trimf, it’s only gaussmf for the elevation axis.
ªG11(s) G12 (s) º ªF11(s) F12 (s) º ªG11(S) 0 º
(7) After numerous simulation experiments, the parameters of
«G (s) G (s)» «F (s) F (s)» = « 0 G22 (S)»¼ the fuzzy controller were selected finally. The deviation,
¬ 21 22 ¼ ¬ 21 22 ¼ ¬
the deviation variation ratio and the output of the pitch axis
The equation˄7˅is the new mathematic model which was
have the same following range㧦{-3㧘-2㧘-1㧘0㧘1㧘2㧘
established by using the method of diagonal matrix and
decoupling. After the system was decoupled, the first 3}㧧The input and output variables map into the following
controlled parameter U1 ( s ) had no effect to the second fuzzy set 㧦{NB㧘NM㧘NS㧘Z㧘PS㧘PM㧘PB}㧧The
range of the elevation axis is㧦{-30㧘-20㧘-10㧘0㧘10㧘
output Y2 ( s ) , U 2 ( s ) and Y1 ( s ) had the same case. By 20㧘30}㧧and its fuzzy set is㧦{NB㧘NM㧘NS㧘Z㧘PS
using the method of diagonal matrix, the main elements of 㧘PM㧘PB}㧧According to the selected fuzzy and range,
the decoupling matrix are F11 (s) = 0.5 , F12 (s) = 0.5 , the edition to the membership function would be complete
respectively. Based on the fuzzy control rulers listed in
F21 (s) = −0.5 , F22 (s) = 0.5 , namely: Table 1, the design of the fuzzy controller was finished.
ª F11 ( s) F12 ( s) º ª 0.5 0.5º
« F ( s ) F ( s ) » = « −0.5 0.5» (8)
¬ 21 22 ¼ ¬ ¼
(a) The output of pitch axis (b) The output of elevation axis
Fig.5 The membership and measurement grade of output U
In the early stage of the control process, the result of fuzzy
Table.1 Rule of fuzzy controller
controller is better, especially in inhibiting the overshoot.
NB NM NS ZO PS PM PB When the system tends to the stable stage, the fuzzy
NB NB NB NM NM NS NS ZO controller is similar to PD controller in nature. So its control
NM NB NM NM NS NS ZO PS result is worse than PID controller’s, the PID controller is
NS NM NM NS NS ZO PS PS selected in the late process. In this system, compared with
ZO NM NM NS ZO PS PS PM
the cursory adjustment of the fuzzy controller, the PID
controller made a precise adjustment.
PS NS NS ZO PS PS PM PM
PM NS ZO PS PS PM PM PB 3.3.2 Fuzzy–PID weighted value control
PB ZO PS PS PM PM PB PB
Figure 6(b) is the schematic diagram of fuzzy-PID
3.3. Fuzzy-PID control weighted value control. In order to avoid the system out of
control which caused by the hard switching, fuzzy-PID
3.3.1 Fuzzy-PID threshold switch control weighted value control was introduced into the system.
Aiming at deviations at the different periods, the proportion
The PID controller has good static performance, while its
of fuzzy control and PID control is different. λ 1 denotes the
response rate is not quick enough. Fuzzy controller is better
at dynamic performance than PID controller, but it can’t proportion of PID controller, λ2 denotes the proportion of
eliminate static error. The fuzzy-PID controller has the
merits both of them, the stable and the quick control effect fuzzy controller, where U=λ2 *Ufuzzy +λ1*UPIDˈ λ2 = 1 − λ1 .
can be obtained at the same time. Therefore, the fuzzy-PID
controller realized the process automation and intelligence
of the attitude control. For the reason that, the study on
fuzzy-PID controller has become a hot spot in this field [8,
9]
.Figure 6(a) is the schematic diagram of fuzzy-PID
threshold switch control. During the continuous control
stage, the system deviation and its variation ratio are
different for a certain controlled object. If the threshold
switch was set, when the deviation was greater than the (a) Frame of fuzzy-PID threshold switch control
threshold, the fuzzy controller was selected in order to
depress the overshoot. If the deviation was smaller, the PID
controller was used to hold the stabilization. This is the
threshold switch control.
In general case, the switch of PID controller and fuzzy
controller obey the following principles. When the
deviation is quite large, the fuzzy controller is selected, or
else the PID controller is selected. The traditional PID
controller often has a quite big overshoot, but a good (b) Frame of fuzzy-PID weighted value control
Fig.6 The Frame of fuzzy-PID control
dynamic stabilization. The overshoot of the fuzzy controller
is smaller, and good dynamic stabilization but not precise
enough. So the above mentioned principles were used.
The parameters of PID controller were shown in Table 2. Table.3 Comparison of PID, fuzzy and threshold switch control