Professional Documents
Culture Documents
Vibration Control Strategy For Flexible Joint Manipulator A Fuzzy Logic Control Approach
Vibration Control Strategy For Flexible Joint Manipulator A Fuzzy Logic Control Approach
M.A. Ahmad, R.M.T. Raja Ismail, M.S. Ramli, A.N.K. Nasir, N.M. Abd Ghani And N.H. Noordin
Abstract - This paper presents investigations into the development of input shaping techniques for swaying control of a double-
pendulum-type overhead crane (DPTOC) system. A nonlinear DPTOC system is considered and the dynamic model of the
system is derived using the Euler-Lagrange formulation. An unshaped bang-bang input force is used to determine the
characteristic parameters of the system for design and evaluation of the input shaping control techniques. The positive and
modified specified negative amplitude (SNA) input shapers with the derivative effects respectively are designed based on the
properties of the system. Simulation results of the response of the DPTOC system to the shaped inputs are presented in time and
frequency domains. Performances of the control schemes are examined in terms of sway angle reduction and time response
specifications. Finally, a comparative assessment of the proposed control techniques is presented and discussed.
Keywords: Double-pendulum-type overhead crane, anti-sway control, positive input shaping, negative input shaping.
In another issue, using input shaper scheme, a swing angle, 2 is the load swing angle, l1 and l2 are the
response without sway can be achieved, however, with a cable length of the hook and load, respectively, and F is
slight time delay approximately equal to the length of the the trolley drive force. In this simulation, the hook and
impulse sequence. With more impulses, the system load can be considered as point masses.
becomes more robust to sway mode parameter changes,
but this will result in longer delay in the system response.
To reduce the delay in the system response, negative
amplitude input shapers have been introduced and
investigated in vibration control. By allowing the shaper
to contain negative impulses, the shaper duration can be
shortened, while satisfying the same robustness constraint.
A significant number of negative shapers for vibration
control have also been proposed. These include negative
unity-magnitude (UM) shaper, specified-negative-
amplitude (SNA) shaper, negative zero-vibration (ZV)
shaper, negative zero-vibration-derivative (ZVD) shaper
and negative zero-vibration-derivative-derivative (ZVDD)
shaper (Mohamed et al., 2006).
This paper presents investigations into the
development of control schemes for anti-swaying control
Figure 1: Description of the DPTOC system.
of a double-pendulum-type overhead crane (DPTOC)
system. A nonlinear DPTOC system is considered and the
dynamic model of the system is derived using the Euler- III. DYNAMIC MODELING OF THE DOUBLE-
Lagrange formulation. An unshaped bang-bang force PENDULUM-TYPE OVERHEAD CRANE
input is used to determine the characteristic parameters of
the system for design and evaluation of the input shaping This section provides a brief description on the
control techniques. The positive zero-sway-derivative- modeling of the DPTOC system, as a basis of a simulation
derivative (PZSDD) and new modified specified negative environment for development and assessment of the feed-
amplitude zero-sway-derivative-derivative (SNA-ZSDD) forward control techniques. The Euler-Lagrange
input shapers are then designed based on the properties of formulation is considered in characterizing the dynamic
the system for anti-sway control. Simulation results of the behavior of the crane system incorporate payload.
response of the DPTOC system to the shaped inputs are By Lagrange’s equations, the dynamic model of the
presented in time and frequency domains. Performances of DPTOC system, shown in Figure 1, is assumed to have the
the shapers are examined in terms of swing angles following form (Spong, 1997)
reduction and time response specifications. Moreover, a
comparative assessment of the effectiveness of the M ( q ) q C ( q , q ) q G ( q ) (1)
positive and negative input shapers in suppressing sway of
the DPTOC system is discussed. where the matrices M (q) 33 , C (q, q ) 33 , and
The rest of this paper is structured in the following
manner. The next section provides a brief description of G(q) 3 represent the inertia, Centrifugal-Coriolis
the double pendulum-type overhead crane system terms, and gravity, respectively, and are defined as
considered in this study. Section 3 describes the modelling
of the system derived using Euler-lagrange formulation m m1 m2 (m1 m2 )l1 cos1
whilst Section 4 describes the design of both positive and M (q) (m1 m2 )l1 cos1 (m1 m2 )l12
negative input shaping schemes. Implementation results
m2 l 2 cos 2 m2 l1l 2 cos(1 2 )
and comparative assessment is reported in Section 5.
Finally, concluding remarks are offered in the last section. m 2 l 2 cos 2
m 2 l1l 2 cos( 1 2 ) (2)
II. THE DOUBLE-PENDULUM-TYPE OVERHEAD m 2 l 22
CRANE SYSTEM
0 ( m1 m 2 )l11 sin 1
The DPTOC system with its hook and load
C ( q , q ) 0 0
considered in this work is shown in Figure 1, where x is 0
the trolley position, m is the trolley mass, and m1 and m2 m 2 l1l 21 sin( 1 2 )
are the hook and load mass respectively. 1 is the hook
N
Ai n
V1 exp n (t N t i ) cos( d t i ) ;
Amplitude
Amplitude
2
A1 i 1 1
A2
* N
Ai n
exp n (t N t i ) sin( d t i )
Time Time
V2
2
Unshaped Input Input Shaper Shaped input i 1 1
Figure 2: Illustration of input shaping technique.
To achieve zero vibration after the last impulse, it is
Generally, a vibratory system of any order can be required that both V1 and V2 in Equation (6) are
modelled as a superposition of second order systems each independently zero. This is known as the zero residual
with a transfer function vibration constraints. In order to ensure that the shaped
command input produces the same rigid body motion as
2 the unshaped reference command, it is required that the
G ( s) sum of amplitudes of the impulses is unity. This yields the
s 2 2s 2 unity amplitude summation constraint as
In order to avoid response delay, time optimality B. Modified SNA Input Shaper
constraint is utilised. The first impulse is selected at time In order to achieve higher robustness for positive
t1 = 0 and the last impulse must be at the minimum, i.e. input shaper, the duration of the shaper is increased and
min (tN) The robustness of the input shaper to errors in thus, increases the delay in the system response. By
natural frequencies of the system can be increased by allowing the shaper to contain negative impulses, the
taking the derivatives of V1 and V2 to zero. Setting the shaper duration can be shortened, while satisfying the
derivatives to zero is equivalent to producing small same robustness constraint. To include negative impulses
changes in vibration corresponding to the frequency in a shaper requires the impulse amplitudes to switch
changes. The level of robustness can further be increased between 1 and -1 as
by increasing the order of derivatives of V1 and V2 and set
them to zero. Thus, the robustness constraints can be Ai ( 1) i 1 ; i = 1,…, n (10)
obtained as
The constraint in (10) yields useful shapers as they
d iV1 d iV2 can be used with a wide variety of inputs. However, the
0; 0 (8)
d n i d n i increase in the speed of system response achieved using
the SNA input shapers is at the expense of some tradeoffs
Both the positive and SNA input shapers are and penalties. The shapers containing negative impulses
designed by considering the constraints equations. The have tendency to excite unmodeled high modes and they
following section will further discuss the design of the are slightly less robust as compared to the positive
positive and SNA input shapers. shapers. Besides, negative input shapers require more
actuator effort than the positive shapers due to high
A. Positive Input Shaper changes in the set-point command at each new impulse
The requirement of positive amplitudes for the input time location.
shapers has been used in most input shaping schemes. The To overcome the disadvantages, the modified SNA
requirement of positive amplitude for the impulses is to input shaper is introduced, whose negative amplitudes can
avoid the problem of large amplitude impulses. For the be set to any value at the centre between each normal
case of positive amplitudes, each individual impulse must impulse sequences. In this technique, the previous SNA
be less than one to satisfy the unity magnitude constraint. input shaper (Mohamed et al., 2006) has been modified by
In order to increase the robustness of the input shaper to locating the negative amplitudes at the centre between
errors in natural frequencies, the positive zero-sway- each positive impulse sequences with even number of total
derivative-derivative (PZSDD) input shaper, is designed impulses. This will result the shaper duration to one-fourth
by solving the derivatives of the system vibration of the sway period of an undamped system as shown in
equation. This yields a four-impulse sequence with Figure 3. The modified SNA-ZSDD shaper is applied in
parameter as this work by adding more negative impulses in order to
enhance the robustness capability of the controller while
2 3 increasing the speed of the system response. Moreover, by
t1 = 0, t2 = , t3 = , t4 = considering the form of modified SNA-ZSDD shaper
d d d shown in Figure 3, the amplitude summation constraints
equation can be obtained as
1 3K
A1 , A2
1 3K 3K 2 K 3 1 3K 3K 2 K 3 2a + 2c – 2b – 2d = 1(11)
sway frequencies for both hook cable and load cable were
0.12
obtained as 0.4883 Hz, 1.099 Hz and 1.587 Hz for the first )
three modes of sway. m
n
( 0.1
Unshaped 0 Unshaped
0.05 PZSDD PZSDD
SNA-ZSDD -20 SNA-ZSDD
0.04
) -40
0.03
B
) d(
d 0.02 yt -60
a(r
si
el n
g 0.01 e -80
n Dl
a ar
g 0 t
ni c -100
e
p
w
s -0.01 S
k r -120
o e
o w
H -0.02 o
P -140
-0.03
-160
-0.04
-180
-0.05 0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
0 2 4 6 8 10 12 14 16 18 20
Frequency (Hz)
Time (s)
Figure 5: Response of the hook swing angle. Figure 8: Spectral density of the load swing angle.
Unshaped 90
0.05 PZSDD
SNA-ZSDD 80
0.04
70
0.03 )
B
) d
( 60
d 0.02 n
a(r
io
el
g 0.01 ct 50
n u
a d
g e PZSDD
0 R 40
ni f
w
s l o SNA‐ZSDD
d
-0.01 e
v 30
a
o Le
L -0.02 20
-0.03
10
-0.04
0
-0.05 Mode 1 Mode 2 Mode 3
0 2 4 6 8 10 12 14 16 18 20
Time (s) Mode of Sway
Figure 6: Response of the load swing angle. Figure 9: Level of sway reduction for hook swing angle.
0 Unshaped
PZSDD
-20 SNA-ZSDD
) -40
B
d(
yt -60
si
n
e -80
D
l
ar
ct -100
e
p
S
r -120
e
w
o
P -140
-160
-180
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5
Frequency (Hz)
Table 1: Level of sway reduction of the hoisting angle of the pendulum and specifications of trolley position response.
90 6
80
5
70
)
B
d
( 60
n 4
o
it
c 50
u
d s) (
e PZSDD e3 PZSDD
f 40
R
im
o
l SNA‐ZSDD T SNA‐ZSDD
ve 30
e
L 2
20
10 1
0
Mode 1 Mode 2 Mode 3 0
Mode of Sway Rise time Settling time
Figure 10: Level of sway reduction for load swing angle. Figure 11: Time response specification.
[4] Liu, D.T., Guo, W.P. and Yi, J.Q. (2006) Dynamics and Stable
VI. CONCLUSION Control for a Class of Underactuated Mechanical Systems. Acta
Automatica Sinica, Vol. 32, No. 3, pp. 422-427.
The development of input shaping with different [5] Mohamed, Z., Martins, J.M., Tokhi, M.O., Costa , J.S. and Botto,
polarities for sway control of a DPTOC system has been M.A. (2005). Vibration control of a very flexible manipulator
presented. The performances of the control schemes have system. Control Engineering Practice, Vol. 13, pp.267-277.
[6] Mohamed, Z., Chee, A.K., Mohd Hashim, A.W I., Tokhi, M.O.,
been evaluated in terms of level of sway reduction and Amin, S. H. M. and Mamat, R. (2006). Techniques for vibration
time response specifications. Acceptable anti-sway control of a flexible manipulator. Robotica, 24, 499-511.
capability has been achieved with both control strategies. [7] Robertson, M.J. and Singhose, W.E. (2005). Closed-Form
A comparison of the results has demonstrated that the Deflection-Limiting Commands. American Control Conference,
Portland, USA, pp.2104-2109.
positive shapers provide higher level of sway reduction as [8] Singer, N.C. and Seering, W.P. (1990) Preshaping Command
compared to the cases using modified negative (SNA) Inputs to Reduce System Vibration. Journal of Dynamic Systems,
shapers. By using the modified negative input shapers Measurement and Control, 112, pp.76-82.
(SNA-ZVDD), the speed of the response is slightly [9] Singhose, W., Crain, E. and Seering, W. (1997) Convolved and
Simultaneous Two-Mode Input Shapers. IEEE Proc. Control
improved in term of settling time at the expenses of Theory Appl., Vol. 144, No. 6, pp.515-520.
decrease in the level of sway reduction. It is concluded [10] Singhose, W. and Singer, N. (1996). Effects of Input Shaping on
that the proposed controllers are capable of reducing the Two-Dimensional Trajectory Following. IEEE Trans. on Robotics
system sway while maintaining the steady state position and Automation, Vol. 12, No. 6, pp.881-887.
[11] Singhose, W.E., Singer, N.C. and Seering, W.P. (1995).
of the trolley. Comparison of command shaping methods for reducing residual
vibration. Proceedings of European Control Conference, Rome,
pp. 1126-1131.
REFERENCES [12] Smith, O.J.M. (1957). Posicast Control of Damped Oscillatory
[1] Gürleyük, S.S. (2007). Optimal Unity-Magnitude Input Shaper Systems. Proceedings of the IRE, pp.1249-1255.
Duration Analysis. Archive of Applied Mechanics, Vol.77, No.1, [13] Spong, M.W. (1997). Underactuated Mechanical Systems, Control
pp.63-71. Problems in Robotics and Automation. London: Springer-Verlag.
[2] Gürleyük, S.S. and Cinal, Ş. (2007). Robust Three-Impulse [14] Tokhi, M.O. and Poerwanto, H. (1996). Control of vibration of
Sequence Input Shaper Design. J. of Vibration and Control, Vol. flexible manipulators using filtered command inputs. Proceedings
13, No.12, pp.1807-1818. of international congress on sound and vibration, St. Petersburg,
[3] Kim, D. and Singhose, W. (2006). Reduction of Double-Pendulum Russia,, pp. 1019–1026.
Bridge Crane Oscillations. The 8th International Conference on [15] Yang, T-S., Chen, K-S., Lee, C-C. and Yin, J-F. (2006).
Motion and Vibration Control, pp. 300-305. Suppression of Motion-Induced Residual Vibration of a Cantilever