Professional Documents
Culture Documents
Paik 2015
Paik 2015
Abstract— Inertial stabilized platform is one of the most states for estimating the uncertainty, so the number of fuzzy
important parts of modern tracking system. There are lots of rules is reduced and the controller will gives no oscillation,
applications such as in the field of defense, aerial photography, zero steady state error and smaller settling time than
satellite imaging, industrial measurements, etc. In platform obtained using Ziegler Nichols tuned PID controller and
stabilization system the platform where any desired object can
fine tuned PID controller. So the proposed fuzzy controller
be placed is to be maintained at a fixed reference level
although there is change in system dynamics. This paper uses design approach and smaller rule base can provide better
an adaptive methodology to stabilize the platform according to performance comparing with the conventional PID
the changes in the situation. Design and development of the 3- controller and fine tuned PID controller so that it can be
axis platform system model is shown. This includes the achieved a stable image throughout the observation period.
relevant system dynamic model of the platform and the
successful control of three degree of freedom is presented for
the application of steering and stabilizing the platform II. OVERALL SYSTEM BLOCK DIAGRAM
mounted on dynamic system. Non-linear simulations are
performed to see the behavior of the system model as well as The proposed overall system block diagram to stabilize the
control simulation for compensating the external disturbances. platform is shown in fig.1. The whole system can be
considered as two sections- modeling and controlling where
Keywords— Platform stabilization system, 3-axis stabilized the modeling part deals with kinematic model and dynamic
platform model equations, Adaptive fuzzy control system, Self-
tuning PID control.
gimbals equation and the controlling part deals with control
technique to stabilize the platform in a better way.
I. INTRODUCTION
B. Platform Orientations
The orientation of a body rotating about a fixed point can be
described using three angles, called Euler
angles. Using the Euler angles, a coordinate transformation
that maps vectors in one reference frame to another can be
defined. This is done by three consecutive rotations that is
Fig. 2. 3-Axis Platform Structure Euler 3-2-1 rotation sequence. The gimbal angles
are simply the Euler angles for the platform
A. Coordinate Systems
axis system when the body axis system is aligned with the
In order to describe the system model and control the inertial axis system[3]. Beginning with a vector
orientation of the platform, four sets of coordinate coordinated in O − XIYIZI is transformed to , then is
systems[1] are as follows:
transformed to and again transformed to
a) The inertial axis system coordinated in O − XPYPZP after the rotation of ZI axis at
b) The body(base) axis system an angle , rotation of YI axis at an angle rotation of
XI axis at an angle respectively. These can be described
c) The platform axis system
mathematically as
d) The gimbal axis system
( ) (1)
a) Inertial axes— An inertial reference frame is a set of
axes which remains constant with time. The attitude of a ( ) (2)
body can uniquely be determined by evaluating the
orientation of the body frame relative to the inertial ( ) (3)
frame. The inertial axis system, OI − XIYIZI, is then
defined as a set of right-hand orthogonal axes oriented
north for the positive XI-axis, east for the positive YI- Where ( ) [ ] (4)
axis and down for the positive ZI-axis.
b) Body axes— The body axis, OB −XBYBZB, as defined
is a fixed right-hand orthogonal coordinate system with
the positive XB-axis, the positive YB-axis to the right of ( ) [ ] (5)
the positive XB-axis and the ZB-axis orthogonally
downward from the XBYB-plane. The origin, OB, is at
the centre of mass of the body.
( ) [ ] (6)
c) Platform axes— The platform axis system is defined as
a right-hand orthogonal coordinate system, with origin
at the intersection of the gimbal axis of rotation and the A vector coordinated in the inertial axis system, O −
spin axis of the gyroscope. With reference to Fig. 2, the XIYIZI, can now be transformed to the platform axis
XP -axis is defined as the axis of rotation of the inner system, O − XPYPZP, by
gimbal, the YP -axis is to the right of the XP –axis in the
plane of rotation of the flywheel of gyroscope and the AP M 321 AI (7)
ZP -axis is pointing orthogonally downward from the
XPYP -plane. The ZP -axis is now aligned with the Where ( ) ( ) ( ) ( ) (8)
angular momentum vector generated by the flywheel.
This coordinate system is fixed in the stabilization The total angular velocity of the platform in terms of the
plane[2].
Euler angles can be written as
d) Gimbal axes— It is necessary to define a set of axes
wherein the dynamic equations of motion of the 3-axis G Z I G YI G X I (9)
527
2015 International Conference on Smart Technologies and Management for Computing, Communication, Controls, Energy and Materials
Applying Eqs. (1), (2) and (3) the total angular velocity can P J p (22)
be written in terms of platform axes, as
where p is the angular momentum of the gyroscope spin
Z I sin G X P sin G cos G YP cos G cos G Z P axis, which is constant. again the eq.(21) can be written as
YI cos G YP sin G Z P (10), (11), (12)
X I X P J d
dt
T dh
dt
J p (23)
Now the total angular velocity of the platform in platform Now the equation of motion of a rigid body equipped with
coordinates is then an element that produces a constant angular velocity will be
X X P Y YP Z Z P
P P P
(13) J d
dt
T j p (24)
(14),(15),(16) requires a set of three Euler equations to describe its
Y G cos G G sin G cos G
P motion[5]. To simplify the analysis we will assume that
Z G sin G G cos G cos G
each gimbal has a spherical moment of inertia tensor, so
P
that cross coupled inertia effects can be ignored. That is
C. Equations of Motion of the Platform
J 11 0 0
The time rate of change of angular momentum of a rigid J 0 J 22 0 (25)
body is related to the torques applied to the body through 0 0 J 33
Newton's second law for rotational motion[4] as
So the dynamic equations along each of the gimbal rotation
dP
dt
T (17) axes can be evaluated through eq. (24)
where T is the torque vector acting on the body and P is the J111 T 2 p cos G 3 p sin G cos G
angular momentum vector of the body defined as
J 222 T 1 p cos G 3 p cos G sin G
P J (18) J 333 T 1 p sin G cos G 2 p cos G sin G
Where is the total angular velocity of the body and (26), (27), (28)
J d
dt
T J (21) The accuracy of the mathematical model and the model
parameters must be evaluated before the design of
for a body equipped with gyroscope controllers for the platform can be investigated. In this
528
Model Development and Adaptive Control Implementation of a 3-Axis Platform Stabilization System
simulink model a step torque is applied to the outer gimbal (VH). The variation range of input, error (E) [-1 1] and
of the platform. change in error (CE) [-1 1], for the three output ranges
are [0 40], [0 20], [0 25] for respectively.
IV. ADAPTIVE FUZZY BASED CONTROL b) Fuzzy rules— The fuzzy rules are obtained according to
the knowledge of experiment to get the better
The conventional PID controller is one of the most useful performance of the system and these fuzzy rules can
controllers that is still being used in many applications,
change depending on the type of system characteristics.
while there are some conditions in which it doesn’t show
Properties of PID controller, type of disturbances,
proper response, like when there is nonlinear and uncertain
conditions[6]. When there are such problems one of the best system behavior, characteristics of actuator and gimbals
ways to solve, is tuning the PID gains manually but, that is orientation are the impact factors to make these rules.
not possible always. In this paper a fuzzy logic method has The fuzzy inference system method used in this paper is
been used to tune the gains , and according to error MAX- MIN and the defuzzification method is
e (t) that is the difference between reference input and gyro centroid[9][10]. The rules for are shown
output signal, and derivative of error de (t) that is change in in table1, 2 and 3 respectively.
error, so the system controller is self-tuned PID using fuzzy
controller[7]. The general block diagram of the control Table 1. Fuzzy Rules for
system is shown in figure 4. CE
BN MN SN Z SP MP BP
E
BN VH VH MH MH H H L
MN VH VH MH MH H L L
SN MH MH MH H L ML VL
Z MH H H L ML VL VL
SP H H L MH ML VL VL
Fig. 4: Adaptive Fuzzy Logic Control System MP L L ML VL VL VL VVL
BP L ML ML VL VL VVL VVL
The system involves two type of controller namely:
conventional PID controller and fuzzy controller[8][9]. The Table 2. Fuzzy rules for
fuzzy controller which will tune the parameters of the PID
controller where the control output of the PID controller in CE
BN MN SN Z SP MP BP
time domain is E
BN VVL VVL VL VL ML L L
( )
( ) ( ) ∫ ( ) (29) MN VVL VL VL ML ML L L
SN VVL VL VL ML L H H
Where is proportional gain, is integral gain and is Z VL VL ML L H H MH
derivative gain. Now tuning the parameters of the PID SP ML L H H MH VH VH
controller a fuzzy inference system is to be designed where
MP L L H H MH VH VH
error ( ) and change in error ( ) are the inputs of fuzzy
controller and corresponding outputs are . BP L L H MH MH VH VH
529
2015 International Conference on Smart Technologies and Management for Computing, Communication, Controls, Energy and Materials
( ) (30)
( ) (31)
530
Model Development and Adaptive Control Implementation of a 3-Axis Platform Stabilization System
REFERENCES
531