Professional Documents
Culture Documents
A New Terminal Sliding Mode Control For Robotic Manipulators - 2008
A New Terminal Sliding Mode Control For Robotic Manipulators - 2008
1. Institute of Automation, Shanghai Jiao Tong University, Shanghai 200240, P.R. China
2. College of Mechanical & Electronic Engineering, China University of Petroleum, P.R. China
3. School of Mechanical Engineering, Shanghai Jiao Tong University, Shanghai 200240, P.R. China.
* Corresponding Author’s E-mail: syli@sjtu.edu.cn
Abstract: In this paper, a new terminal sliding mode control approach is developed for robotic
manipulators. Unlike traditional terminal sliding mode control, the proposed approach can make system
states converge to zero in a finite time without requiring explicitly using of system dynamic model.
Theoretical analysis and simulation results are presented to illustrate the proposed approach. The controller
parameter tuning method is also proposed.
Lemma 1. Assume a1 > 0 , a2 > 0 and 0 < c < 1 , the has a unique solution. If y ( t ) is a solution of (13) on [t0 , t1 )
following inequality holds (Yu, Yu, Shirinzadeh, and Man, and V ( t ) is a solution of (12) on [t0 , t1 ) with V ( t0 ) ≤ y ( t0 ) ,
2005)
then V ( t ) ≤ y ( t ) for t0 ≤ t < t1 .
( a1 + a2 )
c
≤ a1c + a2c (4)
Lemma 4. Assume that a continuous positive definite
Lemma 2. Suppose a = [ a1 ," , an ] , a = a1 + " + an ,
T
function V ( t ) satisfies the differential inequality
1 V ( t ) ≤ −αV η ( t ) ∀t ≥ t0 V ( t0 ) ≥ 0 (14)
a = ( a12 + " + an2 ) 2 represent the Euclidean norm, then the
following inequality holds where α > 0 , 0 < η < 1 are constants. Then, for any given t0 ,
a ≤ a (5) V ( t ) satisfies the inequality
V 1−η ( t ) ≤ V 1−η ( t0 ) − α (1 − η )( t − t0 ) t0 ≤ t ≤ t1 (15)
Proof. For n = 1 , it is obvious that expression (5) is satisfied.
For n = 2 , from Lemma 1, the follow inequality can be and
derived V ( t ) = 0 , ∀t ≥ t1 (16)
1 1 1
(a2
1 +a 2
2 ) ≤ (a ) + (a )
2 2
1
2 2
2
2 (6)
with t1 given by
Therefore V 1−η ( t0 )
t1 = t0 + (17)
α (1 − η )
1
(a 2
1 +a 2 2
2 ) ≤ a1 + a2 (7)
Assume that for n = k the expression (5) holds, i.e., In this paper, ⋅ denotes norm of vector or matrix. The
1 vector norm is Euclidean norm and the matrix norm is
(a 2
1 + " + ak2 ) 2 ≤ a1 + " + ak (8) corresponding induced norm.
V ( t ) ≤ f (V ( t ) , t ) (12) μg > 0 .
(P4) M ( q ) − 2C ( q, q ) is skew-symmetric.
on [t0 , t1 ) if V ( t ) is continuous on [t0 , t1 ) and its derivative
The purpose of this paper is to develop a new TSMC
on [t0 , t1 ) satisfies (12). scheme for robotic manipulators such that both position and
velocity tracking error converge to zero in a finite time.
Lemma 3. Let f ( y ( t ) , t ) be continuous on an open
4. A NEW TSMC APPROACH WITHOUT REQUIRING
connected set D ∈ R 2 and assume that the initial value
SYSTEM DYNAMIC MODEL EXPLICITLY
problem for the scalar equation
y ( t ) = f ( y ( t ) , t ) , y ( t0 ) = y0 (13) In this section, a new TSMC control approach is proposed
for the tracking control of general n-link rigid robotic
9889
17th IFAC World Congress (IFAC'08)
Seoul, Korea, July 6-11, 2008
Now the new TSMC control law which dose not require
manipulators. The proposed approach can guarantee the the explicit use of the system dynamical model is designed as
system states to reach the pre-described terminal sliding follows
mode in a finite time, then the states converge to equilibrium τ = τ 0 + τ1 (28)
point along the terminal sliding mode in a finite time.
Let q d ( t ) ∈ R n be the desired joint position trajectory of ⎧⎪ τ 0 = K M r + K C q r + K G
⎨ (29)
⎪⎩τ 1 = − Ksig ( s ) − sign ( s ) ⎣⎡ Δ r + Δ q r + Δ ⎦⎤
ρ
robotic manipulator. The tracking error e ( t ) ∈ R n is defined
M C G
as
where the K M , K C and K G are positive definite diagonal
e (t ) = q (t ) − qd (t ) (19)
feedforward control gain matrices, which are used to
According to expression (1), the fast terminal sliding mode compensate the effect caused by M ( q ) , C ( q, q ) G ( q ) ,
can be written as respectively. Δ M , Δ C and Δ G are scalars, whose selection
s = e + Λ1e + Λ 2 sig ( e )
γ
(20)
will be discussed later. sign ( s ) = ⎡⎣ sign ( s1 ) ," , sign ( sn ) ⎤⎦ in
T
The time derivative of ith element of sig ( e ) is γ ei (29) is for a saturation control used to compensate for the
γ γ −1
ei .
nonlinear effect caused by the error between the feedforward
Because γ − 1 < 0 , the singularity will occur as ei = 0 . To control gains and modelling parameters, which was used in
avoid the singularity problem, the following definition literature (Slotine and Sastry, 1983) The Ksig ( s )
ρ
is
er ∈ R n is given as
feedback term to guarantee the system states to reach the
γ −1
⎧⎪γ e ei ei ≠ 0 terminal sliding mode in a finite time. K is positive definite
eri = ⎨ i i = 1," , n (21) diagonal feedback control gain matrix, the selection of ρ is
⎪⎩ 0 ei = 0
similar to γ .
Then the time derivative of s can be written as A control gain tuning strategy is proposed as follows. First,
s =
e + Λ1e + Λ 2 er (22) select the Δ M = 0 , Δ C = 0 and Δ G = 0 , tune the control
Remark 2. Due to the definition of er , the singularity gains K , K M , K C and K G using a trial and error method.
The controller at this time is a normal feedforward/feedback
problem will be avoided in the controller design. This will be
seen in the following of this section. control. Second, gradually increase Δ M , Δ C and Δ G from
The command vector and its time derivative are defined as zero to introduce the saturation control. Finally, the previous
follows tuned gains may need to be changed slightly, utilizing trail
and error method.
r = q d − Λ1e − Λ 2 sig ( e )
γ
(23) Theorem 1. Under assumptions (A1)-(A2), consider the
robotic manipulator dynamic equation (27) subject to the new
r = qd − Λ1e − Λ 2 er (24) TSMC control law (28)-(29). If the following conditions are
satisfied
The definitions of s and r lead to the following equation
s = q − r (25) ⎧ ΔM ≥ K M − M ( q )
⎪
⎪ C
⎨Δ q ≥ K q − C ( q , q )
C
s = q − r (26) (30)
⎪
Applying the definitions of s and r to dynamic equation ⎪⎩ ΔG ≥ K G − G ( q )
(18) yields
Then the position tracking error e ( t ) and velocity tracking
M ( q ) s + C ( q , q ) s = − M ( q ) r − C ( q , q ) r − G ( q ) + τ (27)
error e ( t ) will converge to zero in a finite time.
Without loss of generality, two technical assumptions are
Proof Consider the Lyapunov function candidate
made to pose the problem in a tractable manner.
1
(A1) The desired joint position trajectory q d ( t ) , the time V = sT Ms (31)
2
derivatives q d
(t ) and q ( t ) are bounded and smooth
d
9890
17th IFAC World Congress (IFAC'08)
Seoul, Korea, July 6-11, 2008
V ≤ s K M − M r + s K C q − C r + s K G − G
(38)
− sT Ksig ( s ) − s Δ M r − s Δ C q r − s Δ G
ρ
where K1 and K 2 are positive definite diagonal feedback
(
V ≤ − s Δ M − K M − M ) r control gain matrices. K 2 s can guarantee the fast converge
rate when the system states are far away from terminal
(
− s Δ C q − K C q − C )r (39) sliding mode.
− s (Δ )
− K G − G − sT Ksig ( s ) 5. AN ILLUSTRATIVE EXAMPLE
G ρ
According to properties (P1)-(P3), one can get the Consider an illustrative example of the two-link rigid
following inequalities robotic manipulator in (Yu, Yu, Shirinzadeh, and Man, 2005)
⎡α11 ( q2 ) α12 ( q2 ) ⎤ ⎡ q1 ⎤ ⎡− β ( q2 ) q1 −2β ( q2 ) q1 ⎤ ⎡ q1 ⎤ ⎡ γ 1 ( q1 , q2 ) ⎤ ⎡τ 1 ⎤
⎧ KM − M ≤ δ M ⎢ ⎥⎢ ⎥+⎢ ⎥⎢ ⎥+⎢ ⎥g =⎢ ⎥
⎪ α (
⎣ 21 2 q ) α q
⎦⎣ 2⎦ ⎣ 0 β ( q )
q q
2 ⎦⎣ 2⎦
γ ( q
⎣ 2 1 2 ⎦ , q ) ⎣τ 2 ⎦
⎪ C
22 2
⎨ K q − C ≤ δ q
C
(40) where
⎪ α11 ( q2 ) = ( m1 + m2 ) r12 + m2 r22 + 2m2 r1r2 cos ( q2 ) + J1
⎪⎩ KG −G ≤ δ G
α 21 ( q ) = α12 ( q2 ) = m2 r22 + m2 r1r2 cos ( q2 )
where δ > 0 , δ > 0 and δ > 0 are real numbers.
M C G
α 22 = m2 r22 + J 2
Under condition (30) and inequalities (40), if the Δ M , Δ C
and Δ G are chosen as β ( q2 ) = m2 r1r2 sin ( q2 )
⎧δ M ≤ Δ M γ 1 ( q1 , q2 ) = ( m1 + m2 ) r1 cos ( q2 ) + m2 r2 cos ( q1 + q2 )
⎪ C
⎨δ ≤ Δ
C
(41) γ 2 ( q1 , q2 ) = m2 r2 cos ( q1 + q2 )
⎪ δ G ≤ ΔG The parameter values were r1 = 1m , r2 = 0.8m , J1 = 5kgm ,
⎩
J 2 = 5km , m1 = 0.5kg and m2 = 1.5kg .
The following inequality can be given
The reference signals were given by
V ≤ − sT Ksig ( s )
ρ
(42)
q1d = 1.25 − ( 7 / 5 ) e − t + ( 7 / 20 ) e −4t
where q2d = 1.25 + e − t − (1/ 4 ) e −4t
n
− sT Ksig ( s ) = − ∑ si ki si sign ( si )
ρ ρ
The initial values of the system were selected as
i =1 q1 ( 0 ) = 1.0 , q2 ( 0 ) = 1.5 , q1 ( 0 ) = 0 and q2 ( 0 ) = 0 .
η
n
⎛ n 1 ⎞ The control parameters were chosen as
= −∑ ki si ≤ −α ⎜ ∑ msi2 ⎟ ≤ −αV η (43)
ρ +1
3
i =1 ⎝ i =1 2 ⎠ Λ1 = diag ([ 2.5, 2.5]) , Λ 2 = diag ([1.5,1.5]) , γ= ,
5
where η = (1 + p ) 2 , α = kmin ( 2 m ) , kmin = min {ki } . K M = diag ([ 0.014, 0.014]) K C = diag ([1.6,1.6])
η
, ,
By using (42) and (43), one can get
K G = [ 2, 2]
T
, Δ M = 0.13 , Δ C = 1.8 , Δ G = 2.1 ,
V + αV η ≤ 0 (44)
9
From Lemma 4, it follows that s will be 0 in a finite time. K1 = diag ([50,50]) , K 2 = diag ([50,50]) , ρ = .
11
This means that the system states will reach the terminal
sliding mode in a finite time Tr
9891
17th IFAC World Congress (IFAC'08)
Seoul, Korea, July 6-11, 2008
Fig. 1. The angle position tracking of joint 1 Fig. 4. The angle velocity tracking of joint 2
Fig. 2. The angle position tracking of joint 2 Fig. 5. The terminal sliding mode of joint 1 and joint 2
Fig. 3. The angle velocity tracking of joint 1 Fig. 6. The angle position error of joint 1 and joint 2
9892
17th IFAC World Congress (IFAC'08)
Seoul, Korea, July 6-11, 2008
ACKNOWLEDGEMENTS
This work was supported by the National Natural Science
Foundation of China (60774015 & 60534020), the High
Technology Research and Development Program of China
(2006AA04Z173), the Specialized Research Fund for the
Doctoral Program of Higher Education of China
(20060248001) and the Key Technology and Development
Program of Shanghai Science and Technology Department
(07JC14016).
Fig. 7. The angle velocity error of joint 1 and joint 2
REFERENCES
Barambones, O. and Etxebarria, V. (2002). Energy-based
approach to sliding composite adaptive control for rigid
robots with finite error convergence time. International
Journal of Control, 75(5), 352-359.
Bhat, S. P. and Bernstein, D. S. (1998). Continuous finite-
time stabilization of the translational and rotational
double integrators. IEEE Transactions on Automatic
Control, 43(5), 678-682.
Bhat, S. P. and Bernstein, D. S. (2000). Finite-time stability
of continuous autonomous systems. SIAM Journal on
Control and Optimization, 38(3), 751-766.
Feng, Y., Yu, X. and Man, Z. (2002). Non-singular terminal
sliding mode control of rigid manipulators, Automatica,
38(12), 2159-2167.
Fig. 8. The control input of joint 1 and joint 2
Feng, Y., Han, X., Wang, Y. and Yu, X. (2007). Second-
Fig. 1-4 show the position tracking and velocity tracking of order terminal sliding mode control of uncertain
joint 1 and joint 2. These figures show that the good tracking multivariable systems. International Journal of Control,
performance is achieved. Fig. 5 shows that the terminal 80(6), 856-862.
sliding modes converge to zero in a finite time. Fig. 6 and 7 Hong, Y., Yang, G., Cheng, D. and Spurgeon, S. (2005). A
show that the position error and velocity error converge to new approach to terminal sliding mode control design.
zero in a finite time. From Fig. 5-7, it can be seen that system Asian Journal of Control, 7(2), 177-181.
states reach terminal sliding mode in a finite time, then, Janardhanan, S. and Bandyopadhyay, B. (2006). On
converge to equilibrium along terminal sliding mode in a discretization of continuous-time terminal sliding mode.
finite time. Fig. 8 denotes the control inputs. Since the new IEEE Transactions on Automatic Control, 51(9), 1532-
definition of non-singular terminal sliding mode and 1536.
saturation technique are employed in controller design, the Man, Z. and Yu, X. (1997). Adaptive terminal sliding mode
control inputs are bounded and chattering free. tracking control for rigid robotic manipulators with
uncertain dynamics. JSME International Journal of
6. CONCLUSIONS Mechanical Systems, Machine Elements and
Manufacturing,. 40(3), 493-502.
This paper presents a new TSMC approach for robotic Slotine, J. J. E. and Sastry, S. S. (1983). Tracking control of
manipulators without requiring system dynamic mode nonlinear systems using sliding surfaces with application
explicitly. The proposed approach can guarantee the system to robot. International Journal of Control, 38(2), 465-
states reach to the terminal sliding mode in a finite time. 492.
Then the system states converge to zero along the terminal Spong, M. W., and Vidyasagar, M. (1989). Robot Dynamics
sliding mode in a finite time. A novel non-singular terminal and Control. NY: Wiley.
sliding mode is employed in controller design. The Tang, Y. (1998). Terminal sliding mode control for rigid
singularity problem can be avoided. Because this method robots. Automotica, 34(1), 51-56.
does not require the explicit use of the robotic manipulator Yu, S., Yu, X., Shirinzadeh, B. and Man, Z. (2005).
dynamic model, it can be implemented easily. It should Continuous finite-time control for robotic manipulators
mentioned that sound bench tests need to be conducted by with terminal sliding mode, Automatica, 41(11), 1957-
simulations and lab demonstrations before applying the 1964.
9893