Académique Documents
Professionnel Documents
Culture Documents
Modeling, Control and Simulation of Cascade Control Servo System for One Axis
Gimbal Mechanism
PAPER INFO A B S T R A C T
Paper history: The gimbal stabilization mechanism is used to provide the stability to an object mounted on the gimbal
Received 27 March 2013 by isolating it from the base angular motion and vibration. The purpose of this paper is to present a
Received in revised form 27 April 2013 model of control servo system for one axis gimbal mechanism using a cascade PID controller. The
Accepted 20 June 2013 gimbal torque relationships are derived by taking into consideration the base angular motion. The
conventional PID controller and three cascade controller structures are investigated. The servo control
loop is built and modelled in MATLAB/Simulink using these controllers. The simulation results are
Keywords:
compared and the servo system performance is analysed for each controller in terms of performance
Gimbal System
Rtae Gyro criteria. The comparison results prove that a further improved system performance is achieved using I-
Line of Sight PD controller as compared to the system performance obtained when the other controllers are utilized.
Stabilization Loop The papers value lies in designing the servo control system using a modified controller composed of
Servo System two parallel I-PD controllers related with a switch depending on the base angular rate as a threshold.
DC Motor The results show that the modified system satisfies the desired servo system requirements.
doi: 10.5829/idosi.ije.2014.27.01a.18
relationships for two degrees of freedom gimbal remainder of the paper is organized as follows. Second
assembly have been obtained for a simplified case when section formulates the problem. The mathematical of
each gimbal is balanced and the gimbaled element gimbal motion is derived in third section. In fourth
bodies are suspended about principal axes [4]. section, the stabilization loop is constructed by
Equations of motion for the two axes yaw-pitch gimbal introducing the design of the rate gyro, DC motor, the
configuration have been discussed on the assumption platform, and the controller. The simulation results are
that the gimbals are rigid bodies and have no mass analyzed and a modified controller is designed in fifth
unbalance [5]. Otlowski et al. has presented a single section. Finally, the conclusion remarks are highlighted.
degree of freedom (SDOF) gimbal operating in a
complex vibration environment [6]. Any servo motion
control system should have an actuator module that 2. PROBLEM FORMULATION
makes the system to actually perform its function. The
most common actuator used to perform this task is the Newtons first law applied to rotational motion asserts
DC servomotor which is regarded as one of the main that a body does not accelerate with respect to an
components of servo system [7, 8]. There are a lot of inertial frame unless a torque is applied. Furthermore,
control methods for the servo motors. Akar and Temiz Newtons second law establishes that if a net torque T is
utilized the PID, fuzzy logic control (FLC) and adaptive applied to a homogenous rigid mass having a moment
neuro-fuzzy inference system (ANFIS) [9]. Rigatos of inertia J , then the body develops an angular
estimated the unknown values of the DC motor using an acceleration [2] according to:
artificial neural network, and designed a controller
T = J .a (1)
based on ANFISn [10]. In another study, Rigatos
evaluated the performance of the Kalman filter and the Therefore, in principle, all that required to prevent
particle filter in reconstructing the state of the DCSM an object from rotating with respect to inertial space is
and subsequently in using this state estimation in to ensure that the applied torque is zero. However,
feedback control [11]. It can be realized that the despite careful electromechanical design, numerous
importance of gimbal systems gave rise to their sources of torque disturbances can act on a real
investigation in a lot of papers as mentioned above in mechanism causing excessive motion or jitter of (LOS).
addition to another researches indicated in [12-15]. Also, a means for controlling the object so that it can be
Without doubt, these researches have contributed to the rotated in response to command inputs is usually
studying and explaining gimbal systems, but the model required. Therefore, rate or displacement gyros are
of such systems is still difficult and complicated to be typically attached to the object to measure the inertial
understood by engineers because the vast majority of rotation about the axes that require stabilization and
these researches have been interested in the two or multi control. The gyro is used in a closed-loop servo system
axes gimbal systems. Also, these systems have been to counteract the disturbances and, at the same time,
investigated considering the inertia cross coupling allow the object to be controlled from external
between axes. Therefore, this paper presents the model command inputs [2]. The single-axis stabilized gimbal
of one axis gimbal system in order to simplify the is shown in Figure 1. The purpose of the gimbal is to
picture of the gimbal systems and to further investigate isolate the stabilized object from base rotation, and
the properties of this configuration. In another words, allow (LOS) to be pointed. The block diagram in Figure
this paper forms a primary theoretical base for designing 2 shows the gimbal stabilization system. It is typically
a multi axes gimbal systems. Concerning the control configured as a rate servo which attempts to null the
system, although the researchers tried to utilize and difference between the rate command input wc and the
apply many different modern techniques to control
angular rate of the gimbal w Ae . When the rate command
servo systems, the conventional PID and its constructors
are still the most used approach due to their simple input is zero or absent, the system attempts to null the
structure, cheap costs, simple design and high total torque applied to the gimbal, which requires that
performance [16]. In this paper, the cascade PID the stabilization closed-loop generate a control torque at
controller is proposed because of several practical the motor that is equal and opposite to the net
advantages [17]. The well-known PI(D) or more disturbance torque. From Figure 2, it can be seen that:
precisely the "Cascade PI(D)" controller is very wAe 1
= T = J wAe s = J w& Ae = J a (2)
attractive in terms of simplicity and popularity. T Js
Numerical simulations have been performed in order to
investigate the performance of the designed servo The control loop introduced works as stabilization
system and to confirm the improvements obtained from system when the rate command input wc is zero, which
the cascade controller in terms of the performance means that the control system output w Ae must be zero.
measures; rise time (tr), settling time (ts), maximum While this system tries to track the non zero rate
overshoot (Mp), and steady state error (ess). The command input.
159 M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170
w pi w Ar
v
= w Ae
v
p
wP I = w pj , Aw A I (4)
w Ad
w pk
e
where w pi , w p j , w p k are the base angular velocities of
w Ae
frame P in relation to inertial space about i, j, and k axes
e
respectively, and w Ar , w Ae , w Ad are the gimbal angular
velocities in relation to inertial space about the r , e, and
d axes, respectively. The inertia matrix of the gimbal is
Ar Are Ard
Figure 1. A single-axis gimbal mechanism
A
J = Are Ae Ade (5)
Ard Ade Ad
cos e 0 - sin e The total torque applied about the gimbal e-axis is the e-
A
C = 0 1 0 (3)
component of matrix (10):
P
sin e 0 cos e Tm = H& e + wAd Hr - wAr H d (11)
The inertial angular velocity vectors of frames P and A,
respectively are:
M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170 160
wm (s) KTM
Gm ( s) = =
ua (s) ( La s + Ra ) ( J m* s + a *m ) + Ke KTM (21)
1.4
The time response of DC motor the jitter of sensors line of sight and hence needs a
simpler control system [22, 23] which simplifies the
1.2 implementation of control laws in real time. Due to the
The angular speed Wm (rad/sec)of DC motor
0
Control signal u(t ) is a linear combination of error e(t) ,
0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1
Time(sec) its integral and derivative, where KP is proportional
Figure 6. DC motor time response gain, K I is integral gain, K D is derivative gain, TI is
integral time, and TD is derivative time.
Figure 7 shows the schematic model of a control
KP system with a PID controller. The classical structure of
PID controller can be converted into many different
+
r(t) e(t ) + u (t ) y(t ) forms utilizing the cascade control approach so that
KI
+ these forms are able to be applied in some applications.
- + Because of possible discontinuity (step change) in
KD
d reference signal that are transferred into error signal and
dt
result in impulse travelling through derivative channel
and thus cause large control signals u(t ) , it is more
suitable in practical implementation to use "derivative
Figure 7. PID control system of output controller form" (PI-D) shown in Figure 8.
It is even more suitable controller structure if there exist
sensors that give that information, such as tachometers
in electromechanical servo systems or rate gyro in
KP
mobile objects control. If PI-D structure (Figure. 8) is
+ used, discontinuity in r (t) will be still transferred
r (t) y(t )
e(t )
KI +
u(t )
Plant through proportional into control signal u(t ) , but it will
+
- - not have so strong effect as if it was amplified by
derivative element. PI-D controller algorithm is given
d
KD by:
dt
PI-D controller dy(t )
u(t ) = KP e(t ) + KI e(t )dt - KD (26)
dt
Figure 8. PI-D control system
The set-point-on-I-only controller (I-PD form) shown in
Figure 9 is not so often as PI-D structure, but it has
certain advantages. I-PD controller algorithm is given
r(t)
e (t )
KI +
u (t ) y(t ) by:
+
- -
-
dy(t )
u(t) = KP y(t ) + KI e(t )dt - KD (27)
dt
d
KP KD
dt
With this structure transfer of reference value
discontinuities to control signal is completely avoided.
Control signal has less sharp changes than other
Figure 9. I-PD control system structures. Serial (interactive) structure (PD*PI form) is
very often in process industry. I channel uses both the
error signal e(t) and derivative of the error signal
4. 4. Controller Design If gimbal design is not de(t ) dt . PD*PI controller block diagram is shown in
proper, the control algorithms may become complex and Figure 10. It is realized as serial connection of PD and
it may not be possible to meet the performance criteria PI controller. PD*PI control algorithm is:
[22]. While the well-designed gimbal assembly reduces
163 M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170
are:
0.02
v Rise time tr 0.2 sec .
0 v Settling time ts 0.35 sec .
v Maximum overshoot M p 20 % .
-0.02
v Steady state error ess = 0 .
These criteria must generally be satisfied in any control
-0.04
0 1 2 3 4 5 6 7 8 9 10 system.
time(sec)
Table 3 shows the values of the performance criteria
Figure 12. The total applied torque obtained with the adjusted controller parameters. It is
M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170 164
noted that all controllers proposed realize a zero steady The time response of servo system
0.4
state error and all the controllers PID, PI-D, PD*PI have
the same performance as shown in Figures (13-20). 0.35
Table 3 displays that the I-PD controller realizes a
0.3
deg/s ts sec tr sec Mp % ts sec tr sec Mp %
0.25
0 0.29 0.08 0 0.46 0.25 0
0.2
5 0.14 0.06 3.4 0.43 0.24 0 input
0.15 PI
10 0.21 0.05 14.3 0.41 0.23 0 PI-D
0.1 I-PD
15 0.42 0.05 24.3 0.37 0.19 0 PD*PI
35 0.62 0.03 69.4 0.35 0.05 18.1 Figure 15. Servo system response for wPj = 10 deg sec
0.3
0.3
0.25
0.25
0.2
0.2 input
PI
0.15 input 0.15 PI-D
PI
I-PD
0.1 PI-D 0.1 PD*PI
I-PD
PD*PI
0.05 0.05
0 0
0 0.5 1 1.5 0 0.5 1 1.5
Time(sec) Time(sec)
Figure 13. Servo system response for wPj = 0 deg sec Figure 16. Servo system response for wPj = 15 deg sec
165 M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170
0.45
0.5
0.4
0.35 0.4
0.3
0.3
0.25
input input
0.2
PI 0.2 PI
0.15 PI-D PI-D
I-PD I-PD
0.1 PD*PI 0.1 PD*PI
0.05
0
0 0 0.5 1 1.5
0 0.5 1 1.5
Time(sec)
Time(sec)
Figure 17. Servo system response for wPj = 20 deg sec Figure 20. Servo system response for w Pj = 35 deg sec
0.3
T he angular s peed W Ae (rad/s ec )
0.4 0.25
0.2
0.3
input
0.15
PI
input PI-D
0.2 0.1 I-PD
PI
PI-D PD*PI
I-PD 0.05
0.1 PD*PI
0
0 0.5 1 1.5
Time(sec)
0
0 0.5 1 1.5
Time(sec) Figure 21. Servo system response for wPj = 0deg sec
Figure 18. Servo system response for wPj = 25deg sec
0
0 0.5 1 1.5
Time(sec) This drawback of the I-PD controller can be solved if
the coefficient KP is readjusted. Therefore, the same
Figure 19. Servo system response for wPj = 30 deg sec
M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170 166
simulation tests have been repeated utilizing another The time response of servo system
0.5
value for the proportional gain ( KP = 0.7 ) and the results
0.45
are indicated in Table 4 and Figures (21-28).
0.4
0.05
0.2
0
input 0 0.5 1 1.5
0.15 Time(sec)
PI
PI-D
0.1 I-PD Figure 25. Servo system response for w Pj = 20 deg sec
PD*PI
0.05
0
0 0.5 1 1.5
Time(sec) The time response of servo system
Figure 22. Servo system response for wPj = 5deg sec 0.5
0.45 0.4
0.4
0.35 0.3
The angular speed WAe (rad/sec)
input
0.3
PI
0.2
0.25 PI-D
I-PD
0.2 PD*PI
input 0.1
PI
0.15
PI-D
I-PD
0.1
PD*PI 0
0 0.5 1 1.5
0.05 Time(sec)
0.35
The angular speed WAe (rad/sec)
0.4
0.3
0.25 0.3
input
0.2
input PI
PI 0.2
PI-D
0.15
PI-D I-PD
I-PD PD*PI
0.1
PD*PI 0.1
0.05
0
0
0 0.5 1 1.5 0 0.5 1 1.5
Time(sec) Time(sec)
Figure 24. Servo system response for wPj = 15 deg sec Figure 27. Servo system response for w Pj = 30 deg sec
167 M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170
0.5
Furthermore, I-PD controller does not require advanced
0.4 mathematics to design and can be easily adjusted (or
"tuned") to the desired application, unlike more
0.3
input
complicated control algorithms based on optimal control
0.2
PI theory. Based on what has been carried out above, two
PI-D
I-PD observations can be highlighted:
0.1 PD*PI v Simulation results indicated in Tables 3 and 4
indicate that the coefficient KP of the I-PD
0
0 0.5
Time(sec)
1 1.5
controller is the key parameter that guarantees an
acceptable performance when it is correctly
Figure 28. Servo system response for wPj = 35deg sec
readjusted.
v Figure 1 shows that the gimbal can be rotated about
the gimbal e-axis which is identical with the base j-
w Pk wPj wPi
axis. Thus, it can be concluded that the rate w Pj is
TD e the most dominant variable which directly affects the
K P = 0.96 + gimbal system performance.
+ E Tm + T wAe + e& Therefore, based on these observations, the servo
- - control system introduced in Figure 11 is modified so
K P = 0.7 that the controller is reconstructed utilizing two parallel
I-PD controllers, one with KP = 0.7 for the range
wPj = [ 0 - 15] deg sec and the other with K P = 0.96 for the
wPj range w Pj = [16 - 35 ] deg sec . In the modified controller,
the value wPj = 15 deg sec is regarded as a threshold
Figure 29. Servo system with modified I-PD controller value which is used to change the utilized controller
according to the value of wPj . This modification
The time response of servo system with I-PD controller improves the control system performance and provides
0.45
good adaptability for the gimbal system against changes
0.4 of the base angular rates which are considered important
0.35
operational conditions that form a significant source of
The angular speed WAe (rad/sec)
0.05
6. CONCLUSION
0
0 0.5 1 1.5
Time(sec)
In this paper, a servo control system for one axis gimbal
Figure 30. Servo system response using modified I-PD mechanism is introduced. The gimbal motion equation
is derived by taking into account the torque disturbance
results from the base angular motion. Then, the
stabilization loop is constructed. The conventional PID
Even after readjusting operation, the PID, PI-D, and controller, P-ID controller, PD*PI controller, and I-PD
PD*PI controllers are still disable to give the desired controller are investigated and utilized in the
response. While the readjusted I-PD controller improves stabilization loop structure. The servo control system
the system performance especially decreasing the obtained is simulated using MATLAB/Simulink tool
settling time when wPj = 0 - 15deg sec . and many simulation tests are carried out. The results of
M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170 168
each controller are discussed and analyzed in terms of 10. Rigatos, G. G., "Adaptive fuzzy control of dc motors using state
performance criteria. It can be seen that PID, P-ID, and and output feedback", Electric Power Systems Research, Vol.
79, No. 11, (2009), 1579-1592.
PD*PI controllers have the same performance where all
11. Rigatos, G. G., "Particle and kalman filtering for state estimation
of them create an increased overshoot whenever the and control of dc motors", ISA Transactions , Vol. 48, No. 1,
angular rate wPj increases. On the other hand, the I-PD (2009), 62-72.
structure absolutely prevents the transfer of reference 12. Lee, H.-P. and Yoo, I.-E., "Robust control design for a two-axis
gimbaled stabilization system", in Aerospace Conference, IEEE.,
value discontinuities to control signal and the control (2008), 1-7.
signal has less sharp changes than other structures. 13. Shuang, Y. and Yanzheng, Z., "A new measurement method for
Therefore, this controller realizes acceptable unbalanced moments in a two-axis gimbaled seeker", Chinese
performance with less overshoot and suitable settling Journal of Aeronautics, Vol. 23, No. 1, (2010), 117-122.
time. Thus, the servo control system is reconstructed 14. Hasturk, O., Erkmen, A. M. and Erkmen, ., "Proxy-based
utilizing the modified I-PD controller. sliding mode stabilization of a two-axis gimbaled platform",
Target, Vol. 3, No. 4. (2011)
15. Khodadadi, H., Motlagh, M. R. J. and Gorji, M., "Robust control
and modeling a 2-dof inertial stabilized platform", in Electrical,
7. REFERENCES Control and Computer Engineering (INECCE), International
Conference on, IEEE. (2011), 223-228.
1. Masten, M. K., "Inertially stabilized platforms for optical 16. Tang, K., Huang, S., Tan, K. and Lee, T., "Combined pid and
imaging systems", Control Systems, IEEE, Vol. 28, No. 1, adaptive nonlinear control for servo mechanical systems",
(2008), 47-64. Mechatronics, Vol. 14, No. 6, (2004), 701-714.
2. Hilkert, J., "Inertially stabilized platform technology concepts 17. Malaysia, M., "Non-linear modeling and cascade control of an
and principles", Control Systems, IEEE, Vol. 28, No. 1, (2008), industrial pneumatic actuator system", Australian Journal of
26-46. Basic and Applied Sciences, Vol. 5, No. 8, (2011), 465-477.
3. Singh, R., Hanmandlu, M., Khatoon, S. and Madsu, V. K., 18. Malhotra, R., Singh, N. and Singh, Y., "Design of embedded
"Modeling and simulation of the dynamics of a large size hybrid fuzzy-ga control strategy for speed control of dc motor: A
stabilized gimbal platform assembly", Vol. 1, (2008), 111-119. servo control case study", International Journal of Computer
Applications, Vol. 6, No. 5, (2010), 37-46.
4. Rue, A., "Precision stabilization systems", Aerospace and
Electronic Systems, IEEE Transactions on, No. 1, (1974), 34- 19. Abjadi, N., Soltani, J., Pahlavaninizhad, M. and Askari, J., "A
42. nonlinear adaptive controller for speed sensorless pmsm taking
the iron loss resistance into account", in Electrical Machines and
5. Ekstrand, B., "Equations of motion for a two-axes gimbal Systems, ICEMS Proceedings of the Eighth International
system", Aerospace and Electronic Systems, IEEE Conference on, IEEE. Vol. 1, (2005), 188-193.
Transactions on, Vol. 37, No. 3, (2001), 1083-1091.
20. Khajorntraidet, C. and Srisertpol, J., "Torque control for dc
6. Otlowski, D. R., Wiener, K. and Rathbun, B. A., "Mass servo motor using adaptive load torque compensation", in
properties factors in achieving stable imagery from a gimbal Proceedings of the 9th WSEAS international conference on
mounted camera", in SPIE Defense and Security Symposium, System science and simulation in engineering, World Scientific
International Society for Optics and Photonics. (2008), 69460B- and Engineering Academy and Society (WSEAS). (2010), 454-
69460B-13. 458.
7. Makableh, Y., "Efficient control of dc servomotor systems using 21. Akar, M., Hekim, M., Temiz, I. and Dogan, Z., "The speed and
backpropagation neural networks", (2011). torque control of direct current servo motors by using cascade
8. Korayem, M. H., Ahmadi, R., Jaafari, N., Jamali, Y. and fuzzy pi controller", Przegld Elektrotechniczny Selected full
Kiomarsi, M., "Design, modeling, implementation and Texts, Vol. 88, No. 5b, (2012), 123-127.
expermental analysis of 6r robot", International Journal of 22. Masten, M. K. and Hilkert, J., "Electromechanical system
Engineering, Vol. 21, (2008), 71-78. configurations for pointing, tracking, and stabilization
9. Akar, M. and Temiz, I., "Motion controller design for the speed applications", in Technical Symposium Southeast, International
control of dc servo motor", International Journal of Applied Society for Optics and Photonics. (1987), 75-87.
Mathematics and Informatics, Vol. 4, No. 1, (2007), 131-137. 23. Stokum, L. A. and Carroll, G. R., "Precision stabilized platform
for shipborne electro-optical systems", SPIE, Vol. 493, (1984),
414-425.
169 M. Abdo et al. / IJE TRANSACTIONS A: Basics Vol. 27, No. 1, (January 2014) 157-170
Modeling, Control and Simulation of Cascade Control Servo System for One Axis
Gimbal Mechanism
PAPER INFO
Paper history: .
Received 27 March 2013
Received in revised form 27 April 2013
.
Accepted 20 June 2013 - - )(Cascade PID
. PID
Keywords:
Gimbal System PID .
Rtae Gyro
Line of Sight MATLAB/Simulink .
Stabilization Loop
Servo System .
DC Motor
I-PD .
I-PD .
.
.
.
doi: 10.5829/idosi.ije.2014.27.01a.18