Professional Documents
Culture Documents
Control Adaptable
Dr. Martn Velasco Villa
Secci
on de Mecatr
onica
Abril de 2015
Control Adaptable
Basado en autosintonizaci
on
N
otese que:
f 0 ; f converge
a). El hecho que f 0 no implica que f (t ) tiene un lmite cuando t .
cos(log t )
f (t ) =
0 cuando t pero f (t ) se mantiene oscilando (cada vez
t
mas peque
no).
b). f converge ; f 0.
El hecho que f (t ) tenga un limite cuando t no implica que f (t ) 0
f (t ) = e t sin e 2t .
c). Si f es acotada por abajo y decreciente f 0 entonces f converge a un limite.
Bajo que condiciones f converge a cero?
Lema 1 (Barbalat)
Si la funci
on diferenciable f (t ) tiene un lmite (finito) cuando t , y si f es
uniformemente continua, entonces f (t ) 0 cuando t .
I
Una condici
on suficiente para que una funci
on diferenciable sea uniformemente
continua es que su derivada sea acotada.
Modelo de Referencia
La ley de adaptaci
on ajusta los parametros de la ley de control.
(1)
Suponga que se desea seguir una trayectoria xm generada a partir del modelo din
amico,
xm + 1 x m + 2 xm = r (t ) ,
1 , 2 > 0,
r (t ) : entrada
(2)
(4)
= (m + m ) xm 2x 2 x .
Esto es,
mx m xm 2x 2 x = m
xm 2x 2 x
m x + 2x + 2 x = m
xm 2x 2 x
m x + x + x + 2 x = mv
m (x + x + (x + x )) = mv
entonces
m (s + s ) = mv
(6)
donde
s = x + x,
v = xm 2x 2 x.
(7)
(8)
como m
=m
m, se obtiene considerando m = 0,
m
= vs
(9)
=
=
ms + mv
vs.
(10)
Entonces,
1
V = ms s + m
m
= s (ms + mv
)+
1
m
(vs )
= ms 2
Como el sistema produce V semidefinida negativa se tiene probada su estabilidad.
Para probar que lm st = 0 se utiliza el lema de Barbalat lo cual concluye la prueba.
N
otese que
V = 2ms s = 2s (ms + mv
)
= 2m2 s 2 2s mv
(12)
Las ecuaciones de movimiento son lineales con respecto a los parametros de la matriz
de inercia (masas, distancias, momentos de inercia) en el sentido de que existe una
funci
on Y (q, q,
q ) R nl y un vector R l tal que la acuacion (12) puede
escribirse en la forma,
= D (q ) q + C (q, q ) q + B q + g (q ) = Y (q, q,
q ) .
(13)
La funci
on Y (q, q,
q ) se conoce como Regresor y es el Vector de parametros.
La dimensi
on del espacio de par
ametros (el n
umero de par
ametros utilizado) no
es u
nica.
Encontrar el n
umero mnimo de par
ametros es una tarea compleja.
D (q ) q + C (q, q ) q + g (q ) =
(14)
Equivalentemente,
m1 lc21 + m2 l1 + lc22 + 2l1 lc2 cos q2 + I1zz + I2zz m2 lc22 + l1 lc2 cos q2 + I2zz
q
2
2
m2 lc2 + I2zz
m2 lc2 + l1 lc2 cos q2 + I2zz
hq 2 h (q 1 + q 2 )
(m1 lc1 + m2 l1 ) g cos q1 + m2 glc2 cos (q1 + q2 )
+
q +
= 1
m2 lc2 g cos (q1 + q2 )
2
hq 1
0
(15)
donde
h = m2 l1 lc2 sin q2 .
Definiendo entonces,
1 = m1 lc21 + m2 l12 + lc22 + I1 + I2
(16)
2 = m2 l1 lc2
3 = m2 lc22 + I2 .
Los elementos de la matriz de Inercia toman la forma,
d11 = 1 + 22 cos q2
(17)
(18)
Los t
erminos gravitacionales son independientes de D (q ) por lo que requieren
par
ametros adicionales
4 = m1 lc1 + m2 l1 ,
5 = m2 lc2
(19)
de donde
g1 = 4 g cos q1 + 5 g cos (q1 + q2 ) ,
g2 = 5 g cos (q1 + q2 )
(20)
Equivalentemente, definiendo =
T
=
q1
0
q2
q1 + q2
g cos q1
0
1
2
g cos (q1 + q2 )
g cos (q1 + q2 ) 3
4
5
(21)
q r = q d q
s = q q r = q + q
De acuerdo a la propiedad de linealidad en los par
ametros de un manipulador, es
posible escribir sus ecuaciones de movimiento en la forma,
D (q ) q + C (q, q ) q + B (q ) q + g (q ) = = Y (q, q,
q )
(22)
donde Y (q, q,
q ) es el regresor y es el vector de par
ametros.
I
Teorema 2
Sea qr una se
nal continua, acotada con por lo menos primera y segunda derivadas
continuas y acotadas y considere > 0 en (21). La ley de retroalimentaci
on,
= D (q ) qr + C (q, q ) q r + B q r + g (q ) kv s = Ya kv s
(23)
(24)
(25)
Demostraci
on. Sea qr una se
nal continua, acotada y considere los cambios de variable
dados en (21). La retroalimentaci
on (23) se reescribe como,
=
=
D qr + C q r + B q r + g kv s = D qr + C q r + B q r + g kv s
+ D D qr + C C q r + B B q r + (g g )
D qr + C q r + B q r + g kv s + Ya ( ) .
(26)
Entonces la din
amica del sistema en lazo cerrado esta dada por,
D (q ) q + C (q, q ) q + B q + g (q ) = D qr + C q r + B q r + g kv s + Ya
(27)
con lo cual,
D (q ) s + C (q, q ) s + Bs + kv s = Ya
D (q ) s + C (q, q ) s + kBv s = Ya ,
(28)
kBv = B + kv .
1 T
1
s D (q ) s +
2
2
(29)
= s T [C (q, q ) s kBv s + Ya ] + s T D (q ) s s T Ya T .
2
Considerando que es sim
etrica,
V (t )
V (t )
=
=
s T kBv s s T C 12 D s
T
s kBv s.
(30)
Es claro que el sistema (28) es tan solo estable ya que V es semidefinida negativa.
(31)
=
=
=
2s T kBv s
2s T kBv D 1 (C (q, q )) s kBv s + Ya
2s T kBv D 1 [C (q, q ) s + kBv s Ya ]
(32)
(33)
En la demostraci
on anterior se ha considerado un sistema formado por el estado [s, ]
junto con la funci
on de Lyapunov (29).
Estrictamente, el sistema en lazo cerrado esta formado por las ecuaciones.
D (q + qd ) s + c (q + qd , q + q d ) s + kBv s = Ya
= 1 YaT s
q = q + s
con lo cual el estado del sistema (34) esta formado por
q ]
[s, ,
lo cual implica la modificaci
on de la funci
on de Lyapunov (29), para considerar
tambi
en el estado q.
N
otese que el punto de equilibrio del sistema (34) sigue siendo el origen.
(34)