Monday, May 12, 2014

Design of Adaptive Controllers based on Christoffel Symbols of FirstKind

Design of Adaptive Controllers based on
Christoffel Symbols of First Kind



1. Introduction

The present chapter is aimed at systematically exposing the reader to certain modern trends in designing advanced robot controllers. More specifically, it focuses on a new and improved method for building suitable adaptive controllers guaranteeing asymptotic stability. It covers the complete design cycle, while providing detailed insight into most critical design issues of the different building blocks. In this sense, it takes a more global design perspective in jointly examining the design space at control level as well as at the architectural level.
The primary purpose is to provide insight and intuition into adaptive controllers based on Christoffel symbols of first kind for a serial-link robot arm, (Mulero-Martínez, 2007a). These controllers are referred to as static since the positional dependence of the nonlinear functions. In this context, the preferred method of nonlinear compensation is the method of building emulators. Often, however, the full power of the method is overlooked, and very few works deal with these techniques at the level of detail that the subject deserves. As a result, the chapter fills that gap and includes the type of information required to help control engineers to apply the method to robot manipulators. Developed in this chapter are several deep connections between dynamics analysis and implementation emphasizing the powerful adaptive methods that emerge when separate techniques from each area are properly assembled in a larger context.
After beginning with a comprehensive presentation of the fundamentals of these techniques, the chapter addresses the problem of factorization of the Coriolis/centripetal matrix, (Mulero-Martinez, 2009). This aspect is crucial when designing non-linear compensators by emulation. At this point, it is provided a concise and didactically structured description of the design of emulators as matters stand, (Mulero-Martinez, 2006). Specifically, emulators are split up into sub-emulators to improve and simplify the design of controllers while making faster the updating of parameters. From a practical point of view, the implementation is developed by resorting to parametric structures. This means to obtain a set of system's own function as regression functions.
Most of the adaptive schemes start from the notable property of linearity in the parameters, which lead naturally to equivalent structures when designing emulators for the nonlinear terms. When the linearity in the parameters (LIP) is considered as a first assumption in the development of adaptive schemes, it is clear that there exists a strong connection to the LIP emulators formulated in terms of a regression matrix and a vector of parameters. The main difference between standard adaptive schemes and the proposed approach stems from the idea of developing efficient controllers. The present work is aimed by attempts to mitigate the "curse of dimensionality" by exploiting the representation properties associated with the matrix of Coriolis/centripetal effects. By recalling the connection between LIP representation of robot manipulators and LIP adaptive emulators, it can be asserted that standard scheme matches perfectly with a dynamic emulator. Thus, the regression matrix, depend not only on the position joint variables but also on the velocity and acceleration variables.
As regards to the control, a novel theorem guarantees the stability for the whole system and is based on the Lyapunov energy. The proof is generalized to cope with a realistic case where both a functional reconstruction error and an external disturbance are present. It should be observed that the functional reconstruction error is caused by not using a number of regression functions appropiately distributed in the space. As a result, these considerations lead to a quite different approach, since it is required to analyze the initial conditions of the errors to guarantee the validity of the approximation. The specification of a range of validity causes that the stability holds only inside a compact set. As a consequence, the proof guarantees semi-global stability as opposed to the standard schemes where the stability is attained in the whole state space, in a global sense. Apart from these considerations, a number of remarks have been made to address some special aspects such as the boundedness of the parameters, the ultimately uniformly boundedness of all the signals and the stability in the ideal case.
The main benefit of the proposed controller is that it allows to derive tuning laws only for inertia, gravitational and frictional parameters. The Coriolis parameters are not necessary to be used because of the approximation based on Christoffel symbols. This is very useful to implement adaptive controllers since the number of nodes diminishes and the computational performance improves. Previously, an extensive analysis of the mechanical properties for a robot has been discussed. The regression functions for the adaptive controller depend on the non-linear functions associated with the inertia matrix, and therefore, a discretization of positions could be done for the inertia matrix. This is a very useful aspect because the position space for a revolute robot is compact and in consequence, the number of nodes is limited to approximate a non-linear function.
The plan of the chapter is as follows. In section 2 the representation properties for the Coriolis/centripetal matrix are analysed. An interpretation for the Coriolis/centripetal matrix is presented and the description by means of the Christoffel symbols of first kind and fundamental matrices are provided. In section 3, emulators are used to approximate the non-linearities of a robot using the properties presented in the previous section and the Kronecker product. The next section presents the design of the adaptive controller in terms of a control law and a parameter updating law. This section concludes with a theorem that guarantees the stability for the whole system and is based on the Lyapunov energy. Finally an example of a 2-dof robot arm is used to illustrate the theorem.

2. Representation of the Coriolis/Centripetal Matrix. Fundamental Matrices

In this section some notions regarding the representation of the Coriolis/centripetal matrices are introduced. All the ideas presented here constitute an original contribution and have many interesting implications in the field of robotics. To this end, fundamental matrices are introduced and described in terms of their structure. Moreover, some emerging properties are analyzed, allowing one to build the Coriolis/centripetal matrix in a simple way. Let start with the definition of the matrix MD which from now on will be called the inertia derivative matrix.

Definition 1:
n
MD (q,x =) å¶M q¶q( )j xeTj (1)
j=1
where M q( ) is a generalized inertia matrix of dimension n´n a unitary vector of dimension n with a value 1 in the position j and x is an arbitrary vector of dimension n . It is noted that if x represents the generalized velocity vector, the matrix MD will stand for the gradient of the generalized momentum with respect to the position coordinates q . This means that the gradient of the kinetic energy as a quadratic form 21 x M q xT ( ) relative to the joint position can be written as 21 MDT (q,x x) . Another representation of MD is showed below.
Property 1: The matrix MD (q,x) can be expressed as

MD (q,x) = ån ¶¶Mqi xi (2)
i=1

Proof: It is very easy to show that ¶M q¶q( )j xeTj =åin=1 ¶¶Mqji x ei Tj since the following intermediate equation is obtained

¶M q( )xeT =ççççæå=n1 ¶¶Mqji eiTø÷÷÷÷÷öxeTj = åi=n1 ¶¶Mqji x ei Tj (3)
¶qj j èçi

Using the definition 1 and the identity (3) the hypothesis of the property is concluded

n n ¶Mi x ei Tj = ån ¶Mi x
MD (q,x)= ååi= =1 j 1 ¶qj i=1 ¶q i (4)
Q.E.D.
Now a new matrix will be introduced and from now on will be called as inertia velocity matrix, playing a central role in the representation theory. Definition 2: Let define Mv (q,x) in the following way

Mv (q,x)=ççççæ¶¶Mq1 x,..., ¶¶Mqn x÷÷÷÷øö= åi=n1 ¶¶Mqi xeiT (5)
è
The inertia velocity matrix Mv (q,x) receives its name from the fact that when x = q , the term Mv (q,q) will be the time differentiation of the generalized inertia matrix, i.e. M q ( ) .
The following property provides an alternative way to write the matrix Mv . Property 2: The inertia velocity matrix can be also expressed as

n ¶M q( )
Mv (q,x)=å ¶qi xi (6)
i=1

Proof: It is known that ¶¶Mqi xeiT =ånj=1 ¶¶Mqji x ej iT and using the definition 2 the property is proved as follows

n n ¶Mi x ej iT =åån æçççç n ¶Mi eT ö
Mv (q,x)=ååi= =1 j 1 ¶qj j= =1çèi 1 ¶qj i ÷÷÷÷ø÷xj =åj=n1 ¶M q¶q( )j xj (7)
Q.E.D.

2.1 Properties of the fundamental matrices
Subsequently, some properties related to the fundamental matrices are analyzed. Following a systematic methodology, the properties have been classified into two groups:
commutation properties and representation properties.

2.1.1. Commutation properties
Commutation properties permit interchange of an external arbitrary vector y and a vector x passed to a fundamental matrix as an argument. The following property makes possible the commutation while keeping the type of the fundamental matrices. This means that the transpose of the inertia derivative matrix can be transformed into the same structure by simply interchanging the roles of x and y .
Property 3: MDT (q,x)y = MDT (q,y)x
The proof of the last property follows directly from the definition of MD . The following property allows to pass from a type of fundamental matrix to another commuting the vectors x and y .
Property 4: Mv(q,x)y = MD(q,y)x
Proof :

Mv (q,x)y = åin=1 ¶¶Mqi xeiTy = åin=1 ¶¶Mqi xyi = MD (q,y)x (8)
Q.E.D.

2.1.2. Properties of representation of the Coriolis/centripetal matrix
These properties are very important to describe the Coriolis/centripetal matrix from the fundamental structures.
Property 5:
MDT q,q in1 MqiT qe iT (9)

Proof: First of all, the transpose of the inertia derivative matrix can be represented as
MDT q,q nj1e qj T in1 Mqji e using the definition 1 and the fact that the differentiation of iT the inertia matrix with respect to the generalized coordinate q is j M qq j in1 Mqji eiT . Since scalar product is commutative the following expression is derived, qT Mqji  MqjiT q , and as a result MDT q,q nj1ej in1 MqjiT qeiT . The order of summation is needed to be permutated to get the proposed identity.

T
MDT q,qi n1 jn Mqji eTj  qeiT in1 MqiT qeiT (10)
1  Q.E.D.
Below, some representations of the Coriolis/centripetal matrix are introduced as properties derived from MD and Mv .
Property 6: The matrix of Coriolis/centripetal effects can be expressed as

C q,q   1Mv q,q MD q,q MDT q,q  1Mv q,q J q,q  (11)
2 2

where J q,q  MD q,q MDT q,q is a skew symmetric matrix, i.e. J q,q  JT q,q . Proof: This is an immediate consequence of the representation of C q,q  by means of the property 1 and the fact that the inertia velocity matrix is Mvq,q  M q  . In a general way, the following representation can be derived

C q,x   Mv q,x J q,x  (12)

where x is a vector of dimension n and J q,x   MD q,x MDT q,x is a skew symmetric matrix. It is remarkable that the definition of the Coriolis/centripetal matrix presented above, is different from the definition given by (Wen,1988) in the identity 2, C q,z z   MD q,z J q,z z   . An interesting property which is a direct implication of the property 4 is that, by setting x  y in C q,x y .
Property 7: The Coriolis/centripetal force can be represented as

C q,q q  M q  1 MDT q,qq (13)
 2 
or in a general form as
C q,x x( ) = Mv (q,x x) - MDT (q,x x)
2

where x is an arbitrary vector of dimension n :
Property 8: The Coriolis/centripetal matrix commutes with external vectors
(14)
C q,x( )y = C q,( y)x (15)
1

Proof: In order to see this point the representation of the Coriolis/centripetal matrix will be used as a sum of the inertia velocity matrix, Mv (q,x and the skew symmetric matrix ) J q,x given by equation (12). ( )
C q,x( )y = 1(Mv (q,x)y + J q,x( )y) (16)
2

On one hand, it is known that J q,x( )= MD (q,x)-MDT (q,x) .Using the commutation properties 2 and 3 the following expression is derived

C q,x( )y = 1(MD (q,y)x-MDT (q,y)x + MD (q,x)y) (17)
2

On other hand, J q,( y)x = MD (q,y)x-MDT (q,y)x and then applying the commutation property 3 to MD (q,x)y the following result is achieved as claimed

C q,x( )y = (J q,( y)x + Mv (q,y)x)= C q,( y)x (18)
Q.E.D

3. Design of Emulators for Robot Manipulators.

3.1 Functional and Linear Parameterization.
The approach that follows is founded on the idea to find an emulator as a function close to the non-linear terms involved in the dynamics equations of a robot manipulator. In order to get a model from a practical point of view, uncertainties in the nonlinear terms. getting arise from the partial information about the exact structure of the dynamics, must be taken into account. The inaccuracies of a model can be classified into two classes: structured and unstructured uncertainties. The first kind of uncertainties comes out from the inaccuracies of the parameters whereas the unstructured uncertainties are related to unmodeled dynamics, see (Slotine & Li,1991). Thus, the uncertainties can be adaptatively compensated by defining each coefficient as a separate parameter so that the dynamics can be expressed in the linear in the parameters (LIP) and this means that nonlinearities can be split up into an unknown vector of physical parameters P and a known matrix of basis nonlinear functions
Ψ q,q,x,y(  ) comprising the elements of M q( ) , C q,q( ), G q( ) and F q,q( ) , referred to as regression matrix. Therefore, the nonlinear function f x can be written in this sense adding ( ) a term of error ε , see (Ge et al., 1998).

f q,q,x,y(  )= Ψ q,q,x,y P(  ) +ε (19)

The linearity of the parameters is the major structural property of robot manipulators and has been analyzed in (Lewis et al., 2003). This linear factorization is always possible to be done for the rigid body dynamics of a fixed-based manipulator as long as the physical uncertainty is on the mass properties of the robot links. Furthermore, linearity of the parameters is the first assumption in the most of adaptive controllers. An alternative representation of the nonlinear component is as follows

f q,q,x,(  y)= R q,q v x,( ) ( y) (20)

where R q,q( )=(M q( ) C q,q( ) G q( ))n´ +(2n 1) and v=(yT xT 1)2n+1 . This factorization is always attainable whereas the linearity in the parameters (LIP) is only obtained under some circumstances. In the literature, emulators based on regression matrices have been used to approximate the nonlinear dynamics as a whole, as follows

(q,q,q )=M q q( )+C q,q q(  ) +G q( ) (21)

As an attempt to obtain more efficient computation, the emulator approximating the nonlinearity f x is split up into several smaller components: ( )

f q,q,x,y(  )= fm(q,y)+fc(q,q,x )+fg (q)+f q,qf ( ) (22)

The function fm (q,x)= M q( )y , stands for the nonlinearity of inertial terms and can be written taking into account that the components of M q( ) are continuous functions of their arguments so that each component can be uniformly approximated on any compact subset of the state space by an appropriately designed emulator.
From now on we assume that the number of parameters to approximate the column i of a matrix is li .
3.2 Inertia matrix M q( ).

3.2.1 Ideal Case
The inertia matrix M q consists of column vectors ( ) Mi (q that can be approximated by ) regression matrices
Mi (q)= Ψmi (q ξ) mi (23) where Ψmi (q)n l´ i ( ) is a regression matrix of known robot functions and ξmi li is a vector of unknown parameters (e.g. masses, inertia moments and link parameters). Then, with an arbitrary vector xn , there follows the decomposition

n æ
M q x( ) = åi Mi ( )q xi =ççççèåi=n1Ψmi ( )q x ξi mi ÷÷÷÷÷öø (24)
=1

On the assumption that the same regression matrix serves for each column, i.e.
Ψm1 (q)= Ψm2 (q)=Ψmn (q)= Ψm (q)n l´ (), one may rewrite equation (24) by resorting to the Kronecker product as

M q x( ) = Φm (q,x ξ) m (25)

where ξm l is an l-dimensional vector of parameters and
Φm (q,x)=(xT Ä Ψm (q))n l´ ( ) is the regression matrix of the generalized inertia matrix.

3.2.2 Real Case
Given a closed, bounded subset Ω Í n , and a specified accuracy εmi , there exist values for the design parameters li and ξmi so that for all q t( )Ω the following inequality is satisfied:
Mi (q)-Ψmi (q ξ) mi £εmi (26)

For the sake of simplicity, we have assumed that Ψmi (q are equal for all i) = 1,,n . The inertia matrix consists of column vectors that can be approximated as

M q( )=ån Mi ( )q eiT =ççèççæåi=n1Ψmi ( )q ξmi eiT÷÷÷ø÷÷ö+εm ( )q (27)
i=1

where εm (q)n n´ is the functional reconstruction error.
It is convenient to underline that the vector function Φm (q,x only can be expressed by the )
Kronecker product whenever the hypothesis Φm (q,x)= Ψmi (q)= Ψm(q) holds for all i = 1,,n . As a consequence, a linear transformation with a change of basis can be derived
in terms of the Kronecker product

M q x( ) = Φm (q,x ξ) m + Em (q,x) (28) The expansion given by (28) actually approximates the linear transformation M q x( ) to a certain degree of accuracy Em (q,x)= ε xm by using an emulator with the position joint vector as the input. Specifically, the emulator in (28) has the vector (q ,xT T )T as its input and n outputs, and a collection of simple computing elements Φm (q,x are used to ) approximate the function fm (q,x).
3.3 Fundamental matrices.
For the sake of simplicity in the following, the matrix derivative of Ψm (q with ) q n will be denoted as
¶Ψm ( )q ççæççç¶Ψ¶mq1( )q ÷ö÷÷÷÷ ( ) (29)
 ÷÷
¶q ççççèçç¶Ψ¶mqn( )q ø÷÷÷÷ n2´l ÷

3.3.1 Inertia Derivative Matrix MD(q,x)

3.3.1.1 Real Case
It is possible to express the inertia derivative matrix as consisting of two terms, the approximation component Mˆ D (q,x) and the reconstruction error ED (q,x . )

MD (q,x)= åj=n1 ¶M q¶ˆq(j )xeTj + åj=n1 ¶Em¶q(q,xj )eTj (30)

Following the discussion given in the ideal case, the approximation term Mˆ D (q,x)y can be expressed in the regression form:

Mˆ D (q,x y) = ΦD (q,x,y)ξm (31)

3.3.1.2 Ideal Case
The following lemmas are helpful for characterizing the inertia derivative matrix in LIP form.
Lemma 1 (LIP form of MD ). For arbitrary vectors x,yn , q Ωq Ín , the inertia derivative matrix can be written in the LIP form as follows

MD (q,x y) = ΦD (q,x,y)ξm (32)

where ξm l is the parameter vector of the generalized inertia matrix and ΦD n l´ ( ) a regression matrix:

ΦD (q,x,y)=(yT ÄIn )ψ q,x( )
) æçèçxT Ä ¶Ψm ( )q ö÷÷÷÷ (33)
ψ q,x( =çç ¶q ø

Proof: This fact can be straightforward proved by resorting to the definition of MD given above:

MD (q,x y) = ån ¶M q¶q(i )xyi =æççççèåi=n1 ¶Φm¶q(q,xi )yiö÷÷÷÷÷øξm =æççççèxT Ä åi=n1 ¶Ψ¶mq(i q)yiö÷÷÷÷÷øξm = ΦD (q,x,y)ξm (34)
i=1

By closely examining the structure of ΦD and using the property

åi=n1 ¶Ψ¶mq(i q)yi =(yT Ä In ) ¶Ψ¶mq(q) (35)

it is easy to conclude that

æççççè(yT Ä In )¶Ψ¶mq( )q ö÷÷÷÷ø= êéêêx Äæççç¶ΨmT ( )q (y Ä I )ö÷÷ùT
ΦD (q,x,y)= xT Ä T ë çè ¶q n ÷÷÷øúúûú = (36)
= éêêæçççx Ä ¶Ψ¶mTq( )q ö÷÷÷ø÷÷(y ÄIn)úùûúú =(yT ÄIn )ψ q,x( )
ëêçè

3.3.2 Fundamental Matrix Mv(q,x)

3.3.2.1 Ideal Case
Lemma 2. For arbitrary vectors x,yn , q Ωq Ín , the inertia velocity matrix can be written as

Mv(q,x y) = Φv(q,x,y ξ) m (37)

where Φv (q,x,y)=åin=1 ¶Φm¶q(q,yi )xi .
Proof: Owing to the commutation property of fundamental matrices the result is direct. Remark: It is easy to show that the Jacobian matrix Φv (q,x,y) also satisfies the commutation property, Φv(q,x,y) = ΦD(q,y,x) .This is an immediate consequence of the commutation property of Mv (q,y) and MD (q,x as given in the identity 3 . )
3.3.2.2 Real Case
The inertia velocity matrix Mv (q,x can be seen as consisting of an approximation term )
Mˆ v (q,x) and a reconstruction error Ev (q,x . The approximation term ) Mˆ v (q,x) can be written in terms of the Jacobian of Φv (q,x,y) as

Mˆ v (q,x y) = Φv (q,x,y)ξm (38)

and the error Ev (q,x is derived from the gradient of the inertia error ) εm (q . )

Ev (q,x)= ån ¶¶εqmi xi = åi=n1 ¶ε¶mq(iq)xi (39)
i=1

3.3.3 Transpose of the Inertia Derivative Matrix
Now that it is known how MD can be written in LIP form, the main challenge, now, is to extend this result to its transpose. This is more difficult since involves a permutation matrix as stated in the following lemma.
Lemma 3: Let x,yn , q Ωq Ín arbitrary vectors with appropriate units and P a permutation matrix1 defined as follows

n n
P n,m( )= ååEij Ä Eji (40)
i= =1 j 1

where Eij = e ei Tj is a unit matrix having 1 in position (i,j) and all other entries are zero.
Under these conditions, the term MDT (q,x) can be written in LIP form as follows

MDT (q,x y) =(xT Ä In)P n,n ψ q,y ξ( ) ( ) m (41)

Proof: By virtue of definition 1 and lemma 1, the generalized force MDT (q,x)y can be directly derived in the LIP form which can be detailed into

MDT (q,x y) =åi=n ei çèççæçxT ¶M q¶q(i )y÷÷ø÷÷ö=(In ÄxT ) ¶M q¶q( )y =
(42)
=(In ÄxT )¶Φm¶(qq,y)ξm =(In ÄxT )çæçççèyT Ä ¶Ψ¶mq( )q ÷÷ö÷÷øξm

With reference to the property B ÄA = P m,p( )T (A Ä B P n,q) ( ) for all Am n´ ( ) and
Bp q´ ( ) , (see Corollary 4.3.10., p. 260, in (Horn & Johnson,1999)), the term (xT Ä In) can be commutated as

(xT Ä In)= P n,1( )T (In Ä xT)P n,n( ) (43)

The last identity can be simplified further by exploiting the structure of the permutation matrices. In particular, it is easy to show that P n,1( )= P 1,n( )= In (see problem 18, section
4.3, p. 265, in (Horn & Johnson, 1999)), which leads to
(In Ä xT )=(xT Ä In )P n,n( )
Therefore, (44)
MDT (q,x y) =(xT Ä In )P n,n( )æççççèyT Ä ¶Ψ¶mq(q)ö÷ø÷÷÷ξm =
=(xT Ä In )P n,n ψ q,y ξ( ) ( ) m

Remark: The permutation matrix in the last lemma can be also written as
(45)
n n
P n,n( )= åei Ä In Ä eiT = åeiT Ä In Ä ei (46)

i=1 i=1

For more details the reader is referred to the problem 21, section 4.3. p.286,in (Horn & Johnson, 1999).

3.3.4 Coriolis/Centripetal Matrix
On the basis of the description of MD and MDT in LIP form, the skew-symmetric matrix J can be also represented as LIP.

Lemma 4: Let x,y n , q W Íq n arbitrary vectors with appropriate units. The skewsymmetric matrix J q,x( ) can be expressed is linear in the parameters,
J q,x y( ) = FJ (q,x,y)xm where FJ (q,x,y)=(yT Ä In )(In2 - P n,n( ))y(q,x) .
Proof: It is straightforward that
J q,x y( ) = MD (q,x y) - MDT (q,x y) =(yT Ä In )(In2 - P n,n( ))y(q,x)xm

Lemma 5: For arbitrary vectors x,y n , q W Íq n , the inertia velocity matrix can be written as
Mv (q,x y) = Fv (q,x,y)xm
where Fv (q,x,y)=åin=1 ¶Fm¶(qq,yi )xi .
Proof: This is direct.
Remark: It is observed the following identity: FD (q,x,y) = Fv (q,y,x , which is consistent ) with the commutation property.
Remark: An alternative way for J is obtained by resorting to the commutation property:

Mv (q,x y) - MDT (q,x y) = MD (q,y x) - MDT (q,y x) =
T Ä In )(In2 - P n,n( ))y(q,y)x =m J q,y x( ) =(x

Remarkably, the above lemmas can be conveniently used to write the Coriolis/centripetal matrix in LIP form.
Proposition 1 (Coriolis/Centripetal matrix in LIP form): Let x,y n , q W Íq n arbitrary vectors, the Coriolis/centripetal effect C q,x( )y can be linearly factorized as a regression matrix FC (q,x,y) and a parameter vector xm , i.e. C q,x y( ) = FC (q,x,y)xm , where FC is given by
FC (q,x,y) = 21 éë(xT Ä In )y(q,y) + (yT Ä In )(In2 - P n,n( ))y(q,x)ùû
Proof: By restoring to the LIP form of M and J , matrix C can be written as v

C q,x y( ) = 21(Mv (q,x y) + J q,x y( ) ) =
= 21 ëé(xT Ä In )y(q,y) + (yT Ä In )(In2 - P n,n( ))y(q,x)ûù xm

3.4 Model Errors
The dynamic model of the robot manipulator is allowed to be imprecise since the nonlinear function f q,q,x,(  y) = M q x( ) + C q,q(  )y + G q , (where ( ) x,y n are arbitrary vectors usually with units of acceleration and velocity respectively),is not exactly known. The imprecision comes from unstructured uncertainties, namely modeling errors caused by the truncation of the Gaussian expansion series. A detailed description of the approximation errors is demanding from a modeling viewpoint. To point out the fundamental aspects of error modeling, it is convenient to express the total error as composed by three terms,
(Mulero-Martinez, 2007a),
E = Em (q,x) + EC (q,q, y) + EG (q )

By referring to the expression of the Coriolis/centripetal matrix in (Mulero-Martínez,2007a) from the fundamental matrices MD and MV , the Coriolis/centripetal errors EC (q,q, y) can be written as
(q,q,y ) = 1(ED (q,q )- EDT (q,q ) + EV (q,q ))y
EC 2

The error term ED (q,q )is the approximation error associated with the fundamental matrix
MD (q,q ) and EV (q,q ) regards with the velocity matrix MV (q,q ) . For the sake of simplicity the gradient of the inertia error em (q) will be denoted as

¶eqm  æçççè ¶e¶qm1 ,,¶e¶qmn ö÷÷÷ø n n´ 2


These errors can be expressed in terms of the gradient of the inertia error em (q) as follows
ED (q,q ) = ån ¶e¶mq( )iq qe iT
EV (q,q åi=n1 ¶e¶mq( )iq q i (47)
 ) =
i=1

For the following derivation, it is worth rewriting the mathematical errors in a more suitable form using the Kronecker product. This is written down in the following properties. Claim 3: The linear transformation ED (q,q q ) r can be formulated in terms of the Kronecker product as
ED (q,q q ) r =¶em¶q(q)(q r Ä q ) (48)

Proof: The proof is derived directly from the definition of ED (q,q )
n ¶e ( )q n
ED (q,q q ) r = å ¶mq qe q Tj  r = å ¶e¶mq( )jq qq  rj = ¶em¶q( )q (q r Ä q )
j=1 j j=1
Claim 4: The linear transformation EV (q,q q ) r is expressed in terms of the Kronecker product as
V (q,q q ) r =¶em¶q(q)(q Ä q r ) (49)
E

Proof: This fact can be trivially proved from the definition in equation (47)

n ¶em ( )q ¶e
EV (q,q q ) r = åi=1 ¶qi q q i r = m¶q( )q (q Ä q r )

Remark: Equations (48) and (49) are not the same since the Kronecker product is not commutative, i.e. (q r Ä q )¹(q Ä q r ) .
4. Design of the Adaptive Controller.

4.1 Error Dynamic Equation
In order to manage equilibrium points at the origin, it is necessary to make a coordinate transformation so that a position error variable is considered, e t( )= qd ( )t - q t( ) . Thus, convergene of trajectory q t( ) to the desired trajectory qd ( )t can be analysed observing position error trajectories e t( ) close to the origin in the phase space. The objective of the controller is both the stable tracking of trajectories and the rejection of disturbances. A good tracking performance means that the error converge to zero (asymptotic stability) or to a finite value, limt¥ e t( ) = E < ¥ . This idea is also applied to q t( ) and q t( ) because a position trajectory is given by three quantities (q t ,q t ,q t( ) ( ) ( ) ) . Measurements of velocities are easy to get by tachometers, but sensors of acceleration are noisy and are not used for implementation in robotics field. This fact conjures up to use a filtered error signal,
r t , that is a derivative filter or PD (Slotine & Li, 1991): ( )

r t( )= q r ( )t -q t( ) (50)

From (50) it is shown that r t is a measurement of error between real velocity ( ) q t( ) and reference velocity q r (t) . This reference velocity must not be confused with the desired velocity q d ( )t . In fact, reference velocity is defined as follows

q r (t)= q d (t)+Le t( ) (51)

where L is a diagonal matrix of design parameters with big positive elements so that the system is BIBO stable. This matrix allows to filter errors so that no acceleration of errors
e t will appear in the error dynamic equation. The definition of filtered error ( ) r t in ( ) terms of position and velocity errors can be obtained from (50) and (51)
r t( ) = e t( ) + Le t ( )

Substituting q t( ) from (50) into the plant, the error dynamic equation is derived.

M q r( ) =-C q,q r(  ) + f x( )-t+td

where f x( )= M q q( )r + C q,q q(  ) r + G q( )+ F q,q(  ) stands for non-linear terms to be compensated. This non-linear function could be parametrised by xT = (q ,q ,q ,qT  T  rT rT )T or
using the definition of q r ( )t in (51) by xT = (e ,e ,q ,q ,qT  T dT  dT dT )T .
A structural property of robot manipulators is the linearity of parameters (LIP) (Craig, 1989), (Sciavicco, 2002). This means that non-linearities can be split up into a parameter vector P and a vector of basis functions Y( )x . Therefore the non-linearity function f x can be ( ) expressed in this sense adding a term of error e .
f x( )=Y(q,q,q ,q  r r )P +e

Linearity of parameters (LIP) is a first assumption in most of the adaptive controllers.
Proceeding in a similar way, the approximation of the non-linear function using estimation of the parameters Pˆ can be represented by means of linearity of parameters.
f xˆ( )=Y(q,q,q ,q  r r )Pˆ
4.2 Controller Structure, Control Law and Updtating Law.
Up unto this point, LIP property has been analyzed via fundamental matrices. The control approach employs an inertia-related linearization approach, i.e. a conservation of energy formulation, as an attempt to derive update laws and control laws. To be specific, it is required to define an inertia-related Lyapunov function in the stability analysis which utilizes physical properties inherent to a mechanical manipulator (such as those presented above). Thus, the stability of the tracking error system is ensured by formulating the adaptive update rule and by analyzing the stability of the tracking error system at the same time. It is well known that dynamic models even though quite complex are anyhow an idealization of reality. Specifically, robots show uncertainties that are mainly found from two sources: variability of parameters and nonlinearity terms in the system. One way of dealing with parametric uncertainties would be to use the inertia-related approach, see (Lewis et al., 2003). The benefits of this approach as compared to others is that avoids a direct measurement of acceleration and the invertibility of the generalized inertia matrix, which are restrictions of some controllers such as those inspired in the adaptive computedtorque approaches.

Fig. 1. Adaptive Control Structure

The controller consists of three terms: a PD-controller to guarantee a good tracking performance, tpd = K rv = Kv (e + Le) , a compensator of non-linearities, tnl = fˆ and a robust controller to absorb unmodelled dynamics tr .

t = K rv + fˆ + tr (52)

where Kv = KTv > 0 is the gain matrix.
The control structure appears in figure 1. In this scheme, two loops can be spoted: an outer loop to track signals and an inner loop to compensate non-linearities. The inner loop is driven by an adaptive control and the outer loop is driven by a robust and PD terms. An important feature of this class of controllers is that of being based on the all-important closed-loop error dynamics, which results from the substitution of the filtered tracking error into the robot dynamics

M q r( ) = -C q,q r(  ) + f x( )- t = -C q,q r(  ) - K rv +f x( )- tr (53)

where f x( ) = f x( ) - f xˆ( ) stands for the functional estimation error with x being a vector of appropriate variables as shown below. The nominal nonlinearity f can be computed as
f q,q,q ,q(   r r )= M q q( )r + C q,q q(  ) r + G q( )
where qr is the reference acceleration, qr (t) qd ( )t + Le t( ), and q r the reference velocity, q r ( )t  q d (t) + Le t( ) . The nonlinearity f can be conveniently partitioned into several smaller terms, resulting into an added controller structure f x( ) = fm ( )x + fc (x) + fg ( )x
where fg (x) = G q( ) . The terms fm and f can be defined in terms of c qr and q r as follows

fm (q,qr )= M q q( )r =Fm (q,qr )xm
fc (q,q,q r )= C q,q q(  ) r =Fc (q,q,q r )xm fg ( )q = G q( )=Fg ( )q xg

where xm lm , xg lg are parameter vectors and Fm ,Fc ,Fg regression matrices. Theorem 1: Let the desired trajectory qd (t) bounded by qB , i.e. qd (t) £ qB . Suppose that the approximation error e and unmodeled disturbances td(t) are upper bounded by eN and d respectively. Let the control law given by (52) with a robust term, B
tr (t)= K sr gn r( ) where Kr = diag k( rii ) > 0 with krii ³e +n dB . The next parameter updating laws are considered

No comments:

Post a Comment