an adaptive fuzzy controller for robot manipulators: theory and experimentation

10
An Adaptive Fuzzy Controller for Robot Manipulators: Theory and Experimentation MIGUEL A. LLAMA , RAFAEL KELLY , VICTOR SANTIBA ˜ NEZ , and HUGO CENTENO Instituto Tecnol´ ogico de la Laguna, Apdo. Postal 49, Adm. 1 Torre´on Coahuila, 27001, MEXICO Fax: +52 871 7 05 13 26 e–mail: [email protected], [email protected], [email protected], [email protected] Divisi´ on de F´ ısica Aplicada, CICESE, Carretera Tijuana–Ensenada km 107 Ensenada, B. C., 22800, MEXICO e–mail: [email protected] Abstract: this paper addresses the tracking con- trol of robot manipulators for the case when the dynamics parameters are unknown. To this end, we resort to the important property of fuzzy systems as universal approximators. Via Lya- punov theory we prove, under the fact that SISO functions approximation error can be achieved with any prespecified degree of accuracy, that the closed–loop tracking errors are ultimately bounded. We extend the single-input-single- output indirect adaptive fuzzy approach previ- ously introduced in the literature to the more general case of multi-input-multi-output fuzzy control for nonlinear robot manipulators. The exposed theory is validated experimentally on a two degrees of freedom robot arm. Key–Words: fuzzy control, adaptive control, robot control, stability analysis, experimental test. 1 Introduction The fuzzy control of robot manipulators has been widely discussed in recent years [1]–[6] and it has been improved by incorporating other control techniques to the classical ones such as adaptive fuzzy techniques, and fuzzy neural networks schemes [7]–[19]. The highly non linearity, the complexity in the dynamics modeling of robotic systems and the presence of unknown and variant parameters, turn difficult the task of designing effective tracking controllers. A control technique that has proved a very nice perfor- mance in the tracking control problem of robot manipu- lators is the computed torque control (inverse dynamics approach) [20]; this control scheme linearizes the sys- tem and applies a linear PD control. However, the most accuracy knowledge of the model of the plant is required in order to operate properly. If the dynamics of the ro- bot are well known, the computer torque control can be implemented and even improved with the addition of fuzzy systems that tune PD gains or compute the PD control contribution as it is shown in [1], [3] and [7]. Nevertheless, not always the robot dynamics are well known or they may change during a task execution. Therefore adaptive fuzzy techniques have been intro- duced to the control of robot manipulators so as to es- timate the parameters that describe the system dynam- ics and hereby compute the control law. Adaptive fuzzy controls can be classified in: direct, when the fuzzy con- troller is a single fuzzy system constructed (initially) from the control knowledge; and indirect, when the fuzzy controller comprises a number of fuzzy systems constructed (initially) from the plant knowledge [8]. A very comprehensive study is shown in [9], where adap- tive fuzzy control was both simulated and implemented in simple non linear systems. Some direct adaptive fuzzy approaches have been ap- plied to the control of robot manipulators in [8],[10], [11], and with cubic feedback in [12]. Indirect adaptive fuzzy approaches are developed in [8], [13] and with ge- netic algorithms in [14]. However, none of these works were experimentally validated. The indirect adaptive fuzzy control proposed in this pa- per is characterized by a simplified design based on clas-

Upload: araceli-castruita

Post on 24-Nov-2015

4 views

Category:

Documents


0 download

DESCRIPTION

this paper addresses the tracking controlof robot manipulators for the case when thedynamics parameters are unknown.

TRANSCRIPT

  • An Adaptive Fuzzy Controller for Robot Manipulators: Theory andExperimentation

    MIGUEL A. LLAMA, RAFAEL KELLY, VICTOR SANTIBANEZ, and HUGO CENTENO Instituto Tecnologico de la Laguna, Apdo. Postal 49, Adm. 1

    Torreon Coahuila, 27001, MEXICOFax: +52 871 7 05 13 26

    email: [email protected], [email protected],[email protected], [email protected]

    Division de Fsica Aplicada, CICESE, Carretera TijuanaEnsenada km 107Ensenada, B. C., 22800, MEXICO

    email: [email protected]

    Abstract: this paper addresses the tracking con-trol of robot manipulators for the case when thedynamics parameters are unknown. To this end,we resort to the important property of fuzzysystems as universal approximators. Via Lya-punov theory we prove, under the fact that SISOfunctions approximation error can be achievedwith any prespecified degree of accuracy, thatthe closedloop tracking errors are ultimatelybounded. We extend the single-input-single-output indirect adaptive fuzzy approach previ-ously introduced in the literature to the moregeneral case of multi-input-multi-output fuzzycontrol for nonlinear robot manipulators. Theexposed theory is validated experimentally on atwo degrees of freedom robot arm.

    KeyWords: fuzzy control, adaptive control,robot control, stability analysis, experimentaltest.

    1 IntroductionThe fuzzy control of robot manipulators has beenwidely discussed in recent years [1][6] and it has beenimproved by incorporating other control techniques tothe classical ones such as adaptive fuzzy techniques,and fuzzy neural networks schemes [7][19]. The highlynon linearity, the complexity in the dynamics modelingof robotic systems and the presence of unknown andvariant parameters, turn difficult the task of designingeffective tracking controllers.

    A control technique that has proved a very nice perfor-mance in the tracking control problem of robot manipu-lators is the computed torque control (inverse dynamicsapproach) [20]; this control scheme linearizes the sys-tem and applies a linear PD control. However, the mostaccuracy knowledge of the model of the plant is requiredin order to operate properly. If the dynamics of the ro-bot are well known, the computer torque control canbe implemented and even improved with the additionof fuzzy systems that tune PD gains or compute the PDcontrol contribution as it is shown in [1], [3] and [7].Nevertheless, not always the robot dynamics are wellknown or they may change during a task execution.Therefore adaptive fuzzy techniques have been intro-duced to the control of robot manipulators so as to es-timate the parameters that describe the system dynam-ics and hereby compute the control law. Adaptive fuzzycontrols can be classified in: direct, when the fuzzy con-troller is a single fuzzy system constructed (initially)from the control knowledge; and indirect, when thefuzzy controller comprises a number of fuzzy systemsconstructed (initially) from the plant knowledge [8]. Avery comprehensive study is shown in [9], where adap-tive fuzzy control was both simulated and implementedin simple non linear systems.Some direct adaptive fuzzy approaches have been ap-plied to the control of robot manipulators in [8],[10],[11], and with cubic feedback in [12]. Indirect adaptivefuzzy approaches are developed in [8], [13] and with ge-netic algorithms in [14]. However, none of these workswere experimentally validated.The indirect adaptive fuzzy control proposed in this pa-per is characterized by a simplified design based on clas-

  • sical computed torque control, identifying the robot dy-namics through adaptive fuzzy systems. The proposedstability analysis proves and guarantees via Lyapunovtheory that position errors are uniformly bounded andultimately bounded.The practical feasibility of the proposed controller isshown in this paper by means of experiments on a twodegrees of freedom directdrive vertical robot arm. Theresults show that the experimental response of the clas-sical computed torque control is similar to that of theadaptive fuzzy control, standing out the latter becauseit does not require a knowledge of the robot dynam-ics. However, if the knowledge of the initial conditionsis available, this would help to have a faster positiontracking convergence.

    2 Dynamics of robotmanipulators and control

    problem formulationThe dynamics of a serial n-link robot can be written as[20]:

    M(q)q + C(q, q)q + g(q) + fv(q) = (2.1)

    where q is the n 1 vector of joint displacements, q isthe n 1 vector of joint velocities, is the n 1 vectorof applied torque inputs, M(q) is the n n symmetricpositive definite manipulator inertia matrix, C(q, q)qis the n 1 vector of centripetal and Coriolis torques,g(q) is the n 1 vector of gravitational torques and fv(q) stands for the n 1 vector of friction viscousand Coulomb torques.The motion control problem addressed in this papercan be stated in the following terms. Assume that theparameters of the robot dynamics are constant but un-known, and the joint position q and joint velocity qare available for measurement. Let the n 1 desiredjoint position vector qd be a twice differentiable vectorfunction. The control problem is to find a controller todetermine the actuator torques in such a way thatthe joint positions q track a desired joint position tra-jectory qd as close as possible: limt q(t) = qd(t).One conventional solution to this control problem forthe case of known parameters is provided by the com-puted torque control given by [20]

    =M(q)[qd+Kv q+Kpq]+C(q, q)q+ fv(q)+g(q)

    where the joint position and velocity error vectors aredenoted respectively by the n 1 vectors q = qd qand q = qd q, with qd being the n 1 vector of de-sired velocity, and Kp and Kv are symmetric positivedefinite matrices proportional and derivative (PD)

    gains, respectively. It is well known [20] that thiscontroller yields global exponential stability at least forconstant PD gainsKp and Kv. However, the latter factmay limit seriously the control system performance inmany applications. A stable computed-torque controlvia fuzzy self-tunning was introduced in [1] to improvethe performance of the response. Nevertheless, in bothcases the parameters of the robot model are rigorouslyrequired and they are even more sensitive in the con-troller response than the PD gains, which it means thatthose parameters must be well known for an optimumoperation of the closed loop system. If the behavior ofthe plant is properly described, the classical computedtorque control (CTC) provides an appropriate trackingcontrol for robotic systems. Therefore, a complete pa-rameter identifier system based on fuzzy systems andan adaption law will provide the functions that describethe model of the robot regardless the unknown parame-ters.

    3 Adaptive fuzzy controlFrom the dynamics of the robot we can write the jointacceleration vector as follows:

    q = M(q)1[C(q, q)q + g(q) + fv(q)] +M(q)1(3.1)

    Now consider the general form for a single-input single-output non linear system

    xn = f(x) + g(x)u (3.2)y = x y, u IR, x IRn

    with g(x) 6= 0 so as to ( 3.2) be controllable.According to the latter, ( 3.1) can be rewritten in amulti-input multi-output scheme as

    q = F (q, q) +G(q, q) (3.3)

    with F (q, q) = M(q)1[C(q, q)q+g(q)+ fv(q)] andG(q, q) =M(q)1. In this case F (q, q) and G(q, q) aren 1 and nn matrices respectively. As the functionsF (q, q) andG(q, q) will be estimated by a fuzzy system,the computed torque control law takes the form

    = G(q, q)1[qd +Kv q +Kpq F (q, q)] (3.4)

    Where F (q, q) =

    f1(q, q)...

    fn(q, q)

    and G(q, q) =

    g11(q, q) g1n(q, q)...

    . . ....

    gn1(q, q) gnn(q, q)

    denote the estimates of

    the respective function matrices with fi(q, q) andgij(q, q) being their respective elements.

  • This controller is known as indirect adaptive fuzzycontrol, because the control law is computed from theestimates of the dynamic functions of the plant [8].

    3.1 Fuzzy systemA fuzzy rule base system, for the case of two inputx1, x2, and one output y, consists of a set of fuzzyIFTHEN rules comprising the following rules (namedRl1l2)

    IF x1 is Al11 AND x2 is Al22 THEN y is Bl1l2 (3.5)

    where for each input fuzzy set Alii and output fuzzy setBl1l2 exists an input membership function Alii (xi) andoutput membership function Bl1 l2 (y), respectively,with li = Ni12 , ,1, 0, 1, ,

    Ni12 , and i = 1, 2

    for the case of two inputs. N1 is the number of fuzzysets for input 1, and N2 is the number of fuzzy sets forinput 2.In order to achieve the control law we recall the fuzzysystems property as universal approximators. Fuzzysystems can perform a non linear mapping with themore accuracy as the design involves; this is discussedin the Theorem 1 [8].

    Theorem 1. Suppose that the input universe of dis-course U is a compact set in IRn. Then, for any givenreal continuous function g(x) on U and an arbitrary > 0, there exists a fuzzy system f(x) in the form of

    f(x) =

    N1i1=1

    N2i2=1 y

    i1i2(Ai11 (x1)Ai22 (x2)

    )

    N1i1=1

    N2i2=1

    (Ai11 (x1)Ai22 (x2)

    )

    (3.6)

    such that

    supxU

    |f(x) g(x)| < (3.7)

    where yi1i2 is the center of the (i1, i2)th output mem-bership function. It means that fuzzy systems are uni-versal approximators; that is, they can approximate anyfunction on a compact set to arbitrary accuracy (de-noted by ). The accuracy of the approach dependsupon the information of the system to approxime andthe complexity of the fuzzy systems. The approxima-tion accuracy can be found as

    ||g(x) f(x)|| g(x)x1

    h1 +

    g(x)x2

    h2

    + . . .+g(x)xn

    hn (3.8)

    where || || = supxU |d(x)| is the infinite norm, hi =max1jNi1 |c

    j+1i c

    ji |, with cki as the center of the

    membership function k = j or k = j + 1 (according tothe case) of the input i, where i=1,2. . . n, and n is thenumber of inputs of the fuzzy system [8].4In the proposed control law, we can approach the un-known functions using fuzzy systems with singletonfuzzifier, Ni (odd) triangular membership functions foreach input, with i = 1, 2 (see Fig. 3.1), n =M adapta-tion parameters as singleton membership function forthe output (see Fig. 3.2), rule base defined by ( 3.5)for two inputs, max-prod inference and center averagedefuzzifier as follows:

    fj(x|f ) =

    p1l1=1

    pnln=1 y

    l1lnf

    (2i=1 Alii (xi)

    )

    p1l1=1

    pnln=1

    (2i=1 Alii (xi)

    )

    for j = 1, . . .n (3.9)

    gjk(x|g) =

    q1l1=1

    qnln=1 y

    l1lng

    (2i=1 Blii (xi)

    )

    q1l1=1

    qnln=1

    (2i=1 Blii (xi)

    )

    for j = 1, . . .n, k = 1, . . . n (3.10)

    Where yl1lnf are the free parameters in f

    IRn

    i=1 pix1, that is f =

    y1...1f...

    yl1...lnf

    with pi = l1 ln,

    and yl1lng are the free parameters in g IRn

    i=1 rix1,

    that is g =

    y1...1g...

    yl1...lng

    with ri = l1 ln, so we can

    rewrite ( 3.9) and ( 3.10) as

    fj(x|f ) = Tf (x) (3.11)

    gjk(x|g) = Tg (x) (3.12)

    with (x) a vector of dimensionsn

    i=1 pi 1, whoseelements are

    l1ln(x) =

    2i=1 Alii (xi)p1

    l1=1 pn

    ln=1

    (2i=1 Alii (xi)

    ) (3.13)

    and (x) a vector of dimensionsn

    i=1 qi 1, whose el-ements are

    l1ln(x) =

    2i=1 Blii (xi)q1

    l1=1 qn

    ln=1

    (2i=1 Blii (xi)

    ) (3.14)

  • Fig. 3.1: Input membership functions

    Fig. 3.2: Output membership functions

    Then, introducing the robot variables, the fuzzy ap-proximators can be written in a compact form as

    F (q, q|f ) = Tf (q, q) (3.15)

    G(q, q|g)1 = Tg (q, q), (3.16)

    while (q, q) and (q, q) are n 1 adaptive para-

    meters vectors and f =

    f1 0 0

    0. . . 0

    0 0 f2

    IRnpinpi , (q, q) =

    1...n

    IRnpi ,

    g =

    g11 g1n...

    . . ....

    gn1 gnn

    IRnrinri ,

    (q, q) =

    1...n

    IRnri .

    The designed fuzzy rule base is summarized in the lookup Table 3.1.

    Fig. 3.3: Closed loop system

    3.2 Stability analysis

    The closed loop system (see Fig. 3.3) is obtained bycombining the robot dynamic model ( 3.3) with thecontrol law ( 3.4). Introducing the acceleration of thedesired trajectory (qd) we get the acceleration error

    q = Kv q Kpq+F (q, q|f ) + G(q, q|g) F (q, q)G(q, q)

    (3.17)

    Define =[1 2 n

    ]T = [F (q, q|f ) F (q, q)] + [G(q, q|g) G(q, q)] as the minimumapproximation error where F (q, q|f ) and G(q, q|

    g)

    are the best (max-prod) approximators of F (q, q) andG(q, q) respectively between all the fuzzy approxima-tors of the form ( 3.9) y ( 3.10); then ( 3.17) can beequivalently rewritten as

    ddt

    [qq

    ]:= e = Ae+B (3.18)

    where

    A =[

    0 IKp Kv

    ] IR2n2n (3.19)

    B =[

    0F (q, q|f ) F (q, q|f ) + [G(q, q|g) G(q, q|g)] +

    ]

    IR2n

    In order to carry out the stability analysis we propose

  • Table 3.1: Lookup table for the fuzzy rule base.

    l1 = 2 l1 = 1 l1 = 0 l1 = 1 l1 = 2x2\ x1 NB NS ZE PS PB

    l2 = 2 NB 1 2 3 4 5l2 = 1 NS 6 7 8 9 10l2 = 0 ZE 11 12 13 14 15l2 = 1 PS 16 17 18 19 20l2 = 2 PB 21 22 23 24 25

    the following Lyapunov function candidate:

    V (q, q, f , g) =12[

    q

    T q

    T ]P[

    q

    q

    ]

    +n

    i=1

    12i

    [fi fi ]

    T [fi fi ]

    +n

    i=1

    n

    j=1

    12ij

    [gij gij ]

    T [gij gij ]

    with P = P T > 0 satisfying the Lyapunov equationATP PA = Q where Q = QT > 0. The first termof V (q, q,f ,g) is a positive definite function with re-spect to q and q because the positive definiteness ofP . The remain terms are also positive because theyare quadratic terms. So that, V (q, q,f ,g) is globallypositive-definite and radially unbounded function.The time derivative of the Lyapunov function candidatealong of the trajectories from ( 3.18) is given by

    V (q, q,f ,g) =12[ qT qT

    ]P[qq

    ]

    +12[qT qT

    ]P[ qq

    ]

    +n

    i=1

    1i[fi

    fi ]

    T fi

    +n

    i=1

    n

    j=1

    1ij

    [gij gij ]

    T gij

    (3.20)

    Inspired from [21] we take P = P T > 0 as

    P =[Kp + Kv I

    I I

    ](3.21)

    where the smallest eigenvalue of Kv (min{Kv}) satis-

    fies min{Kv} > > 0. We can reduce ( 3.20) asV (q, q, f , g) =

    12[

    q

    T q

    T ]Q[

    q

    q

    ]

    +n

    i=1

    (qi + qi)i

    +n

    i=1

    1i[

    fi fi]T[

    fi + i(qi + qi)i(q, q)]

    +n

    i=1

    n

    j=1

    1ij

    [

    gij gij

    ]T

    [

    gij + ij(qi + qi)ij(q, q)j]

    (3.22)

    From ( 3.22) we can obtain the following update lawsfor the parameters such that their respective termsare cancelled

    fi = i(qi + qi)i(q, q) (3.23)gij = ij(qi + qi)ij(q, q)j (3.24)

    with i = 1, 2 . . . n and j = 1, 2 . . . n.When accomplishing the previous update laws, the timederivative of the Lyapunov function is reduced to

    V (q, q,f ,g) = 12[qT qT

    ]Q[qq

    ]

    +n

    i=1(qi + qi)i (3.25)

    Let min{Q} be the smallest eigenvalue of Q, then from( 3.25) we have

    V 12[min{Q} 1]

    qq

    2

    12

    [qq

    2

    2[qT qT

    ] [

    ]+

    2]

    +12

    [

    ] 2

    12[min{Q} 1]

    qq

    2

    +12

    2

    (3.26)

  • Since the fuzzy systems are universal approximators,we can make the minimum approximation error arbi-trarily small by using more rules to construct the fuzzy

    system (

    < ). Hence, by stability theory of

    perturbed systems is possible to conclude that[qq

    ]

    and[fg

    ]are uniformly bounded, and

    [qq

    ]is uni-

    form ultimately bounded.Furthermore, integrating both sides of ( 3.26) and se-lecting [min{Q}] > 1 we have t

    0

    q

    q

    2

    d

    2min{Q} 1

    [

    V (0) + t

    0

    2

    d]

    = 2min{Q} 1V (0) + 2min{Q} 1

    t

    0

    2

    d

    if is square integrable, then[qq

    ]is also square

    integrable and from ( 3.18),[ qq

    ]is also bounded;

    then, from Barbalat Lemma we can conclude that

    limt[qq

    ]=[00

    ] IR2n.

    So we have proven the following

    Proposition 1. Consider the indirect adaptive fuzzycontrol system given by ( 3.4), ( 3.15), ( 3.16), (3.23) and ( 3.24) in closed loop with the robot dy-

    namics ( 2.1). The states[qq

    ]and

    [figij

    ]are

    uniformly bounded, and[qq

    ]is uniformly ultimately

    bounded. Furthermore, if is square integrable, then

    limt[qq

    ]=[00

    ] IR2n.

    4

    4 Experimental evaluation4.1 Experimental setup

    In order to verify the effectiveness of the proposed adap-tive fuzzy control, an extensive number of realtimecontrol experiments on a well identified directdrive ro-bot arm were carried out. The experimental robot is atwo axis directdrive robot arm built at CICESE Re-search Center [22], [23]. The arm moves in the verticalplane as shown in Figure 4.1. The actuators are directdrive brushless motors operated in torque mode, so theyact as torque source and accept an analog voltage as a

    reference of torque signal. The control algorithm is ex-ecuted at 2.5 msec sampling period in a control board(based on a DS1103 32/64bit floating point DSP boardrunning with a 400Mhz microprocessor) mounted on aPC host computer.

    Fig. 4.1: Robot arm

    The entries of the dynamics ( 2.1) of this two degreesoffreedom directdrive robotic armC(q, q) has beenchosen using Christoffel symbols, are given by [22]and [23]

    M(q) =[

    2.351 + 0.168 cos(q2) 0.102 + 0.084 cos(q2)0.102 + 0.084 cos(q2) 0.102

    ]

    ,

    C(q, q) =[

    0.084 sin(q2)q2 0.084 sin(q2)(q1 + q2)0.084 sin(q2)q1 0

    ]

    ,

    g(q) = 9.81[

    3.921 sin(q1) + 0.186 sin(q1 + q2)0.186 sin(q1 + q2)

    ]

    ,

    fv(q) =[

    2.288q1 + 8.049 sgn(q1)0.186q2 + 1.734 sgn(q2)

    ]

    According to the actuators manufacturer, the directdrive motors are able to supply torques within the fol-lowing bounds

    |1| max1 = 150 [Nm],|2| max2 = 15 [Nm].

    4.2 Design parameters

    The proposed controller have to estimate the F (q, q|f )and G(q, q|g)1 functions in order to calculate thecontrol law. These functions are computed with six

  • different fuzzy systems

    F (q, q|f ) =[f1(q, q)f2(q, q)

    ]=[Tf11(q, q)Tf22(q, q)

    ]

    G(q, q|g)1 =[g11(q, q)1 g12(q, q)1g21(q, q)1 g22(q, q)1

    ]

    =[Tg1111(q, q)

    Tg1212(q, q)

    Tg2121(q, q) Tg2222(q, q)

    ]

    From the knowledge of the structure of the 2 degreesoffreedom robot model we know that Tg1212(q, q) =Tg2121(q, q), thus we have not six but five differentfuzzy systems to be constructed. Also we can expectTg2222(q, q) to be a constant value. Every fuzzy sys-tem receives two inputs whose universe of discoursewere partitioned in five fuzzy sets: A2j = NB (Nega-tive Big), A1j = NS (Negative Small), A0j = ZE (Zero),A1j = PS (Positive Small), and A2j = PB (Positive Big),with j = 1, 2. We selected triangular membership func-tions

    Aljj(xj) for both inputs.

    In all cases the input membership functions are sym-metrical with respect to zero. This is shown in Figures3.1 and 3.2, where pxj = {p2j ,p1j , p0j , p1j , p2j} isthe set of the bounds of fuzzy set support (also calledfuzzy partition of the universe of discourse) which de-fines the input membership functions. The final parti-tions of the universes of discourse were (in agreementwith the used notation pA = {p2,p1, p0, p1, p2}):For q:

    pq1 = {60,30, 0, 30, 60} [degrees]

    pq2 = {60,30, 0, 30, 60} [degrees].

    For q:

    pq1 = {180,60, 0, 60, 180} [degrees/s]

    pq2 = {180,60, 0, 60, 180} [degrees/s].

    The F (q, q|f ) fuzzy sets have q1 and q2 as inputswhereas q2 and q2 are the inputs for the G(q, q|g)1fuzzy sets.It can be seen that, for any input, the sum of the mem-bership values of two adjacent fuzzy sets is one, and themembership value for any xj > p2j , xj < p2j is equalto one. Also, as we can see from Figure 3.1, only fourrules are fired in a given instant. Since both inputs have5 fuzzy sets (N1 = 5 and N2 = 5), then the number ofrules is M = 25 and it involves n = 25 product terms;every of these terms have its corresponding singletonmembership function whose center is given by an adap-tation parameter . This fact converts the fuzzy systeminto adaptive fuzzy system.

    4.3 Desired taskThe desired position trajectory, is given by

    qd(t) =

    [

    b1[1 ed1t3] + c1[1 ed1t

    3] sin (1t)

    b2[1 ed2t3] + c2[1 ed2t

    3] sin (2t)

    ]

    [rad]

    (4.1)and was inspired from the structure of desired trajecto-ries used by other authors for experimental evaluationof control algorithms [24, 25].In our application, the first term of ( 4.1) was chosento exhibit a motion profile without abrupt changes inposition, velocity and acceleration but at the same timeto exploit the arm in its fastest motion without invadingthe actuators saturating zone.In expression ( 4.1), 1 and 2 represent the frequencyof desired trajectory for the shoulder and elbow jointsrespectively. In our experimental tests, we use 1 = 7.5rad/s and 2 = 1.75 rad/s.To quantify the control performance, we use the rootmean square average of tracking error (based on the L2norm of the tracking errors q) given by

    L2[q] =

    1

    T t0

    T

    t0qT q dt (4.2)

    where T represents the total experimentation time andt0 is the initial time of interest.Besides the adaptive fuzzy control (AFC), a classicalcomputed torque control (CTC) was tested so as tocompare their closed loop response and make conclu-sions.

    4.4 Experimental resultsThe experimental results are depicted in the Figs. 4.2to 4.4. Fig. 4.2 shows position joints, position errorsand applied torques for the classical computed torquecontrol. For the desired trajectory the computed torquecontrol achieves a good tracking in both joints. It can-not reduce near to zero the position errors due to nonmodeled friction in the joints. Also, notice that the ap-plied torques are far of the manufacturer torque limits.Now, Fig. 4.3 refers to the position joints, position er-rors and applied torques for the indirect adaptive fuzzycontrol. The robot response are quite well for bothjoints. We recall that this controller does not resort inknown parameters of the robot, but only in the estima-tion of descriptive functions of the model via adaptivefuzzy systems. Comparing to the computed torque con-trol, the main difference lies in the position error of thesecond joint, which is a little bigger with this proposedcontroller.Alternatively, Fig. 4.4 shows the estimated functionsfrom the adaptive fuzzy systems and the real value of

  • 0 2 4 6 8 1020

    0

    20

    40

    60

    t [seg]

    1[N

    m]

    Applied torques

    0 2 4 6 8 101

    0.5

    0

    0.5

    1

    t [seg]

    q 1[deg]

    Position errors

    0 2 4 6 8 101

    0.5

    0

    0.5

    1

    t [seg]q 2

    [deg]

    0 2 4 6 8 10

    4

    2

    0

    2

    4

    6

    t [seg]

    2[N

    m]

    0 2 4 6 8 100

    20

    40

    60

    t [seg]

    q 1[deg]

    Desired and actual positions

    0 2 4 6 8 10

    50

    0

    50

    100

    150

    200

    t [seg]

    q 2[deg]

    qd1

    q2qd2

    q1

    Fig. 4.2: Graphic results for the CTC

    0 2 4 6 8 1020

    0

    20

    40

    60

    t [seg] 1

    [Nm]

    Applied torques

    0 2 4 6 8 101

    0.5

    0

    0.5

    1

    t [seg]

    q 1[deg]

    Position errors

    0 2 4 6 8 102

    1

    0

    1

    2

    t [seg]

    q 2[deg]

    0 2 4 6 8 10

    4

    2

    0

    2

    4

    6

    t [seg]

    2[N

    m]

    0 2 4 6 8 100

    20

    40

    60

    t [seg]

    q 1[deg]

    Desired and actual positions

    0 2 4 6 8 10

    50

    0

    50

    100

    150

    200

    t [seg]

    q 2[deg]

    q1qd1

    q2qd2

    Fig. 4.3: Graphic results for the AFC

    0 2 4 6 8 1020

    0

    20

    40

    60

    t [seg]

    f 2,f

    2

    [1

    seg2

    ]

    0 2 4 6 8 100

    0.05

    0.1

    0.15

    0.2

    t [seg]

    g1

    12,g1

    12

    [1

    kgm

    2

    ]

    0 2 4 6 8 1050

    0

    50

    t [seg]

    f 1,f

    1

    [1

    seg2

    ]

    0 2 4 6 8 102.1

    2.2

    2.3

    2.4

    2.5

    2.6

    t [seg]

    g1

    11,g1

    11

    [1

    kgm

    2

    ]

    0 2 4 6 8 100.1014

    0.1016

    0.1018

    0.102

    0.1022

    0.1024

    t [seg]

    g1

    22,g1

    22

    [1

    kgm

    2

    ]

    f1

    f1

    f2

    f2

    g111

    g112

    g122

    g122

    g112

    g111

    Real and approximated functions

    Fig. 4.4: Real and estimated functions

  • Table 5.1: Performance indexes.

    Controller L2[q]CTC 0.3421 AFC 0.4272

    those functions computed through the known model ofthe robot. It is not guaranteed that the estimators fol-lows the real values of the functions, but it does notmean that the control objective is not accomplished.

    4.5 Concluding remarks ofexperiments

    According to the desired trajectory which was used totest the controllers, the classical computed torque con-trol and the indirect adaptive fuzzy control have similarresponses, but the indirect adaptive fuzzy control hasthe advantage that does not require the model of therobot to compute the control law. Performance indexesare the L2 norm of the tracking position errors, whichare shown in Table 5.1 and Fig. 5.1. Fig. 5.2 shows theL2 norm of the tracking position errors for each joint.

    5 ConclusionsIn this paper an indirect adaptive fuzzy control for ro-bot manipulators was proposed. To this end we ex-tended the single input single output indirect adap-tive fuzzy approach to the general case of multiinputmultioutput systems. Via Lyapunov theory and sta-bility theory of perturbed systems, we proved that thestates of the closed loop system, that is, the velocity andposition errors and the parameters of the fuzzy systemare bounded and furthermore the velocity and positionerrors are uniformly and ultimately bounded.The controller was experimentally validated on a 2 dofrobot manipulator achieving excellent results. A per-formance comparison was made between the proposedadaptive fuzzy control and the classic computed torquecontrol, resulting with a similar response but our pro-posed adaptive fuzzy control has the advantage of notrequiring the knowledge of any parameter of the robotmodel in contrast with the computed torque controlwhich require the overall knowledge of the dynamicsrobot.

    ACKNOWLEDGEMENT

    Work partially supported by DGEST and CONACyT(grant 45826).

    REFERENCES

    0

    0.1

    0.2

    0.3

    0.4

    0.5

    Norm

    orerrors

    [deg]

    1

    0.3421

    1

    0.4272

    1

    CTC

    1

    AFC

    1

    Fig. 5.1: L2 norm for both control techniques

    0

    0.2

    0.4

    0.6

    0.8

    Norm

    orerrors

    [deg]

    1

    0.4361

    1

    0.2046

    1

    0.6497

    1

    0.2480

    1

    joint 1

    1

    joint 2

    1

    CTC

    1

    AFC

    1

    Fig. 5.2: L2 norm of each joint for both control techniques

    [1] M. A. Llama, R. Kelly, and V. Santibanez, Sta-ble computedtorque control of robot manipula-tors via fuzzy selftuning, IEEE Transactionson Systems, Man, and CyberneticsPart B Vol. 30,pp. 143150, Feb. 2000.

    [2] W. Chen, J. K. Mills, J. Chu and D. Sun, A fuzzycompensator for uncertainty of industrial robots,Proc. of 2001 ICRA. IEEE International Confer-ence on Robotics and Automation, 2001, pp. 29682973, 2001.

    [3] M. A. Llama, R. Kelly, and V. Santibanez, A Sta-ble Motion Control System for Manipulators viaFuzzy SelfTuning,, Fuzzy Sets and Systems Vol.124, No. 2, pp. 133154, Dec. 2001.

    [4] V. Santibanez, R. Kelly, and M. A. Llama, GlobalAsymptotic stability of a tracking sectorial fuzzycontroller for robots manipulators, IEEE Trans-actions on Systems, Man, and CyberneticsPart BVol. 34, pp. 710718, Feb. 2004.

  • [5] Y. L. Sun and M. J. Er, Hybrid fuzzy control ofrobotics systems, IEEE Transactions on FuzzySystems Vol. 12, No. 6, pp. 755765, Dec. 2004.

    [6] V. Santibanez, R. Kelly, and M. A. Llama, ANovel Global Asymptotic Stable Set-Point FuzzyController with Bounded Torques for Robot Ma-nipulators, IEEE Transactions on Fuzzy SystemsVol. 13, No. 3, pp. 362372, Jun. 2005.

    [7] S.Wen; H. Yang, Fuzzy adaptive PD control forrobot and experiment study, Machine Learningand Cybernetics. Proceedings of 2005 InternationalConference Vol. 2, pp 834839, Aug 2005.

    [8] L. X. Wang, A Course in Fuzzy Systems and Con-trol, Prentice Hall PTR, Upper Saddle River N.J.,1997

    [9] R. Ordonez, J. Zumberge, J. Spooner, and K.Passino, Adaptive Fuzzy Control: Experimentsand Comparative Analyses, IEEE Transactionson Fuzzy Systems Vol. 5, pp 167188, May 1997.

    [10] H. Dac Loc, T. Thu Ha and N Cao., An adaptivefuzzy logic controller for robot-manipulator, In-ternational Journal of Advanced Robotic SystemsVol. 1, pp 115117, 2004.

    [11] Y. Cho, K. Seo, and H. Lee, A Direct AdaptiveFuzzy Control of Nonlinear Systems with Appli-cation to Robot Manipulator Tracking Control,International Journal of Control, Automation, andSystems Vol. 5, pp 630642, Dec 2007.

    [12] M. Liu Stability Analysis of Decentralized Adap-tive Fuzzy Logic Control for Robot Arm Tracking,Proceedings of the 39th IEEE Conference on De-cision and Control, 2000, Vol. 1, pp 883888, Dec2000.

    [13] S.S. Neo, M.J Er, Adaptive fuzzy control of ro-bot manipulators, Control Applications, Proceed-ings of the 4th IEEE Conference, pp. 724729,Sep.1995.

    [14] Y. Jin, Decentralized Adaptive Fuzzy Control ofRobot Manipulators, IEEE Transactions on Sys-tems, Man, and CyberneticsPart B Vol. 1, pp 4757, Feb 1998.

    [15] W. Sun and Y. Wang, An Adaptive Fuzzy Con-trol for Robotic Manipulators, Proc. of 20048th International Conference on Control, Automa-tion, Robotics and Vision, pp. 19521956. Kun-ming China, Dec. 2004.

    [16] E. Kim, Output Feedback Tracking Control ofRobot Manipulators with Model Uncertainty viaAdaptive Fuzzy Logic, IEEE Transactions onFuzzy Systems Vol. 12, No. 3, pp 368378, Jun2004.

    [17] Y. Touati and E. H. Rebaa, Fuzzy Adaptive Con-troller Design Methodology for Robotics Systems,Proc. of The 14th IEEE International Conferenceon Fuzzy Systems, 2005. FUZZ 05, pp. 921926.Reno, NV, May. 2005.

    [18] H. Yousef, E. El-Madbouly, D. Eteim and M.Hamdy, Adaptive fuzzy semi-decentralized con-trol for a class of large-scale nonlinear sys-tems based on input-output linearization concept,Proc. of International Conference on ComputerEngineering and Systems, 2007. ICCES 07, pp.2732. Cairo Egypt, Nov. 2007.

    [19] R.J. Wai and Z.W. Yang, Adaptive Fuzzy NeuralNetwork Control Design via a TS Fuzzy Model fora Robot Manipulator Including Actuator Dynam-ics, IEEE Transactions on Systems, Man, andCyberneticsPart B Vol. 38, No. 5, pp. 13261346,Oct. 2008.

    [20] M. Spong, S. Hutchinson and M. Vidyasagar, Ro-bot Modeling and Control, New York: John Wileyand Sons, 2006.

    [21] R. Kelly, V. Santibanez and A Loria, Controlof Robot Manipulators in Joint Space, Springer-Verlag, 2005.

    [22] F. Reyes, and R. Kelly, Experimental evaluationof identification schemes on a directdrive robot,Robotica, Vol. 15, pp. 563571, 1997.

    [23] F. Reyes, and R. Kelly, Experimental evaluationof modelbased controllers on a directdrive robotarm, Mechatronics, Vol. 11, pp. 267282, 2001.

    [24] D. M. Dawson, J. J. Carroll and M. Schneider,Integrator backstepping control of a brush DCmotor turning a robotic load, IEEE Transactionson Control System Technology, Vol. 2, pp. 233244,Sept. 1994.

    [25] M. S. De Queiroz, D. Dawson and T. Burg, Re-examination of the DCAL controller for rigid linkrobots, Robotica, Vol. 14, pp. 4149, 1996.