Professional Documents
Culture Documents
CCC 2008 2
CCC 2008 2
CCC 2008 2
Abstract: In this paper, a chattering free sliding mode control (SMC) for a robot manipulator including PID part with a
fuzzy tunable gain is designed. The main idea is that the robustness property of SMC and good response characteristics
of PID are combined with fuzzy tuning gain approach to achieve more acceptable performance. For this purpose, in the
first stage, a PID sliding surface is considered such that the robot dynamic equations can be rewritten in terms of sliding
surface and its derivative and the related control law of the SMC design will contain a PID part. The stability guarantee
of this sliding mode PID-controller is proved by a lemma using direct Lyapunov method. Then, in the second stage, in
order to decrease the reaching time to the sliding surface and deleting the oscillations of the response, a fuzzy tuning
system is used for adjusting both controller gains including sliding controller gain parameter and PID coefficient.
Finally, the proposed methodology is applied to a two-link robot manipulator including model uncertainty and external
disturbances as a case study. The simulation results show the improvements of the results in the case of using the
proposed method in comparison with the conventional SMC.
Key Words: Sliding Mode Control, Robot manipulator, PID control, Fuzzy control, Lyapunov theory.
In the following, H (q ) , C (q, q ) and G (q ) are shown by This subject is proved in the following lemma.
H, C, and G, respectively. Lemma- In the SMC design of a system with dynamic
equation (1) and sliding surface (3), if the control input τ is
3 SLIDING MODE CONTROL WITH PID selected as (6), by considering F as (9) and
The objective of tracking control is design a control law for K = diag ( K11 , K 22 , , K nn ) with the following
obtaining the suitable input torque τ such the position components:
vector q can track the desired trajectory q d . In this regard, K ii = [F + K v s + TD + η ]i , i = 1,2, , n (11)
the tracking error vector is defined as follows: Then, the sliding condition (10) is satisfied by equation (4).
e = qd − q (2) Proof: Consider the following Lyapunov function
In order to apply the SMC, the sliding surface is considered candidate:
as the relation (3) which contains the integral part in 1 T
addition to the derivative term: V=s Ms (12)
2
t
s = e + λ1e + λ 2 edt (3) Since M is positive definite, for s ≠ 0 we have V > 0 and
0 by differentiating of the relation (12) and regarding the
where λi is diagonal positive definite matrix. Therefore, symmetric property of M, it can be written:
s = 0 is a stable sliding surface and e → 0 as t → ∞ . The 1 T
V= s Ms + s T Ms (13)
robot dynamic equations can be rewritten based on the 2
sliding surface (in term of filtered error) as follows: By substituting (4) in (13) and considering that
Ms = −Cs + f + τ d − τ (4)
s T ( M − 2C ) s = 0 , we have:
Where
1 T
t V= s Ms − s T Cs + s T ( f + τ d − τ )
f = M (q d + λ1e + λ 2 e) + C (q d + λ1e + λ 2 edt ) + G 2 (14)
0
T
(5) = s ( f +τ d −τ )
Now, the control input can be considered as follows: By replacing the relation (6) in (14), V can be rewritten as:
τ = fˆ + K v s + K sgn( s ) (6) V = s T ( f + τ d − fˆ − K v s − K sgn( s ))
Where n
~ (15)
t = s T ( f + τ d − K v s) − K ii s i
fˆ = Mˆ (q d + λ1e + λ 2 e) + Cˆ (q d + λ1e + λ 2 edt ) + Gˆ
0 i =1
(7) Since the following inequality (16) is valid and regarding
is an estimation of f and the relation (11), we have:
t ~
K v s = K v e + K v λe + K v λ edt is the outer PID F + K v s + TD ≥ f + τ d − K v s (16)
0
tracking loop, and K v , K are diagonal positive definite ~
K ii ≥ [ f + τ d − K v s ] i + η i (17)
matrices and are defined such that the stability conditions
are guaranteed. The sgn(s) is also the sign function. Finally, it can be concluded that:
We have also: n
~ ~ ~ t ~
V ≤− η i si (18)
f = M (q d + λ1e + λ 2 e) + C (q d + λ1e + λ 2 edt ) + G ≤ F i =1
0
This indicates that V is a Lyapunov function and the sliding
(8)
condition (10) has been satisfied.
~ ~ ~
where f = f − fˆ , M = M − Mˆ , C = C − Cˆ ,and The use of sign function in the control law leads to high
~ oscillations in control torque which is undesired
G = G − Gˆ . F can also be selected as the following
phenomenon and is called chattering. To overcome this
relation:
drawback, there are some solutions which one of them is
~ ~ t ~ using the following saturation function instead of sign
F = M (q d + λ1e + λ 2 e) + C (q d + λ1e + λ 2 edt + G
0 function in the discontinuous part of the control law:
(9)
In order to reach the system states (e, e) to the sliding
surface s = 0 in a limited time and remain there, the control
1 s ≥ϕ N Z P
1
s s
sat = −ϕ < s < ϕ (19)
ϕ ϕ 0.8
Degree of membership
−1 s ≤ −ϕ
0.6
-1 -0.5 0 0.5 1
As it was mentioned before, by using a high gain in SMC inpu variable sd
(K), the sensitivity of the controller to the model (b)
uncertainties and external disturbances can be reduced.
Continue Fig. 1: The membership functions for b) input s
Moreover, a high gain in PID part of the control system
( K v ) can reduce the reaching time to sliding surface and
tracking error. However, increasing the gain causes the 1
S M B
Degree of membership
the distance of the states to the sliding surface, a more
0.6
acceptable performance can be achieved. In other words, the
value of gain should be selected high when the state 0.4
input1(N.m)
100
where α = (m1 + m2 )a12 , β = m 2 a 22 , γ = m 2 a1 a 2 , 50
and lengths of the first and second links, respectively. The -50
0 2 4 6 8 10
masses are assumed to be in the end of the arms and the time(sec)
gravity acceleration is considered g = 9.8 . Moreover, the 100
masses are considered with 10% uncertainty as follow:
input2(N.m)
50
m1 = m10 + ∆m1 , ∆m1 ≤ .4
(25) 0
m 2 = m 20 + ∆m 2 , ∆m 2 ≤ .2
-50
0 2 4 6 8 10
where m10 = 4 and m 20 = 2 , and M̂ , Ĉ , and Ĝ are time(sec)
estimated. The desired state trajectory is:
1 − cos π t Fig. 4: The control inputs in the case of using conventional SMC
qd = (26)
2 cos π t
0.15
and the disturbance torque is considered as follows:
0.1
Error1(rad)
0.5 sin 2πt 0.05
τd = (27)
0.5 sin 2πt 0
0.5 -0.05
0 2 4 6 8 10
which leads to TD = .
0.5 time(sec)
2
The design parameters are determined as follow: 1.5
Error2 (rad)
15 0 40 0 1
λ1 = , λ2 = (28) 0.5
0 15 0 40 0
The values of the ϕ and η are selected as -0.5
0 2 4 6 8 10
and N v are selected as follow: Fig. 5: The tracking errors in the case of using Fuzzy SMC-PID
50 0 5 0
N= , Nv = (29) 200
0 5 0 10
input1 (N.m)
50
SMC-PID are also provided in figures (5), and (6).
0
-50
0.15
Error1(rad)
0.1 -100
0 2 4 6 8 10
0.05
time(sec)
0
-0.05
0 2 4 6 8 10
time(sec) Fig. 6: The control inputs in the case of using Fuzzy SMC-PID
2
1.5 As it is seen in these figures, the proposed fuzzy SMC-PID
Error2(rad)
0.005
0
[5] L. X. Wang, A Course in Fuzzy Systems and Control,
Prentice Hall, NJ, 1997.
-0.005
[6] C. C. Lee, Fuzzy Logic in Control Systems: Fuzzy Logic
-0.01
0 2 4 6 8 10 Controller-Part I, IEEE Trans. Sys. Man. and Cyb. Vol. 20,
time(sec) No. 2, 404-418, 1990.
-3
5
x 10 [7] C. C. Lee, Fuzzy Logic in Control Systems: Fuzzy Logic
Controller-Part II, IEEE Trans. Sys. Man. and Cyb. Vol. 20,
Error2(rad)
0.5
0 [14] Y. C. Huang, and T. H. S. Li, Fuzzy Terminal Sliding Mode
Controller for Robotic Manipulators, IEEE Int. Conf. on
-0.5
Mechatronics, 858-863, 2005.
-1
0 2 4 6 8 10 [15] Q. P. Ha, D. C. Rye, and H. F. Durrant-Whyte, Fuzzy Moving
time(sec) Sliding Mode Control with Application to Robotic
Manipulators, Automatica, Vol. 35, 607-616, 1999.
Fig. 8: The enlargement of the tracking errors in the case of using [16] H. Javaheri, and G. R. Vossoughi, Sliding Mode Control with
Fuzzy SMC-PID Online Fuzzy Tuning: Application to a Robot Manipulator,
IEEE Int. Conf. on Mechatronics & Automation, 1357-1362,
2005.
6 CONCLUSION [17] T. C. Kuo, Y. J. Huang, A Sliding mode PID-Controller
In this paper, design of a sliding mode control with a PID Design for Robot Mnipulator, IEEE Conf. On Computational
Intelligence in Robotics and Automation, 625-629, 2005.
loop for robot manipulator was presented in which the gain
of both SMC and PID was tuned on-line by using fuzzy [18] I. Eker, Sliding mode control with PID sliding surface and
experimental application to an electromechanical plant, ISA.
approach. Then the stability guarantee of the system was
Trans. Vol. 45, No. 1, 109-118, 2006.
proved by direct Lyapunov method. The proposed
methodology in fact tries to use the advantages of the SMC,
PID and Fuzzy controllers simultaneously, i. e., the
robustness against the model uncertainty and external
disturbances, quick response, and on-line automatic gain
tuning, respectively. Finally, the simulation results of
applying the proposed methodology to a two-link robot
were provided and compared with corresponding results of
the conventional SMC which show the improvements of
results in the case of using the proposed method.
REFERENCES
[1] M. W. Spong, and M. Vidiasagar, Robot Dynamics and
Control, Wiley, New York, 1989.
[2] J. J. Slotine, and W. Li, Applied Nonlinear Control,
Englewood Cliffs, NJ: Prentice Hall, 1991.
[3] W. Perruquetti, and J. P. Barbot, Sliding Mode Control in
Engineering. Marcel Dekker, Inc. New York, 2002.