Research Journal of Applied Sciences, Engineering and Technology 4(19): 3843-3851,... ISSN: 2040-7467

advertisement
Research Journal of Applied Sciences, Engineering and Technology 4(19): 3843-3851, 2012
ISSN: 2040-7467
© Maxwell Scientific Organization, 2012
Submitted: May 08, 2012
Accepted: May 29, 2012
Published: October 01, 2012
Modeling, Design and Control of a Ship Carried 3 DOF Stabilized Platform
Leghmizi Said, Liu Sheng, Naeim Farouk and Boumediene Latifa
College of Automation, Harbin Engineering University, Harbin, Heilongjiang 150001, China
Abstract: The system for stabilizing platform of a ship carried antenna a nd its core component are
discussed in this study. Relevant mathematics model of these components are established. Thus, the
dynamic model of the system is deduced including the effects of friction, inertia and torque motors. Using
Solid Works, we built the mechanical structure, including the servo machine of each part of the system.
The system under consideration is a system with strong interactions between three channels. By using the
concept of decentralized control, a control structure is developed that is composed of three control loops,
each of which is associated with a single-variable controller. First, PID controller was applied; then,
Takagi-Sugeno (TS) fuzzy controller was used for controlling the platform. Simulation tests were
established using Simulink of Matlab. The obtained results have demonstrated the feasibility and
effectiveness of the proposed fuzzy approach comparing to the PID controller. Simulation results are
represented in this study.
Keywords: Decentralized control, dynamic model, fuzzy controller, PID contoller, simulink, solidworks,
Takagi-Sugeno (TS)
INTRODUCTION
The stabilized platform is the object which can
isolate motion of the vehicle and can measure the
change of platform’s motion and position incessantly. It
can make the equipment which is fixed on the platform
aim at and track object fastly and exactly. In the
stabilized platform systems, the basic requirements are
to maintain stable operation even when there are
changes in the system dynamics and to have very good
disturbance rejection capability.
Since they began to be utilized about 100 years
ago, stabilized platforms have been used on every type
of moving vehicle, from satellites to submarines and are
even used on some handheld and ground-mounted
devices (Hilkert, 2008; Debruin, 2008). Its application
is quite abroad and it becomes investigative hotspot in
most countries all the time.
The considered platform is a class of multivariable
servomechanisms with multiple axes. The control of
such multivariable servomechanisms is, in general, not
a simple problem, as there exist cross-couplings, or
interactions, between the different channels. In
addition, this system is required to maintain stable
operation even when there are changes in the system
dynamics. In the stabilized platform systems, the basic
requirement is to have very good disturbance rejection
capability. Presence of inherent nonlinearities such as
striction, friction, saturation of actuators, etc., also must
be taken into account.
Many approaches have been proposed to control
such a complex interconnected system for example the
decomposition-coordination approach, the aggregation
approach, the multitime-scale approach and the
decentralized control approach (Linkens and Nyongesa,
1998; Lee et al., 1995) Since the decentralized control
approach is reliable and practical in view of the
implementation, it is the most popular method that
attempts to design control schemes, where each
subsystem is controlled independently based on local
information. However, the decentralized approaches are
restricted to stabilization and the dynamics of each
subsystem and the interconnection terms are assumed to
be known (Nie, 1997; Shi and Singh, 1992). In practice,
the model of the considered platform contains vast
unknown uncertainties. Since fuzzy logic control has
been considered as an alternative to traditional control
schemes to deal with system dynamics uncertainty and
obtain the best performance of the system. Fuzzy
control is adopted as the subject of this study (Yeh,
1999).
The objective of this study is to develop the
dynamics model and the 3D design of the ship carried
stabilized platform. Then, apply the PID and Fuzzy
controllers for stabilizing the platform. By using the
decentralized control concept, we developed a control
structure composed of three separate control channels,
each of which is associated with a single variable
controller. The simulation results in applying the two
proposed controller to a 3-DOF stabilization system are
presented which demonstrates the effectiveness of the
proposed fuzzy controller comparing to the PID
controller.
Corresponding Author: Leghmizi Said, College of Automation, Harbin Engineering University, Harbin, Heilongjiang
150001, China
3843
Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012
 (Yaw)
 (Pitch)
 (Roll)
Fig. 1: The 3-DOF platform structure
= Relative angular rate between the case and the
outer gimbal, measured about the outer gimbal X
axis (Xo)
SYSTEM DYNAMICS
System description: The considered system in this
study is composed of the platform, inner gimbal, outer
gimbal and the case (Fig. 1); each member is assumed
to be rigid and has one degree of freedom (Leghmizi
and Liu, 2010).
According to the Euler definition of the rotation
angles, we define the angles and rates relating the four
members of the gimbaled system as following (Barnes,
1971):
θ = Relative angle between the inner gimbal and the
platform, measured about the platform Y axis (Yp)
= Relative angular rate between the inner gimbal and
the platform, measured about the platform Y axis
(Yp)
ψ = Relative angle between the outer and inner
gimbals, measured about the inner gimbal Z axis
(ZI)
= Relative angular rate between the outer and inner
gimbals, measured about the inner gimbal Z axis
(ZI)
= Relative angle between the case and the outer
gimbals, measured about the outer gimbal X axis
(Xo)
At each member of the gimbaled system we
associate an orthogonal coordinate system (Fig. 2)
platform (Xp, Yp, Zp), inner gimbal (XI, YI, ZI), outer
gimbal (XO, YO, ZO) and case (XC, YC, ZC).
The considered system platform is fixed on the
ship. Generally the satellite dish antenna is based on the
back part of the ship presented in Fig. 3.
Dynamics model: The mathematical modeling was
established using Euler theory. The Euler’s moment
equations are:
M  i H
(1)
The net torque M consists of driving torque applied
by the adjacent outer member and reaction torque
applied by the adjacent inner member:
i H 
i H
3844 dH
 m H  m  H
dt
: Inertial derivative of the vector
(2)
H
Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012
Fig. 2: The system topology
Fig. 3: The case coordinates in the body-fixed frames
mH : Derivative of H calculated in a rotating frame of
reference
of second-order differential equations in the state
variables. Solving this system of equations we obtain:
m : Absolute rotational rate of the moving reference
frame
H : Inertial angular momentum
M : External torque applied to the body
By applying Eq. (2) on the different parts of the
platform system, the system may be expressed as a set
3845  
C i B o  C o Bi
Ai Bo  Ao Bi
(3)
 
C o Ai  C i Ao
Ai Bo  Ao Bi
(4)
Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012
 
Cp
Bp

Ap
Bp
*
C i B o  C o Bi
Ai Bo  Ao Bi
(5)
where,
A p  sin 
Bp  1
Cp 
M
Fig. 4: The base unit of the platform
*
Ipy
 MPY
I py
 I px  I pz 
Ai  cos cos sin  

 I iz 
I px
I px 

 cos 2 
Bi  1  sin 2 

I iz
I iz 

M *  MIZ
Ci  oiz
I iz
 I ix  I px cos 2   I pz sin 2  
 I iy 
2
Ao  1  cos 2  
  sin   
I ox
 I ox 


Fig. 5: The outer gimbal
 I px  I pz 
Bo  cos sin  cos 

 I ox 
Co 
*
M cox
 MCX
I ox
Detailed equations computation is presented in the
study (Leghmizi et al., 2011).
ESTABLISHING THREE DIMENSIONAL
MODEL OF THE STABILIZED PLATFORM
Fig. 6: The inner gimbal
The design of a three-axis platform requires a total
of four bodies. These bodies include the base (case), the
inner, outer and platform gimbals.
The base, shown in Fig. 4 is designed to provide a
solid foundation to the three gimbals that will be
rotating around their respected axis. A rigid base is
responsible for preventing vibrations that will cause
inaccurate movement and give unpredictable dynamic
responses. In the right section of the base is attached a
servo machine boxe, shown in Fig. 8a, responsible of
the rotation of the outer gimbal.
The outer gimbal, shown in Fig. 5, controls the
system platform roll. The outer gimbal will be directly
attached to the actuator mounted to the base. When the
actuator is activated it will allow the outer gimbal to
rotate 180°. The second actuator boxe, shown in Fig.
8b, is contained inside the outer gimbal. The actuator is
firmly attached inside and is enclosed by a cap.
The inner gimbal, shown in Fig. 6, controls the 3DOF platform yaw. The middle gimbal is rotated by the
actuator housed in the outer gimbal. The middle gimbal
allows the platform to rotate 90°. The third and final
actuator, shown in Fig. 8c, is attached the left side of
the inner gimbal.
The platform gimbal showed in Fig. 7 is
responsible for the platform’s pitch. The platform
gimbal does not include housing for an actuator as there
are no additional gimbals to rotate.
The platform system assembly is represented in
Fig. 9.
3846 Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012
the system based on these complete nonlinear dynamics
is extremely difficult. It is thus necessary to reduce the
complexity of the problem by considering the linearized
dynamics (Lee et al., 1996). This can be done by noting
that the gimbal angles variation are effectively
negligible and that the ship velocities effect is
insignificant.
Applying the above assumptions to the nonlinear
dynamics, the following equations are obtained:
Fig. 7: The platform gimbal
 
Dco
1
 
I px  I ix  I ox
I px  I ix  I ox
Fco (sgn) 
 
I pz  I py  I px
I px  I ix  I ox
 Too
1
Doi
 
I pz  Iiz
I pz  Iiz
I I I
Foi (sgn )  py px pz   Tmm
I pz  Iiz
Fig. 8: The machine boxes used in the platform
 
Fig. 9: Final assembly of the platform
Table 1: Platform parameters
Platform
Inner gimbal
Ipx
0.119
Iix
0.406
Ipy
0.119
Iiy
0.845
Ipz
0.237
Iiz
1.020
0.110
Doi
0.260
Dip
Outer gimbal
Iox
Ioy
Ioz
Dco
1.05
1.05
1.10
0.32
Using this software we can also calculate the
principal moments of inertia taken at the center of mass
of each part of the platform system. These moments of
inertia will be used in the following simulation section.
The values found for these parameters are given in
Table 1.
SIMULATION RESULTS AND DISCUSSION
The complete nonlinear dynamics for the stabilized
platform system was developed in the previous section.
Here, it suffices to note that designing a simulation for
(6)
Dip  1
I  I pz  I py 

Fip (sgn )  px
  TII
I py
I py
I py
(7)
(8)
PID controller simulation: In the 3-D of platform we
will apply a decentralized PID which consiste of three
PID controllers applied to each part of the platform
separately as shown in Fig. 10 the PID parameters are
calculated for each part using the Ziegler-Nichols
method (Ziegler and Nichols, 1942). The obtained
parameters are listed in Table 2.
In order to see the outcome of the designed
controller, we performed a simulation in closed-loop
mode. This simulation was particularly useful for the
recognition of the effect of each PID coefficient to the
response of the system.
Simulation results will be presented to illustrate the
gimbals behavior to different PID parameters. They are
presented in Fig. 11, which contain the step response of
the platform system using the PID controller and in Fig.
12, which contain the impulsion response of the
platform response using the PID controller.
As shown in Fig. 11 and 12, the responses are
significantly acceptable but the response characteristics
still not well improved.
Figure 13 illustrates the position tracking responses
using PID controller. It can be seen that this controller
present bad tracking performance with big rising time.
This is due to the nonlinearities of the system that the
controller can’t handle. For this an introduction of a non
linear controller is necessary.
3847 Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012
Fig. 10: PID control for the 3-DOF platform
Ki
1.8
5
Kd
11.3
Gimbals position (rad)
1.5
1.0
0.5
0
0
0.2
0.4
0.6
0.8 1.0 1.2
Time (s)
1.4
1.6 1.8
0.5
0
-0.5
0
0
0.5
1.0
1.5
2.0
2.5
Time (s)
2
3
4
5
Time (s)
6
7
8
9
1.0
0.5
0
0
1
1.5
Platform
Inner gimbal
Outer gimbal
1.0
1
Gimbals position (rad)
Gimbals position (rad)
1.5
2
Fig. 13: Position tracking response using PID controller
2.0
Fig. 11: Step response of the platform using PID controller
3
-1
Platform
Inner gimbal
Outer gimbal
Platform
Inner gimbal
Outer gimbal
Reference
4
Gimbals position (rad)
Table 2: PID parameters
Kp
8.8
3.0
3.5
4.0
Fig. 12: Impulse response of the platform using PID controller
Platform
Inner gimbal
Outer gimbal
0
0.5
1.0
1.5
2.0 2.5 3.0 3.5 4.0 4.5 5.0
Time (s)
Fig. 14: Disturbance rejection of the 3DOF platform using
PID controller
3848 Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012



Fig. 15: TS fuzzy controller for the 3-DOF platform
Also, in order to see the disturbance rejection
aptitude of the PID controller, small disturbance 
was introduced. The injected disturbance was a pulse of
   0.1rad amplitude and adds to the system input at
time instant 3s.
The disturbance rejection capability of each part of
the stabilized platform using PID controller is plotted in
Fig. 14 They show that the controller is also unable of
dealing with this situation.
Fuzzy controller simulation: In the 3-D of platform
we will apply a decentralized Fuzzy controller which
consiste of three TS-Fuzzy controllers applied to each
part of the platform separately as shown in Fig. 15.
The structure of a complete fuzzy control system is
composed from the following blocs: Fuzzification,
Knowledge base, Inference engine, Defuzzification as
shown in Fig. 3 (Chuen, 1990).
The general TS fuzzy systems in this study use 2
input variables. eθ, eψ, e and , , are selected as
input variables of each subsystem respectively and
defined as two variables representing the situation. cji is
selected as output of the jth subsystem and defined as a
variable representing the action. Notice that variables
for θ, ψ, , , and assume linguistic terms as their
values such as positive-big, negative-small and zero,
etc.
Table 3: Rule base of the fuzzy logic controller
NB
NM
NS
ZR
PS
e\
θ
PB
PM
PS
ZR
NS
NM
NB
ZR
NS
NM
NB
NB
NB
NB
PS
ZR
NS
NM
NB
NB
NB
PM
PS
ZR
NS
NM
NB
NB
PB
PM
PS
ZR
NS
NM
NB
PB
PB
PM
PS
ZR
NS
NM
PM
PB
PB
PB
PB
PM
PS
ZR
NS
PB
PB
PB
PB
PM
PS
ZR
Using the Takagi-Sugeno model (Takagi and
Sugeno, 1985), the fuzzy system is characterized by a
set of p If-Then rules stored in a rule-base and
expressed as Ri: IF eθ is Ai and is Bi then:
c i j  p 0  p1e  p 2
where, Ai and Bi are linguistic terms which in this
study can be NL, NM, NS, ZR, PS, PL and PB.
The rule base of this controller is summarized in
Table 3 for simplicity; the same universe of discourse
and the same fuzzy set are adopted for fuzzy input
variables. The membership functions of isosceles
triangles are used as the fuzzification function.
The Sugeno type fuzzy controller employ linear
functions of input variables as rule consequent, so the
steps of aggregation and defuzzification of fuzzy rules
are simultaneously and the final output of the system
3849 Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012
1.2
1.0
0.8
0.6
0.4
0.2
0
0
0.2
0.4
PID
TS Fuzzy
Inner gimbal position (rad)
Platform position (rad)
1.4
1.2
1.0
0.8
0.6
0.4
0.2
0
0
PID
TS Fuzzy
1.4
0.6 0.8 1.0 1.2
Time (s)
1.4 1.6 1.8 2.0
0.2
0.4
0.6 0.8 1.0 1.2
Time (s)
(a)
1.4 1.6 1.8 2.0
(b)
Outer gimbal position (rad)
1.5
PID
TS Fuzzy
1.0
0.5
0
0
0.2
0.4
0.6 0.8 1.0 1.2
Time (s)
1.4 1.6 1.8 2.0
(c)
Fig. 16: Step response of the platform system using PID and TS Fuzzy controller, (a) platform, (b) inner gimbal, (c) outer gimbal
is the weighted average of all rule outputs, computed
as:
Tl 
c
i 1
N
j
i
i

i 1
(9)
i
The zero-order Sugeno model is applied, the output
level z is a constant (p1 = p2 = 0). The value of p0
depends on the linguistic term of the output. For
example if the output is NB (according to the rule base)
so p0 = -1.
To observe the performance of the designed fuzzy
controller a comparison between the step response of
the platform using PID controller and the step response
of the platform using the fuzzy controller was done.
The results of the simulation investigating
positioning performance comparison of platform
system are shown in Fig. 16.
Figure 16 (Solid lines) shows step responses of the
stabilized platform system when controlled by three
separated order-0 TS fuzzy controllers. Figure 16
Platform position (rad)
N
Platform response
Desired trajectory
1.2
1.0
0.8
0.6
0.4
0.2
0.0
-0.2
0
0.5
1.0
1.5
2.0 2.5 3.0 3.5 4.0 4.5 5.0
Time (s)
Fig. 17: Position tracking response of the platform
(dashed lines) shows step responses of the stabilized
platform system when controlled by three separated
PID controllers. As shown in Fig. 16 the responses
(solid lines) were significantly improved with smaller
overshoot, shorter rising time.
Figure 17 illustrates the position tracking responses
using TS fuzzy PD controller. It can be seen that this
controller present good tracking performance with
minor rise time.
3850 Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012
CONCLUSION
Our research focused on the common coordinate,
kinematics, dynamics, control system and software
design for ship carried stabilized platform. For that in
this study we developed a dynamics modeling of the
platform and a 3D model of the platform using
Simulink and SolidWorks. Then, we considered the
problem
of
controlling
this
multivariable
servomechanism where there exist cross-couplings
between the channels. A fuzzy PD control strategy
using a Takagi-Sugeno fuzzy model has been proposed
and by comparing it with PID controller, it has been
shown in the study that uniformly stable operation is
achieved together with asymptotic tracking of the
reference command signals.
In the study, simulation results in applying the
proposed TS fuzzy PD controller to a 3-Dof
stabilization system have been presented which
demonstrates the effectiveness of the fuzzy controller.
Future study is directed to the optimization of the
scaling factors of the fuzzy system and the intelligent
method to generate an effective rule base.
REFERENCES
Barnes, F.N., 1971. Stable member equations of motion
for a three-axis gyro stabilized platform. IEEE T.
Aero. Elec. Syst., 7(5): 830-842.
Chuen, C.L., 1990. Fuzzy Logic in control systems:
Fuzzy logic controller-part I, II. IEEE T. Syst. Man
Cy., 20(2): 419-435.
Debruin, J., 2008. Control systems for mobile satcom
antennas. IEEE Contr. Syst. Mag., 28: 86-101.
Hilkert, J.M., 2008. Inertially stabilized platform
technology concepts and principles. IEEE Contr.
Syst. Mag., 28: 26-46.
Lee, P.G., K.K. Lee and G.J. Jeon, 1995. An index of
applicability for the decomposition method of
mu1tivariable fuzzy systems. IEEE T. Fuzzy Syst.,
3: 364-369.
Lee, T.H., E.K. Koh and M.K. Loh, 1996. Stable
adaptive
control
of
multivariable
servomechanisms, with application to passive lineof-sight stabilization system. IEEE T. Ind. Elec.,
43(1): 98-105.
Leghmizi, S. and S. Liu, 2010. Kinematics modeling
for satellite antenna dish stabilized platform.
Proceedings of the 2010 International Conference
on Measuring Technology and Mechatronics
Automation-Volume 02, (ICMTMA '10), IEEE
Computer Society Washington, DC, USA, pp: 558563.
Leghmizi, S., R. Fraga, S. Liu, K. Later, A. Ouanezar,
et al., 2011. Dynamics modeling for satellite
antenna dish stabilized platform. International
Conference on Computer Control and Automation,
May 1-3, pp: 20-25.
Linkens, D.A. and H.O. Nyongesa, 1998. A hierarchical
multivariable fuzzy controller for learning with
genetic algorithms. Int. J. Contr., 63(5): 865-883.
Nie, J., 1997. Fuzzy control of multivariable nonlinear
servomechanisms with explicit decoupling scheme.
IEEE T. Fuzzy Syst., 5: 304-311.
Shi, L. and S.K. Singh, 1992. Decentralized adaptive
controller design for large-scale systems with
higher order interconnections. IEEE T. Automat.
Contr., 37: 1106-1118.
Takagi, T. and M. Sugeno, 1985. Fuzzy identification
of systems and its applications to modeling and
control. IEEE T. Syst., Man Cy., 15: 116-132.
Yeh, Z.M., 1999. A systematic method for design of
multivariable fuzzy logic control systems. IEEE T.
Fuzzy Syst., 7(5): 741-752.
Ziegler, J.G. and N.B. Nichols, 1942. Optimum settings
for automatic controllers. T. ASME., 64: 759-768.
3851 
Download