You are on page 1of 9

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

Corresponding Author: Leghmizi Said, College of Automation, Harbin Engineering University, Harbin, Heilongjiang
150001, China
3843

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 platforms 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.


Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012

3844
(Pitch) u
(Roll) |
(Yaw)


Fig. 1: The 3-DOF platform structure

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 (Y
p
)

= Relative angular rate between the inner gimbal and


the platform, measured about the platform Y axis
(Y
p
)
= Relative angle between the outer and inner
gimbals, measured about the inner gimbal Z axis
(Z
I
)

= Relative angular rate between the outer and inner


gimbals, measured about the inner gimbal Z axis
(Z
I
)
= Relative angle between the case and the outer
gimbals, measured about the outer gimbal X axis
(X
o
)

= Relative angular rate between the case and the


outer gimbal, measured about the outer gimbal X
axis (X
o
)

At each member of the gimbaled system we
associate an orthogonal coordinate system (Fig. 2)
platform (X
p
, Y
p
, Z
p
), inner gimbal (X
I
, Y
I
, Z
I
), outer
gimbal (X
O
, Y
O
, Z
O
) and case (X
C
, Y
C
, Z
C
).
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 Eulers moment
equations are:

H i M

=
(1)

The net torque M consists of driving torque applied
by the adjacent outer member and reaction torque
applied by the adjacent inner member:

H H m
dt
dH
H i
m
+ = = e

(2)

H i

: Inertial derivative of the vector H


Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012

3845


Fig. 2: The system topology



Fig. 3: The case coordinates in the body-fixed frames

H m

: Derivative of H calculated in a rotating frame of
reference
m
e
: 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
of second-order differential equations in the state
variables. Solving this system of equations we obtain:

i o o i
i o o i
B A B A
B C B C

= |
(3)

i o o i
o i i o
B A B A
A C A C

=
(4)


Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012

3846

i o o i
i o o i
p
p
p
p
B A B A
B C B C
B
A
B
C

= * u
(5)

where,
sin =
p
A


1 =
p
B

py
Ipy
p
I
MPY M
C

=
*

(


=
iz
pz px
i
I
I I
A u u sin cos cos

(

+ + =
iz
px
iz
px
i
I
I
I
I
B u u
2 2
cos sin 1

iz
oiz
i
I
MIZ M
C

=
*

(

+
(
(

+ +
+ =
ox
iy
ox
pz px ix
o
I
I
I
I I I
A
u u

2
2 2
2
sin
sin cos
cos 1

(


=
ox
pz px
o
I
I I
B u u cos sin cos

ox
cox
o
I
MCX M
C

=
*


Detailed equations computation is presented in the
study (Leghmizi et al., 2011).

ESTABLISHING THREE DIMENSIONAL
MODEL OF THE STABILIZED PLATFORM

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


Fig. 4: The base unit of the platform



Fig. 5: The outer gimbal



Fig. 6: The inner gimbal

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 3-
DOF 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 platforms 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.


Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012

3847


Fig. 7: The platform gimbal



Fig. 8: The machine boxes used in the platform



Fig. 9: Final assembly of the platform

Table 1: Platform parameters
Platform Inner gimbal Outer gimbal
I
px
0.119 I
ix
0.406 I
ox
1.05
I
py
0.119 I
iy
0.845 I
oy
1.05
I
pz
0.237 I
iz
1.020 I
oz
1.10
D
ip
0.110 D
oi
0.260 D
co
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
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:

oo
ox ix px
px py pz
co
ox ix px ox ix px
co
T
I I I
I I I
F
I I I I I I
D

+ +
+

+ +

+ +
=
u |
| |


) (sgn
1

(6)

mm
iz pz
pz px py
oi
iz pz iz pz
oi
T
I I
I I I
F
I I I I
D

+
+

+
=
| u


) (sgn
1
(7)

II
py
py pz px
ip
py py
ip
T
I
I I I
F
I I
D

+
= | u u u


) (sgn
1 (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 cant handle. For this an introduction of a non
linear controller is necessary.


Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012

3848


Fig. 10: PID control for the 3-DOF platform

Table 2: PID parameters
K
p
K
i
K
d

8.8 1.8 11.3










Fig. 11: Step response of the platform using PID controller












Fig. 12: Impulse response of the platform using PID controller









Fig. 13: Position tracking response using PID controller















Fig. 14: Disturbance rejection of the 3DOF platform using
PID controller
0
0.5
1.0
1.5
G
i
m
b
a
l
s

p
o
s
i
t
i
o
n

(
r
a
d
)
0 0.2 0.4 0.6 0.8 1.0 1.2 1.4 1.6 1.8 2.0
Time (s)
Platform
Inner gimbal
Outer gimbal
0
0.5
1.0
1.5
G
i
m
b
a
l
s

p
o
s
i
t
i
o
n

(
r
a
d
)
0 0.5 1.0 1.5 2.0 2.5 3.0 3.5 4.0
Time (s)
-0.5
Platform
Inner gimbal
Outer gimbal
0
G
i
m
b
a
l
s

p
o
s
i
t
i
o
n

(
r
a
d
)
0 1 2 3 5
Time (s)
-1
Platform
Inner gimbal
Outer gimbal
4 6 7 9 8
1
2
3
4
5
Reference
0
0.5
1.0
1.5
G
i
m
b
a
l
s

p
o
s
i
t
i
o
n

(
r
a
d
)
0 0.5 1.0 1.5 2.0 2.5 3.0 3.5 4.0
Time (s)
Platform
Inner gimbal
Outer gimbal
4.5 5.0


Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012

3849
|



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
t A

was introduced. The injected disturbance was a pulse of
0.1rad t A =
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

, eand

are selected as
input variables of each subsystem respectively and
defined as two variables representing the situation. c
j
i
is
selected as output of the j
th
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
e


NB NM NS ZR PS PM PB
PB ZR PS PM PB PB PB PB
PM NS ZR PS PM PB PB PB
PS NM NS ZR PS PM PB PB
ZR NB NM NS ZR PS PM PB
NS NB NB NM NS ZR PS PM
NM NB NB NB NM NS ZR PS
NB NB NB NB NB NM NS 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:

u
u

2 1 0
p e p p c
j
i
+ + =


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


Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012

3850

(a) (b)












(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:

=
=
=
N
i
i
N
i
i
j
i
l
c
T
1
1

(9)

The zero-order Sugeno model is applied, the output
level z is a constant (p
1
= p
2
= 0). The value of p
0

depends on the linguistic term of the output. For
example if the output is NB (according to the rule base)
so p
0
= -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















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.
0
0.2
0.4
0.6
0.8
1.0
1.2
1.4
0 0.2 0.4 0.6 0.8 1.0 1.2 1.4 1.6 1.8 2.0
Time (s)
PID
TS Fuzzy
P
l
a
t
f
o
r
m

p
o
s
i
t
i
o
n

(
r
a
d
)


0
0.2
0.4
0.6
0.8
1.0
1.2
1.4
0 0.2 0.4 0.6 0.8 1.0 1.2 1.4 1.6 1.8 2.0
Time (s)
PID
TS Fuzzy
I
n
n
e
r

g
i
m
b
a
l

p
o
s
i
t
i
o
n

(
r
a
d
)
0
0.5
1.0
1.5
0 0.2 0.4 0.6 0.8 1.0 1.2 1.4 1.6 1.8 2.0
Time (s)
PID
O
u
t
e
r

g
i
m
b
a
l

p
o
s
i
t
i
o
n

(
r
a
d
)
TS Fuzzy
-0.2
0.6
1.0
1.2
P
l
a
t
f
o
r
m


p
o
s
i
t
i
o
n

(
r
a
d
)
0 0.5 1.0 1.5 2.0 2.5 3.0 3.5 4.0
Time (s)
Platform response
Desired trajectory
4.5 5.0
0.8
0.0
0.4
0.2


Res. J. Appl. Sci. Eng. Technol., 4(19): 3843-3851, 2012

3851
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 line-
of-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: 558-
563.
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.

You might also like