Está en la página 1de 7

Congreso Nacional de Control

Automtico, AMCA 2015,


339
Cuernavaca, Morelos, Mxico.

Control de Movimiento de Robots


Manipuladores va Inmersion e Invariancia:
Casos particulares
Fernando Castaneda, Francisco Jurado, Vctor Santibanez

Tecnologico Nacional de Mexico, Instituto Tecnologico de la Laguna,
Blvd. Revolucion y Calzada Cuauhtemoc S/N, C.P. 27000, Torreon,
Coahuila de Zaragoza, Mexico.
(e-mail:[jfcastaneda][fjurado][vsantiba]@itlalaguna.edu.mx)

Resumen: El objetivo del presente trabajo es mostrar como la metodologa Inmersion e


Invariancia (I&I) aplicada para el caso de control de robots manipuladores resulta ser mas
general en el sentido que se pueden obtener leyes de control de movimiento con estructura
similar a las leyes de control clasicas para robots manipuladores sin la necesidad de recurrir
al analisis de estabilidad en el sentido de Lyapunov para el sistema completo. En el presente
trabajo, el principio fundamental para la obtencion de las leyes de control estabilizadoras por
realimentacion de estados va I&I se centra en la seleccion de la dinamica objetivo como un
sistema lineal y desacoplado dependiente unicamente de los errores articulares. El desempeno
de los controladores I&I es validado mediante simulacion.

Palabras Clave: Control no lineal, inmersion, invariancia, robots manipuladores.

1. INTRODUCCION (Sepulchre et al., 1996). La nocion de inmersion tiene


ademas una larga tradicion en la teora de control, su idea
Recientemente, una metodologa para el diseno de contro- basica es la de transformar el sistema en consideracion a un
ladores no lineales y controladores adaptables para siste- sistema con propiedades especficas. Por ejemplo, el pro-
mas no lineales basada en las nociones de inmersion del blema clasico de inmersion de un sistema no lineal generico
sistema a controlar (Nijmeijer and van der Schaft, 1990; dentro de un sistema lineal y controlable por medio de
Isidori, 1995; Byrnes et al., 1997) e invariancia de una va- una realimentacion de estados estatica o dinamica ha sido
riedad disenada con caractersticas particulares (Nijmeijer extensamente estudiada en (Nijmeijer and van der Schaft,
and van der Schaft, 1990; Wiggins, 1990; Isidori, 1995), las 1990; Isidori, 1995). Mas recientemente, la inmersion ha
cuales son herramientas clasicas de la teora de regulacion sido usada en la teora del regulador no lineal en la obten-
no lineal y control geometrico no lineal (Wonham, 1985; cion de condiciones necesarias y suficientes para regulacion
Jouan, 2003), ha sido reportada en la literatura como In- robusta. En particular, en (Byrnes et al., 1997; Isidori,
mersion e Invariancia (I&I) (Immersion and Invariance, 1997) se demuestra que la regulacion robusta puede con-
I&I) (Astolfi et al., 2002; Astolfi and Ortega, 2003; Astolfi seguirse considerando que el exosistema pueda ser inmerso
et al., 2008). dentro de un sistema lineal y observable. En (Michel et al.,
2001), se muestra que un sistema dinamico, posiblemente
El desarrollo de la teora de control geometrico lineal y no de dimension infinita, tiene un equilibrio estable si este
lineal ha demostrado que los subespacios invariantes y sus puede ser inmerso dentro de otro sistema dinamico con
contrapartes no lineales como distribuciones invariantes un equilibrio estable mediante el denominado mapeo de
juegan un papel fundamental en la solucion de muchos preservacion de estabilidad. La estabilizacion va I&I esta
problemas de diseno. Variedades invariantes lentas y rapi- ademas relacionada con el metodo de estabilizacion basado
das, las cuales surgen de manera natural en los sistemas en pasividad (Byrnes et al., 1991; Ortega et al., 1998) y
con perturbaciones singulares, han sido utilizadas para en la teora de disipatividad (Byrnes et al., 1991).
estabilizacion (Kokotovic, 1985) y analisis de sistemas de
adaptacion lenta (Riedle and Kokotovic, 1986). La nocion En el presente artculo se presenta el estudio de la tecnica
de variedades invariantes es ademas crucial en el diseno de I&I aplicada al control de posicion pura y control de movi-
leyes de control estabilizadoras para sistemas no lineales. miento (seguimiento de trayectoria) para robots manipula-
La teora de variedad central (Carr, 1981) ha sido instru- dores. Del estudio en cuestion resulta interesante observar
mento en el diseno de leyes de control estabilizadoras para que se pueden obtener leyes de control con estructuras
sistemas con aproximacion lineal no controlable (Aeyels, similares a las leyes de control clasicas para robots mani-
1985) mientras que el concepto de dinamica cero y la puladores, ademas, el enfoque utilizado para sintonizar las
fuertemente relacionada nocion de variedad cero han sido ganancias del controlador resulta ser diferente.
explotadas en diversos metodos de estabilizacion local y
global, incluyendo el control basado en pasividad (Ortega
et al., 1998), backstepping (Krstic et al., 1995) y forwarding
Reserva de Derechos No. En trmite, ISSN. En trmite
Congreso Nacional de Control
Automtico, AMCA 2015,
340
Cuernavaca, Morelos, Mxico.

2. METODOLOGIA I&I Y EL ENFOQUE CLASICO Ademas, consideraciones similares pueden plantearse para
PARA EL CONTROL DE MOVIMIENTO DE abordar el problema de seguimiento.
ROBOTS MANIPULADORES El principio de estabilizacion de un punto de equilibrio de
un sistema no lineal va I&I es mostrado en el siguiente
La idea basica del enfoque I&I es conseguir el objetivo teorema (Astolfi et al., 2008).
de control mediante la inmersion de la dinamica de la Teorema 1. Considere el sistema
planta dentro de un sistema objetivo, de orden menor,
que capture el comportamiento deseado. El problema de x = f (x) + g(x)u (1)

control es luego reducido al diseno de una ley de control con x R , u R y un punto de equilibrio x Rn
n m
que garantice que el sistema controlado asintoticamente a ser estabilizado. Suponga que existen mapeos suaves
se comporte como el sistema objetivo. La metodologa I&I : Rp Rp , : Rp Rn , : Rn Rnp , c : Rn Rm
requiere de la seleccion de un sistema dinamico objetivo, lo y v : Rn(np) Rm , con p < n, tales que sostengan lo
cual no es una tarea trivial ya que la solucion del problema siguiente:
fundamental de diseno del control depende de tal seleccion.
La seleccion de la dinamica objetivo lineal para sistemas (C1) Sistema dinamico objetivo. El sistema objetivo es
fsicos no es necesariamente la mas adecuada, ya que, por definido por
un lado, los disenos realizables podran tomar en cuenta = (), (2)
las restricciones impuestas por la estructura fsica y, por
el otro lado, es bien sabido que muchos de los sistemas donde Rp tiene un equilibrio globalmente asintotica-
fsicos no son linealizables por realimentacion. Este no mente estable en Rp y
es el caso cuando se aborda el estudio para el control x = ( ).
de robots manipuladores ya que como se sabe, la ley de
control por par calculado permite obtener un sistema lineal (C2) Condicion de Inmersion. Para todo ,
en lazo cerrado en terminos de las variables de estado. El
enfoque utilizado para estudiar y obtener controladores f (()) + g(())c(()) = (). (3)
para robots manipuladores como es el caso del control
PD mas compensacion pre-calculada de gravedad, PD
(C3) Variedad implcita. El conjunto identidad
mas compensacion de gravedad, el control PID y control
por Par-Calculado entre otros, es seleccionar una ley de
control basada en energa o linealizante que estabilizara {x Rn |(x) = 0} = {x Rn |x = (), Rp } (4)
al sistema, para lo cual despues es necesario analizar
se mantiene.
la estabilidad del equilibrio en lazo cerrado utilizando
la teora de Lyapunov; en particular el llamado segundo (C4) Dinamica fuera de la variedad y acotamiento de
metodo de Lyapunov para sistemas no lineales. El metodo soluciones. Todas las trayectorias del sistema
I&I es mas general que los metodos para obtener leyes
de control basadas en la teora de Lyapunov en el sentido
que en este ultimo es necesario primero seleccionar una z = [f (x) + g(x)v(x, z)] , (5)
x
ley de control para posteriormente analizar la unicidad
x = f (x) + g(x)v(x, z), (6)
y estabilidad del equilibrio del sistema en lazo cerrado,
por lo que la estabilidad es analizada para el sistema
completo, lo cual la mayora de las veces no resulta ser estan acotadas y (5) posee un equilibrio globalmente uni-
un tarea facil. Por el contrario, el metodo I&I se aparta formemente asintoticamente estable en z = 0 Rnp ,
de este enfoque debido a que en este se pretende obtener donde z representa el estado de la dinamica fuera de la
una ley de control estabilizadora cumpliendo con ciertas variedad. Luego x es un equilibrio globalmente asintoti-
condiciones, i.e., la ley de control surge al desarrollar la camente estable del sistema en lazo cerrado
metodologa y no es impuesta desde el inicio como en los x = f (x) + g(x)v(x, (x)). (7)
metodos basados en Lyapunov para el control de robots
manipuladores; sin embargo, esto no quiere decir que la
teora de estabilidad de Lyapunov no sea utilizada en esta La prueba para este teorema puede examinarse en (As-
metodologa, de hecho, esta se sigue utilizando pero no tolfi et al., 2008). Los resultados del teorema 1 son in-
para analizar la estabilidad del sistema completo sino para terpretados de la siguiente manera: Dado el sistema (1)
analizar la estabilidad de algunos de los subsistemas que y establecido el sistema (2), el objetivo es encontrar una
surgen al desarrollar la metodologa I&I que pueden ser variedad V descrita implcitamente por {x Rn |(x) = 0}
mas faciles de resolver. y en forma parametrizada por {x Rn |x = ()}, la
cual pueda hacerse invariante y asintoticamente estable
tal que la restriccion en lazo cerrado del sistema para V
3. INMERSION E INVARIANCIA (I&I) sea descrita por = (). Cabe resaltar que el control
v que haga invariante la variedad no sera unico, ya que
A continuacion se exponen las condiciones fundamentales este es unicamente definido solo sobre la variedad V, i.e.,
para la construccion de una ley de control por realimen- v((), 0) = c(()). De todos los posibles controles se
tacion de estados, estatica, globalmente asintoticamente debera seleccionar aquel que lleve la coordenada z a cero
estabilizadora para sistemas no lineales, las cuales son y mantenga acotadas las trayectorias del sistema, i.e., tal
parte del resultado basico de la estabilizacion por I&I. que la condicion (C4) sea satisfecha.
Octubre 14-16, 2015.
Congreso Nacional de Control
Automtico, AMCA 2015,
341
Cuernavaca, Morelos, Mxico.

Definicion 1. Un sistema descrito por ecuaciones de la como q = q d q donde q d Rn representa el vector de


forma (1) con dinamica objetivo (2) se dice que es (lo- posiciones deseadas constantes de las variables articulares
calmente) I&I estabilizable si las condiciones (C1)-(C4) del robot manipulador, luego, el modelo (8) puede expre-
del teorema 1 se cumplen (localmente). sarse en terminos del vector de estado x = [ q T q T ]T
como
4. MODELO DINAMICO DE ROBOTS
   
d q q
MANIPULADORES = (9)
dt q M (q)1 [ C(q, q)q g(q)]
El modelo dinamico para robots manipuladores de n g.d.l. donde x R2n . Aplicando la metodologa I&I para el con-
esta descrito por la ecuacion trol de posicion del sistema (9), se comienza por seleccionar
el sistema dinamico objetivo para luego buscar satisfacer
M (q)q + C(q, q)q + g(q) = (8)
las suposiciones (C2)-(C4).
donde M (q) Rnn es la matriz de inercia, C(q, q)
Rnn es la matriz de fuerzas centrfugas y de Coriolis, (C1) Sistema dinamico objetivo. Se establece el sistema
g(q) Rn es el vector de fuerzas o pares gravitacionales objetivo
y Rn es el vector de fuerzas o pares externos. = K (10)
Los vectores q, q, q Rn representan las posiciones, donde Rn y K > 0 es una matriz diagonal de diseno
velocidades y aceleraciones de las variables articulares del con coeficientes constantes, i.e., K = diag {k1 , k2 , ..., kn }.
robot, respectivamente. El modelo dinamico (8) cuenta con El sistema (10) tiene un equilibrio globalmente asintotica-
propiedades que son de gran utilidad cuando se estudia la mente estable en = 0 Rn .
estabilidad del sistema en lazo cerrado con alguna ley de
control . Algunas de estas propiedades son descritas a (C2) Condicion de inmersion. La condicion de inmersion
continuacion. requiere de la seleccion de un mapeo entre los estados del
sistema dinamico del robot manipulador y los estados del
Propiedad 1. Matriz de inercia M (q).
sistema objetivo. Este mapeo es definido como
La matriz de inercia M (q) es una matriz simetrica definida    
positiva de n n cuyos elementos son funciones solamente q 1 ()
x= =
de q. Existe una constante real positiva tal que q 2 ()
M (q) I q Rn de donde se selecciona 1 () = , debido a que se desea que
donde I denota la matriz identidad de orden n n. La el comportamiento de las trayectorias del vector de errores
matriz M (q)1 existe y es definida positiva. articulares sea el mismo que el definido por el sistema
Propiedad 2. Matriz de Coriolis C(q, q). (10), i.e., que las trayectorias tengan un comportamiento
La matriz de fuerzas centrfugas y de Coriolis C(q, q) es exponencial decreciente. Sustituyendo el mapeo conocido
una matriz de n n cuyos elementos son funciones de q 1 () en (9) como se describe en (3) se tiene
y q. La matriz C(q, q) puede no ser unica, pero el vector 2 () = K,
C(q, q)q es unico. C(q, 0) = 0 para todo vector q Rn . con lo que el mapeo () queda definido completamente
La matriz C(q, q) esta relacionada con la matriz de inercia como      
M (q) por la expresion q 1 ()
x= = = .
q 2 () K
 
T 1
x M (q) C(q, q) x = 0 q, q, x Rn
2
(C3)Variedad Implcita. Se define el siguiente conjunto
y de hecho 12 M (q) C(q, q) es una matriz antisimetrica. identidad
Propiedad 3. Vector de gravedad g(q). V = x R2n |(x) = 0 =

El vector de pares gravitacionales g(q) de n 1 depende
x R2n |q = , q = K Rn

solo de las posiciones articulares q. El vector g(q) esta
acotado si q lo esta tambien. Para el caso de robots de donde se satisface que el orden del sistema dinamico
provistos unicamente de articulaciones rotacionales, el objetivo (10) es menor que el orden del sistema (9). Ahora,
vector g(q) es Lipschitz, i.e., existe una constante kg > 0 una funcion (x) que cumple con el conjunto identidad
tal que definido anteriormente puede ser
kg(x) g(y)k kg kx yk (x) = q K q = 0
para todo x, y Rn . con lo que queda definida por completo la variedad V.
5. CONTROL DE POSICION VIA I&I (C4) Dinamica fuera de la variedad y acotamiento de
soluciones. Se define la siguiente coordenada
El objetivo de control de posicion para robots manipula- z , (x) = q K q
dores consiste en encontrar una ley de control por reali-
mentacion de estados tal que las trayectorias q(t) del donde la derivada de z a lo largo de las trayectorias del
sistema (8) en lazo cerrado sean iguales a las posiciones sistema (9) queda definida como
constantes deseadas de las variables articulares del robot z = M (q)1 [ C(q, q)q g(q)] + K q. (11)
manipulador, i.e., Luego, habra de seleccionarse una entrada de control
lm [q d (t) q(t)] = 0. tal que el subsistema (11) tenga un equilibrio globalmente
t
asintoticamente estable en el origen, i.e.,
Para iniciar con el diseno del controlador va I&I , es
necesario definir el vector de error de posicion articular lm z(t) = 0
t
Octubre 14-16, 2015.
Congreso Nacional de Control
Automtico, AMCA 2015,
342
Cuernavaca, Morelos, Mxico.

y que las trayectorias del sistema resultante esten acota- Utilizando el siguiente subsistema
das. Para esto, observe que si es seleccionada como h i
"
z K q
#
d q 1
= z + g(q) (12) = M (q) [z C(q, z + K q)(z + K q) (16)
dt z
+ g(q d ) g(q)] + K[z + K q]
donde > 0 es una matriz diagonal de diseno con
coeficientes constantes, = diag {1 , 2 , ..., n }, con esta se observa que (16) es un sistema no lineal autonomo,
eleccion el sistema (9) se transforma en el cual tiene un equilibrio en el origen [q T z T ]T = 0
 q  " z K q
# R2n . Sin embargo, aparte del origen pueden existir otros
d 1 equilibrios los cuales pueden ser tantos como soluciones de
q = M (q) [z C(q, z + K q)(z + K q)] .
dt 1
q tenga la ecuacion
z M (q) [z C(q, z + K q)(z + K q)] + K[z + K q]
(13) K q = g(q q d ) g(q d ). (17)
Ahora, observe que el subsistema dinamico
h i h i Aunque aqu no se demuestra, si K se escoge suficien-
d q z K q
z
=
M (q)
1
[z C(q, z + K q)(z + K q)] + K[z + K q]
temente grande entonces q = 0 Rn sera la unica
dt
(14) solucion. Esta condicion surge de la aplicacion del teorema
representa una ecuacion diferencial autonoma, debido a de contraccion de mapas a la ecuacion (17), donde se con-
que q d es constante, cuyo equilibrio se encuentra en el cluye que si min {K} > kg (Kelly and Santibanez, 2003)
origen y es unico. Para demostrar la estabilidad del equi- entonces la unica solucion sera q = 0 Rn , por consiguien-
librio de este subsistema se propone la siguiente funcion te el origen del subsistema (16) sera el unico equilibrio.
candidata de Lyapunov Suponga que se selecciona min {K} > kg , entonces se
1 1 propone la siguiente funcion candidata de Lyapunov para
V (q, z) = [z + K q]T M (q)[z + K q] + q T K q analizar la estabilidad del origen del subsistema (16) como
2 2
1
donde V (q, z) > 0 es una funcion definida positiva y la V (q, z) = [z + K q]T M (q)[z + K q] + f (q)
derivada temporal V (q, z) a lo largo de las trayectorias 2
con
del subsistema (14) resulta 1
1 f (q) = q T K q + U(q d q) U(q d ) + g(q d )T q
V (q, z) =
T
[z + K q] M (q)[z + K q] 2
2 
T 1
 donde f (q) es una funcion definida positiva de forma
+[z+K q] M (q) M (q) [z C(q, z + K q)(z + K q)] + K[z + K q]
global si min {K} > kg (Kelly and Santibanez, 2003).
T T
[z + K q] M (q)K[z + K q] q K[z + K q]. Luego V (q, z) es una funcion definida positiva en forma
Simplificando se tiene global cuya derivada a lo largo de las trayectorias del
1 T T
subsistema (16) esta dada por
V (q, z) = [z + K q] M (q)[z + K q] [z + K q] z
2 1
T T
[z + K q] C(q, z + K q)[z + K q] q K[z + K q]. V (q, z) = [z + K q]T M (q)[z + K q]
2
Utilizando la Propiedad 2 y desarrollando terminos final- [z + K q]T
mente se obtiene
[z + K q]T C(q, z + K q)[z + K q]
V (q, z) = [z + K q]T [z + K q],
2 + [z + K q]T [g(q d ) g(q q d )]
V (q, z) min {} kz + K qk ;
U(q d q)
con lo que se concluye que el subsistema (14) tiene un q T K[z + K q] + [z + K q]T
(q d q)
equilibrio globalmente asintoticamente estable en el ori-
gen. Resta ahora solo demostrar que las trayectorias de [z + K q]T g(q d ).
q(t) estan acotadas; para esto observe que debido a la Considerando la Propiedad 2 de antisimetra de M (q) y
conclusion anterior se tiene q(t), z(t) L L2 . Utili- (q d q)
C(q, q) y el hecho de que U(q d q) = g(q q d ), finalmente
zando luego la definicion de z(t) = q K q se concluye
que q(t) L , lo que cumple con la condicion (C4) del se obtiene
teorema 1. De la ley de control (12), si se sustituye la V (q, z) = [z + K q]T q T K[z + K q]
coordenada z segun su definicion se obtiene o equivalentemente
= K q q + g(q), V (q, z) = [z + K q]T [z + K q],
ley de control que tiene la estructura de la conocida ley 2
V (q, z) min {} kz + K qk ;
de control PD mas compensacion de gravedad, con la
diferencia de que las ganancias proporcional y derivativa con lo que se concluye que el subsistema (16) tiene un
son definidas de diferente manera segun el enfoque que le equilibrio globalmente asintoticamente estable en el ori-
imprime la metodologa I&I . gen. Solo resta demostrar que las trayectorias de q(t) estan
acotadas. Para esto, observe que debido a la conclusion
Si ahora la ley de control es redefinida como anterior q(t), z(t) L L2 y utilizando la definicion de
= z + g(q d ) (15) z(t) = q K q se concluye ademas que q(t) L , lo que
y las definiciones (C1)-(C3) anteriores son consideradas cumple con la condicion (C4) del teorema 1.
nuevamente, luego el sistema dinamico (9) se transforma
en 6. CONTROL DE MOVIMIENTO VIA I&I
q = z K q
1
q =M (q) [z C(q, z + K q)(z + K q) + g(q d ) g(q)] Para comenzar con el diseno del controlador de movi-
[z C(q, z + K q)(z + K q) + g(q d ) g(q)] + K[z + K q]. miento para robots manipuladores es necesario aplicar una
1
z =M (q)
Octubre 14-16, 2015.
Congreso Nacional de Control
Automtico, AMCA 2015,
343
Cuernavaca, Morelos, Mxico.

transformacion de coordenadas al sistema (8), para esto es Sustituyendo (21) en (18) tenemos
definido el vector de error
 e como  = 2 (), (22)
q qd q
e= ,
q qd q 2 () = qd M (qd )1 [ ()
donde qd Rn y qd Rn representan la posicion y C(qd , qd 2 ())[qd 2 ()] g(qd )]; (23)
velocidad deseada de las variables articulares variantes en
donde se observa de la primera ecuacion que es conocida,
el tiempo, respectivamente. El modelo dinamico (8) puede
por lo que sustituyendo (20) en (22) resulta
representarse en terminos del vector de estado e R2n
como K = 2 (). (24)
q

  De (24) se observa que
d q 1
= qd M (qd q) [ 2 () = K,
dt q


C(qd q, qd q)(qd q) g(qd q)] por lo que ahora el mapeo () es definido por completo
(18) como  
donde qd Rn es la aceleracion deseada de las variables () =

, (25)
articulares del robot manipulador. Ahora, considere el K
modelo para robots manipuladores en espacio de estados cumpliendo con la condicion descrita en (C2) del teorema
descrito por (18). El objetivo de control de movimiento 1.
consiste en encontrar una ley de control por realimentacion
de estados tal que dado un conjunto de funciones (C3) Variedad implcita. Acorde a la identidad (4) se
vectoriales acotadas qd (t), qd (t) y qd (t), las trayectorias define la siguiente variedad implcita
de q(t) sigan con precision las trayectorias de qd (t), i.e., V , {e R2n |(e) = 0} =
lm q(t) = 0. (19)
t {e R2n |q = , q = K Rn }, (26)
Si el objetivo de control se verifica, significara que las ar- donde se satisface que n < 2n, i.e., el orden del sistema
ticulaciones del robot manipulador siguen asintoticamente dinamico objetivo (20) es menor que el orden del sistema
la trayectoria de movimiento deseado. (18).
A continuacion se describe el diseno de una ley de control Luego, si el vector e es descrito por los siguientes compo-
por realimentacion de estados que cumple el objetivo de nentes
q Rn
 
control anteriormente expuesto utilizando la metodologa
e= , (27)
I&I. q Rn
Proposicion 1. El sistema (18) del robot manipulador es la siguiente ecuacion
globalmente I&I estabilizable con dinamica objetivo
(e) = q 2 (11 (q)) = 0 (28)
= K cumple con las condiciones descritas en la definicion (26).
y ley de control Sustituyendo en (28) el mapeo inverso 11 () obtenido de
= M (qd q)[z K q] (25) se tiene
qd q]
+ C(qd q, qd q)[ + g(qd q) (e) = q 2 (q) = 0.
Luego, sustituyendo 2 () de (25) resulta
con z = q K q, donde K y son matrices de diseno del
controlador. (e) = q + K q = 0 (29)
Prueba 1. Aplicando la formulacion propuesta en el teore- con lo que queda definida la variedad V de forma explcita.
ma 1, se comienza por seleccionar la dinamica objetivo.
(C4) Dinamica fuera de la variedad y acotamiento de
(C1) Sistema dinamico objetivo. El enfoque clasico de la soluciones. La dinamica fuera de la variedad se obtiene
teora de control no lineal es transformar un sistema no a partir de la siguiente definicion
lineal en uno lineal, con esto en mente se define el siguiente z , (e)
sistema dinamico objetivo
con (e) como se obtuvo de (29), donde la derivada a lo
= K (20) largo de las trayectorias del sistema (18) resulta como
donde Rn y K > 0 es una matriz diagonal de coefi-
z = q + K q.
(30)
cientes constantes K = diag(k1 , ..., kn ) y el sistema (20)
tiene un equilibrio globalmente asintoticamente estable en Sustituyendo (18) en (30) obtenemos
= 0 Rn . z = qd M (qd q)1 [
(C2) Condicion de inmersion. Se define el siguiente mapeo qd q)
C(qd q, qd q)( g(qd q)]
     
q 1 () (31)
+ K q.
e= , = (21)
q 2 () 2 ()
Luego, habra de seleccionarse una entrada de control
donde el mapeo 1 () = es seleccionado debido a que se tal que el subsistema (31) tenga un equilibrio globalmente
desea que la coordenada q, que es el vector asociado al error asintoticamente estable en el origen, i.e.,
de posicion articular, se comporte como el sistema dinami- lm z(t) = 0,
co objetivo (20), i.e., que presente un comportamiento t
exponencial decreciente, por lo que solo resta encontrar y que las trayectorias del sistema resultante esten aco-
el mapeo 2 () aplicando la formulacion descrita en (3). tadas. Para este fin, se selecciona de todos los posibles
Octubre 14-16, 2015.
Congreso Nacional de Control
Automtico, AMCA 2015,
344
Cuernavaca, Morelos, Mxico.

controladores que estabilicen el sistema (31) la siguiente


ley de control

= M (qd q)[qd + z + K q]
qd q]
+ C(qd q, qd q)[ + g(qd q) (32)
donde es una matriz diagonal de diseno con coeficientes
constantes, i.e., = diag(1 , , n ). Esta eleccion surge
al igualar la parte derecha de (31) con z y debido a que
M (qd q) es una matriz definida positiva y por lo tanto
invertible (Propiedad 1) es posible despejar la entrada de
control , lo que conduce a la dinamica
z = z (33)
donde se observa por las propiedades de la matriz de diseno
que (33) tiene un equilibrio globalmente asintoticamente
estable en el origen. Ahora bien, al sustituir (32) en (18)
se obtiene el siguiente subsistema en lazo cerrado
Figura 1. Diagrama esquematico de un brazo robot mani-


q q pulador de 2 g.d.l.
d
q = K q z (34)
dt z Para la simulacion de las leyes de control de posicion
z T
(12) y (15) se definieron los valores q d = [/4 /20]
en funcion de las coordenadas (e, z), donde es facil obser- para la posicion deseada de las articulaciones del robot
var que las trayectorias de z(t) estan acotadas y tienden manipulador as como K = diag{4, 5}, = diag{30, 15},
a cero de forma exponencial, por lo que la dinamica de la Kp = diag{120, 81} y Kv = diag{35, 15} para las ganan-

coordenada q(t) en algun momento en el tiempo solo de- cias de los controladores. Para el caso del controlador de
el cual debido a las propiedades
pendera del termino K q, movimiento (32) se establecieron los valores K = diag{20}
de diseno de la matriz K permitira que las trayectorias de y = diag{40} para las ganancias de los controladores
esten acotadas y, mas aun, tiendan a cero; por lo que
q(t) y para el caso del controlador Par Calculado clasico se
tambien las trayectorias de q(t) se mantendran acotadas utilizaron Kp = diag{900} y Kv = diag{60}. Las Figs.
debido a su dependencia directa con la coordenada q, con 2-4 muestran una comparacion del desempeno de los con-
lo que la condicion (C4) del teorema 1 es satisfecha y de troladores (12), (15) y (32), aqu obtenidos, con respecto
esta manera se cumple con la prueba de la Proposicion 1. a los controladores clasicos. Como era de esperarse, el
comportamiento de estas leyes de control es similar entre
7. RESULTADOS EN SIMULACION s pero con la diferencia fundamental de que las ganancias
de los controladores son seleccionadas de forma diferen-
Con el fin de ilustrar el comportamiento de las leyes te, i.e., primero es seleccionada la razon de decaimiento
de control (12), (15) y (32), se evaluaron simulaciones exponencial para el comportamiento del error mediante
utilizando el modelo matematico de un robot manipulador la ganancia K y despues se establece la velocidad con
de 2 g.d.l. La Fig. 1 muestra el diagrama esquematico la que el sistema se comportara como el sistema objetivo
del robot manipulador del modelo en cuestion. El modelo mediante la ganancia .
dinamico del robot manipulador como en (8) es obtenido
en (Kelly and Santibanez, 2003) y descrito como
h i h i h i
M11 (q) M12 (q) C11 (q, q) C12 (q, q) g1 (q)
q + q + =
M21 (q) M22 (q) C21 (q, q) C22 (q, q) g2 (q)
| {z } | {z } | {z } Control PD+Compensacin de Gravedad
M (q) C(q,q) g(q) 0.8
donde
0.6 q1
2
M11 (q) = m1 lc1 + m2 [l12 + lc2
2
+ 2l1 lc2 cos(q2 )] + I1 + I2
2 0.4
M12 (q) = m2 [lc2 + l1 lc2 cos(q2 )] + I2
2
M21 (q) = m2 [lc2 + l1 lc2 cos(q2 )] + I2 0.2 q2
2
M22 (q) = m2 lc2 + I2 0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
C11 (q, q) = m2 l1 lc2 sin(q2 )q2 Control PD+Compensacin de Gravedad va I&I
0.8
C12 (q, q) = m2 l1 lc2 sin(q2 )[q1 + q2 ]
C21 (q, q) = m2 l1 lc2 sin(q2 )q1 0.6
q1
C22 (q, q) = 0
0.4
g1 (q) = [m1 lc1 + m2 l1 ]g sin(q1 ) + m2 lc2 g sin(q1 + q2 )
q2
g2 (q) = m2 lc2 g sin(q1 + q2 ). 0.2

Las condiciones iniciales correspondientes a las posiciones 0


y velocidades articulares son seleccionadas como 0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
   
0 0
q(0) = , q(0) = . Figura 2. Errores de posicion [rad vs seg].
0 0
Octubre 14-16, 2015.
Congreso Nacional de Control
Automtico, AMCA 2015,
345
Cuernavaca, Morelos, Mxico.

Control PD+Compensacin Precalculada de Gravedad REFERENCIAS


0.8
Aeyels, D. (1985). Stabilization of a class of nonlinear
0.6 q1 systems by a smooth feedback control. Systems &
Control Letters, 5(5), 289294.
0.4
Astolfi, A., Escobar, G., Ortega, R., and Stankovic, A.
0.2 q2 (2002). An adaptive controller for the tcsc based on the
immersion and invariance design technique. In Proc.
0
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
14th Conf. Power Systems Computation, Seville, Spain.
Control PD+Compensacin Precalculada de Gravedad va I&I Astolfi, A., Karagiannis, D., and Ortega, R. (2008). Nonli-
0.8 near and Adaptive Control with Applications. Springer-
0.6 q1
Verlag London Ltd., London.
Astolfi, A. and Ortega, R. (2003). Immersion and inva-
0.4 riance: a new tool for stabilization and adaptive control
of nolinear systems. IEEE Trans. Automatic Control,
0.2 q2 48(4), 590606.
0
Byrnes, C., Isidori, A., and Willems, J. (1991). Passi-
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2 vity, feedback equivalence, and the global stabilization
of minimum phase nonlinear systems. IEEE Trans.
Figura 3. Errores de posicion [rad vs seg]. Automatic Control, 36(11), 12281240.
Byrnes, C., Priscoli, F.D., and Isidori, A. (1997). Output
Control Par Calculado Regulation of Uncertain Nonlinear Systems. Birkhauser,
0.08 Boston.
0.06
Carr, J. (1981). Applications of Center Manifold Theory.
q1 Springer-Verlag.
0.04 Isidori, A. (1995). Nonlinear Control Systems. Springer-
q2 Verlag, 3rd edition, Berlin.
0.02
Isidori, A. (1997). A remark on the problem of semiglobal
0 nonlinear output regulation. IEEE Trans. Automatic
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
Control Par Calculado va I&I Control, 42(12), 17341738.
0.08 Jouan, P. (2003). Immersion of nonlinear systems into li-
0.06 q1 near systems modulo output injection. SIAM J. Control
and optimization, 41(6), 17561778.
0.04 Kelly, R. and Santibanez, V. (2003). Control de movimien-
q2
to de robots manipuladores. Pearson Education, Madrid.
0.02
Kokotovic, P. (1985). Recent trends in feedback design:
0 an overview. Automatica, 21(3), 225236.
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5
Krstic, M., Kanellakopoulos, I., and Kokotovic, P. (1995).
Nonlinear and Adaptive Control Design. John Wiley
Figura 4. Errores de posicion [rad vs seg]. and Sons, New York.
Michel, A., Wang, K., and Hu., B. (2001). Qualitative
8. CONCLUSION Theory of Dynamical Systems: The Role of Stability
Preserving Mappings. Marcel Dekker, 2nd edition, New
Se ha empleado la metodologa I&I para el control de York.
robots manipuladores. Para el caso de control de posicion Nijmeijer, H. and van der Schaft, A. (1990). Nonlinear
se obtuvieron leyes de control (12) y (15) con la estructura Dynamical Control Systems. Springer-Verlag.
de los controladores PD mas compensacion de gravedad Ortega, R., Lora, A., Nicklasson, P., and Sira-Ramrez.,
y PD mas compensacion pre-calculada de gravedad, pero H. (1998). Passivity-based Control of Euler-Lagrange
con la diferencia fundamental de que las ganancias y Systems. Springer-Verlag, London.
K de los controladores tienen un enfoque diferente de Riedle, B. and Kokotovic, P. (1986). Integral manifolds
sintona. Para el caso de control de movimiento, se obtuvo of slow adaptation. IEEE Trans. Automatic Control,
una ley de control (32) con la estructura del controlador 31(4), 316324.
Par Calculado, tambien con la diferencia particular de que Sepulchre, R., Jankovic, M., and Kokotovic, P. (1996).
las ganancias del controlador son sintonizadas con otro Constructive Nonlinear Control. Springer-Verlag, Ber-
enfoque. Esto permite concluir que con la metodologa lin.
I&I es posible obtener algunas de las leyes de control Wiggins, S. (1990). Introduction to Applied Nonlinear
clasicas para el control de robots manipuladores. Dynamical Systems and Chaos. Springer-Verlag, New
York.
AGRADECIMIENTOS Wonham, W. (1985). Linear Multivariable Control: A
Geometric Approach. Springer-Verlag, 3rd edition.
Al Consejo Nacional de Ciencia y Tecnologa (CO-
NACyT), por el apoyo economico otorgado mediante la
beca de estudios y el proyecto CONACyT 134534 y Pro-
yectos TecNM.
Octubre 14-16, 2015.