Lemma 3 (Worst Case (W2) ) : Let: Ieee Transactions On Automatic Control, Vol. 44, No. 2, February 1999 357
Lemma 3 (Worst Case (W2) ) : Let: Ieee Transactions On Automatic Control, Vol. 44, No. 2, February 1999 357
Lemma 3 [Worst Case (W2)]: Let max be the maximal solution constructively given based on finite-dimensional operations and has
to the transcendental equation a structure of LQ feedback with preview compensation. Then we
Authorized licensed use limited to: Daniel Alvarado. Downloaded on October 01,2021 at 15:28:34 UTC from IEEE Xplore. Restrictions apply.
358 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 44, NO. 2, FEBRUARY 1999
[22], [23], [1], [12], and their bibliographies), have been made to Let qd (t) 2 <n be the reference position trajectory, and we define
improve the tracking performance of robots, the decentralized (or a generalized tracking error [22]
so-called independent joint) controller structure is still adopted by
the majority of modern robots in favor of its computation simplicity r = e_ + 8e (3)
n
where q 2 < is the joint angle vector; 2 < , the input n 01 :
3 = 4 k8k1
torque vector; D(q ) = DT (q ) 2 <n2n , the positive definite inertia
matrix; H (q; q_ )q_ = (In
q_ T )Hv (q )q_ 2 <n in which Hv (q ) = Proof: Since the input–output relations of two proper stable
linear time-invariant maps T1 : r 7! e and T2 : r 7! e_ defined
[H1T (q) 1 1 1 HnT (q)]T 2 <n 2n , the centrifugal and Coriolis torque;
g(q) 2 <n , the gravity torque; and f (q_) = [f1 (q_1 ) 1 1 1 fn (q_n )]T 2 by (3) satisfy
<n , the friction torque with kekT 1 k8k1 01krkT 1 + ke0 k1
fi (q_i ) = si e0d kq_ k + ci sgn(q_i ) + vi q_i
(9)
ke_ kT 1 krkT 1 + k8e0 k1
in which si ; di > 0; ci > 0; vi > 0 are constants related to the where ke0 k1 and k8e0 k1 are bounded zero input responses in
striction, Coulomb, and viscous friction, respectively. Obviously, which e0 = e(t0 ), substituting (9) into (7) yields (8).
there exist positive constants fc = maxi2n fsi + ci g and fv = We define the ith component of (4) as the ith subsystem of the
maxi2n fvi g such that kf (q_)k fc + fv kq_k. overall error dynamics
It is well known that map 7! q_ defined by (1) is passive [2], [4], n
[16], [22], which implies that dij (q)_rj + q_T Hi (q)r = 0i + i ; i2n (10)
rT (D=
_ 2 0 H )r = 0; 8r 6= 0: (2) j =1
Authorized licensed use limited to: Daniel Alvarado. Downloaded on October 01,2021 at 15:28:34 UTC from IEEE Xplore. Restrictions apply.
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 44, NO. 2, FEBRUARY 1999 359
where dij (q) is the i-j th entry of D(q) and the ith component of (5) Proof: Consider the Lyapunov function candidate
n
i = dij (q)(qdj + j e_ j ) + q_T Hi (q)(_qd + 8e) V (r) = 1 rT D(q)r:
2
j=1 Its total derivative along the solution of (4) and (5), after taking (2)
+ gi (q) + fi (q_) (11) and (12) into account, is
n
V_ (r) = 0rT Kr 0 i ri2 + i ri4 + rT
as the interconnections. The decentralized feedback control is then
to find a class of local state feedback and reference trajectory
feedforward laws i = i (ri ; qd ; q_d ; qd ) so that r, and therefore e
i=1
n n
and e_ , according to (9), are as small as possible. 0rT Kr 0 min ri2 0 min ri4 + rT :
i=1 i=1
III. PD AND NONLINEAR DECENTRALIZED CONTROL Applying the L1 norm for rT and T which are obtained by
The well-known decentralized linear PD law is given by truncating them at time T t0 and recalling Lemmas 1 and 2,
we obtain
= Kr = K e_ + K 8e
V_ (rT ) 0kmin krkT2 1 0 min krkT2 1 0 min krkT4 1
where K = diagfk1 ; 1 1 1 ; kn g > 0. This control law, together with + n1 krkT 1 + n2 krk2T 1 + n3 krk3T 1 :
its various versions, has found a broad application in robot systems
due to its computation simplicity and independent joint controller Since the last term on the right-hand side satisfies 3 krkT3 1
structure. It is well known that the PD law guarantees local L 1 3 (krkT2 + krkT4 )=2, we obtain
1 1
stability provided that K is sufficiently large (see, e.g., [10] and [13]).
V_ (rT ) 0k krkT 1 + n 2 + 3
2 krkT 1 0 min krkT 1
2 2 2
It can be shown (see [13]) that the local rather than global stability min
i2n
Completing the squares for the second and fifth terms, and the third
i = ki ri + i ri + i ri3 ; (12) and fourth terms, respectively, on the right-hand side of (15), and
then dropping the resultant two negative squares terms, we obtain
where ki ; i ; i > 0 are controller parameters to be designed. (The
V_ (rT ) 0kmin krkT2 1 + (n(22 + 3 )) + (n1 ) :
2 2
PD portion is written as two terms is merely for the convenience of
stability proof). We need the following lemma. 8(2min 0 n3 ) 4min
Lemma 2: For vector functions v; y 2 Cn [t0 ; T ], the following
In view of 0krkT2 0V (rT )=kDk let T ! 1 so that T can
1 1
be dropped, then we have V_ (r) 0c V (r) + c , where c and
inequalities hold:
n c are given by (14). This implies that V (r) is globally ultimately
ri2k krkTk1 ;
2
k = 1; 2; 1 1 1 ; bounded by Vfc = c =c . In addition, since min (D)krk2
i=1 T 1 2V (r) 2Vfc , where krk is the Euclidean norm of r, we have
jxT yjT 1 nkxkT 1 kykT 1: krk2 2Vfc =min (D) which is the set given by (14) and the theorem
is proven.
1
Proof: Apply the definition of truncated L norm (see [13]). Remark 3.1: The significance of cubic feedback in (12) is not only
The following theorem refers to the global stability of the control to achieve the global stability but also to improve robustness because
law (12). the gain conditions (13) are independent of 1 and 2 . (In PD control
Theorem 1: Consider tracking error dynamics (3)–(5), in which the gain condition depends on 1 ; 2 ; and 3 ; see [14]). Recalling
the input torque is given by (12). If ki ; i ; and i in (12) satisfy 3 and 4 given in Section II, the third inequality in (13) becomes
the conditions min > ncH =2, which indicates that as far as (13) is true, the L 1
stability can be guaranteed regardless of how large the sizes of D(q );
kmin > 0; min > 0; min > n3 =2 (13) g(q); and f (q_) are, even though smaller kmin may result in large
tracking errors.
where kmin = mini2n fki g; min = mini2n fi g and min = Remark 3.2: In the case where the PD gains are already large
mini2n fi g, then the tracking error r globally converges to a residual enough, the effect of the cubic feedback in (12) in steady state will
set be rather minor. This can be seen from (8); if ri is already quite
small, ri3 will be even smaller and become insignificant compared
fc = fr : krk2 2c =(c min (D))g (14) with the effect of the PD portion.
c = (n(22 + 3 )) + (n1 )
2 2
In the control design shown in the last section, as far as stability is
8(2min 0 n3 ) 4min concerned, no a priori knowledge of the system parameters is required
c = 2kmin
except an estimate of 3 . Virtually, if the nonlinear functions related
(D)
max to local state in i are known, we can then introduce a decentralized
adaptive feedback to reduce the tracking errors.
max(min) (1) is the maximum (minimum) eigenvalue of (1) and k 1 k We introduce notations q (q; q_); qi (qi ; q_i ); and qd
is the Euclidean norm. (qd ; q_d ; qd ). Based on the linear-in-parameter property of robot
Authorized licensed use limited to: Daniel Alvarado. Downloaded on October 01,2021 at 15:28:34 UTC from IEEE Xplore. Restrictions apply.
360 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 44, NO. 2, FEBRUARY 1999
model, we split i in (10) into two parts so that it becomes Proof: Consider the Lyapunov function candidate
n
k k 1 0 + 0 krk 1 + 0 krk 1 :
a T 1 2 T 3
2
(17)
T i (i 0 'T i )'T i max kk1 k'kT 1 0 min k'kT2 1
i=1
q ; q ); i 2 n, are known, we propose
Under the assumption that w (
2 kk1 0 2 k'k 1
i i d 2
max 2 min 2
the following decentralized PD-plus-nonliear-plus-adaptive (PD + min
T
given by 2 T
'_ = 00W T (
q; qd )r + 60( 0 ') min 0
V_ (rT ; 'T ) 0kmin krkT2 1 0
2
k'k 1 + 4n
2
T
1
k 2
where 0 = diagf01 ; 1 1 1 ; 0n g 2 <
min
k
0 0 2
+ (n(22 + 3 ))0 :
whose di-
+ max kk1
2
agonal elements are 0i , and 6 = diagf1Ik ; 1 1 1 ; n Ik g 2
2
k 2
2min 8(2min 0 n3 )
< with Ik 2 <k 2k identical matrices, are posi-
k
then the tracking error r and parameter estimation error ' of the
overall system globally converge to a residual set we have V_ (r; ') 0a V (r; ') + a after T is dropped. This
implies that V is globally ultimately bounded by Vfa = a =a and
fa = f(r; ') : V (r; ') Vfa = a =a g (21)
the theorem is proven.
at a rate not slower than exp(0at), where Remark 4.1: In view of (22) and (21), we have that
minfmin (D);
min g (krk2 + k'k2 ) 2V (r; ') 2Vfa = 2a =a .
a = min
2kmin Thus, the upper bound of the tracking error and parameter
kDk1 ;
min min
estimation error can then be obtained as krk2 + k'k2 2a =
(n(220 + 30 ))2 + n10 + max
2 (minfmin (D);
min ga ).
a =
8(2min 0 n3 ) 4min 2min 1
0 kk2 : Remark 4.2: To best reduce the tracking errors, a global feed-
forward and local feedback law (18) was applied. Since the joint
In the equations above, max(min) = max(min)i2n fi g;
min =
mini2n;j2 k f
ij g (the minimum element of matrix 0), and 10 ;
servo feedback loops are isolated from each other, it does not
violate the independent joint controller structure of most modern
20 and 30 are given by (17). robots. However, if necessary, the purely decentralized feedback
Authorized licensed use limited to: Daniel Alvarado. Downloaded on October 01,2021 at 15:28:34 UTC from IEEE Xplore. Restrictions apply.
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 44, NO. 2, FEBRUARY 1999 361
and feedforward adaptation can be obtained by replacing wi ( qi ; qd ) control actions will excite the high-frequency unstable modes of
in (18) and (19) by wi (qi ; qdi ; q_di ; qdi ). In this case, the effect of joint compliance which have been unmodeled. In the case of de-
adaptation may be reduced as the size of the wi ( qi ; qdi ; q_di ; qdi )i centralized adaptive control, the estimated parameters, performing
is not as large as before. like variable gains, will neutralize the interconnections and tracking
Remark 4.3: Even though, theoretically, smaller tracking errors errors to ensure the stability [8]. In the following section it will be
can be obtained by increasing the PD gains, the resultant larger seen that the adaptive scheme not only leads to smaller tracking
Authorized licensed use limited to: Daniel Alvarado. Downloaded on October 01,2021 at 15:28:34 UTC from IEEE Xplore. Restrictions apply.
362 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 44, NO. 2, FEBRUARY 1999
errors but also smaller control signals compared with those of PD are, respectively
control. d11 = 11 + 222 cos q2 ; d12 = d21 = 21 + 22 cos 2
d22 = 21
V. SIMULATION h1 = 022 2
2q1 q2 + q2 sin q2 ; h2 = 022 q12 sin q2
Consider (1) of a two-DOF planar robot arm, in which f (q_) = 0 g1 = 12 cos q1 + m2 glc2 cos(q1 + q2 )
(zero damping) for simplicity. The entries of D(q ); h(q; q_ ) and g (q ) g2 = m2 glc2 cos(q1 + q2 )
Authorized licensed use limited to: Daniel Alvarado. Downloaded on October 01,2021 at 15:28:34 UTC from IEEE Xplore. Restrictions apply.
IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 44, NO. 2, FEBRUARY 1999 363
VI. CONCLUSION
A nonlinear and an adaptive decentralized control schemes for
robot tracking were presented. By refining the tracking error dynamics
of [22], the design was carried out by introducing a cubic feedback
and applying the passive and linear-in-parameter properties of robots’
dynamics to achieve global stability and reduced tracking errors.
Importantly, due to the independent-joint controller structure and
the simplicity of algorithms, the approaches can be implemented in
most robots by simply recoding their joint servos without hardware
alternation.
REFERENCES
Authorized licensed use limited to: Daniel Alvarado. Downloaded on October 01,2021 at 15:28:34 UTC from IEEE Xplore. Restrictions apply.