“control no lineal para un manipuladorroboticode dos ......objetivo describir una forma de control...
TRANSCRIPT
![Page 1: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/1.jpg)
“Control No Lineal Para un Manipulador Robotico De Dos Grados De Libertad ”Dos Grados De Libertad ”
por:
Carolina Bachenheimer.
Adriana Martínez.
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 2: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/2.jpg)
ObjetivoDescribir una forma de control de latrayectoria de un manipulador robóticopor modos deslizantes reemplazando lapor modos deslizantes reemplazando lafunción signo por la función saturaciónpara disminuir el “chattering” yconservar la robustez del sistema.
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 3: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/3.jpg)
Se debe garantizar 2 cosas:
La superficie S atraiga las
Introducción: Modos Deslizantes
La superficie S atraiga las trayectorias.
Deslizamiento sobre la superficie hacia el origen.
Figura 1. Superficie de deslizamiento S=0.
![Page 4: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/4.jpg)
Para que S=0 atraiga las trayectorias se propone una
21 2= sV
&
Introducción: Modos Deslizantes
propone una función de liapunov tal que:
0
0
<⋅<
⋅=
ss
V
ssV
&
&
&&
![Page 5: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/5.jpg)
:
00
00
Entonces
ss
ss
><
<>&
&
Introducción: Modos Deslizantes
Debido a que los puntos son atraídos por S pero estos no llegan con precisión a la superficie, se crea el fenómeno de “chattering”
)(
:
ssigs
sss
Entonces
ηη
−=−=
&
& Figura 2. Fenómeno de “Chattering” (S=0).
Existen varias técnicas para eliminarel “chattering”, la más conocida esreemplazar la función signo de la leyde control, por la funciónsaturación;
![Page 6: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/6.jpg)
El modelo general para un robot manipulador den-grados de libertad se describe con la siguienteecuación:
Modelo Dinámico de la Planta
ug
gq
CC
CCq
MM
MM=
+
+
•••112111211
Donde:M: Matriz de Inercia: Matriz que presenta el comportamiento dinámico del robot.C: Matriz de Coriolisis y centrífuga: Es la matriz que contiene los efectos no-lineales (términos dependientes de velocidad) del comportamiento dinámico delrobot manipulador.G: Vector de gravedad: Esta matriz contiene los efectos dinámicos de la gravedaddependiendo de las posiciones articulares.U: Vector de estados: Posición Angular.
gCCMM
222212221
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 7: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/7.jpg)
Representación en Variables de Estado.
Las variables de estado para describir el modelo dinámico son las posiciones articulares (q1,q2) y las velocidades articulares (q1,q2) y las velocidades (q1’,q2’).
−
−
=
−
2
1
2
1
2221
1211
2
1
2221
1211
2
1
1
g
g
q
q
CC
CC
u
u
NN
NN
q
q
M
&
&
43421&&
&&
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 8: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/8.jpg)
Representación en Variables de Estado.
Desarrollando la Ecuación anterior:
−−−+−−−−−−+−−−
=
21222212121122121112121111111111
2
1
1
2
1
2121 :4,:3,:2,:1
gNqCNqCNuNgNqCNqCNuN
gNqCNqCNuNgNqCNqCNuN
q
q
q
q
q
q
qVariableqVariableqVariableqVariable
&&&&
&&&&
&
&
&&
&&
&
&
&&
Donde:
−−−+−−− 222222221212222212121221111211212 gNqCNqCNuNgNqCNqCNuNq &&&&&&
( )[ ]( )[ ]
222222
22212222112
2122122
212
21111
1
cos
cos2
IlmM
IqlllmMM
IIqllllmlmM
MN
c
cc
ccc
+=
++==
+++++== − ( )
( )
( )0
sin
sin
sin
22
1221221
21221212
2221211
==
+−=
−=
•
••
•
C
qqllmC
qqqllmC
qqllmC
c
c
c
[ ] ( ) ( )( )21222
2122112111
sin
sinsin
qqglmg
qqglmqglmlmg
c
cc
+=+++=
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 9: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/9.jpg)
Ley de ControlEl paper propone un diseño sistemático y factible para controlar de forma robusta y libre de “chattering” un manipulador robótico.
(1) ( ) ( )[ ] ( )tdqgqqqCuMq +−−= − &&&&& ,1(1)
(2) :Vector perturbaciones externas.
:Trayectoria deseada.
(3) :Error de la posición.
(4) :Error de velocidad.
(5) Salida del sistema.
( ) ( )[ ] ( )tdqgqqqCuMq +−−= &&&&& ,
( ) nRtd ∈
qqe d −=
qqe d &&& −=
qy =
nd Rq ∈
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 10: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/10.jpg)
Ley de Control
Se define la superficie de deslizamiento S como:(6)(7) se denomina la condición de deslizamiento.Derivando (6) se obtiene: (8)Uniendo (8) con la derivada de (4): (11)
eCeS '+= &
( )SS sgnα−=&
eCeS &&&& '+=eCqqS &&&&&& '+−=Uniendo (8) con la derivada de (4): (11)
Uniendo (9) con (1):(10) Igualando (10) con (7) y asumiendo que no hay perturbaciones externas se puede despejar u:(11)
donde K= [K1,K2,…,Kn]>0. K es un valor alto que depende de las incertidumbres del sistema y de .
eCqqS d &&&&&& '+−=
( ) ( ) ( ) ( ) ( ) ( )tdqgqMqqqCqMuqMqeCS d −++−+= −−− 111 , &&&&&&
( ) ( ) ( ) ( ) ( ) ( )[ ]SKqgqMqqqCqMqeCqMu d sgn,' 11 ++++= −− &&&&&
αCarolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 11: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/11.jpg)
Eliminación del “Chattering”
es la capa de frontera como se
muestra en la Figura 3. Una de lastécnicas comunes para eliminar elchattering es cambiar la función sgn(S)por la función saturación (sat(S)):
Figura 3. Superficie de deslizamiento y Capa de Frontera. Figura 4. Función sat(S) para Eliminación del Chattering.
La función sat(S) hace que fuera de la capa frontera, gracias a la función sgn(S), los puntos sean atraídos a la superficie y una vez dentro de la capa de frontera estos se desplazan hacia el origen de una forma mas suave como se muestra en la figura 4.
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 12: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/12.jpg)
Simulaciones-Diagrama de Bloques
Figura 5a. Diseño del Manipulador Robótico Figura 5b. Diseño del Manipulador.Figura 5a. Diseño del Manipulador Robótico Figura 5b. Diseño del Manipulador.
con Control.
Figura 5c. Diseño del Control para el Manipulador Robótico.
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 13: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/13.jpg)
Simulaciones-sat(S)
Figura 6a. qd1 Vs. Q1. Figura 6b. qd2 Vs. Q2.
Figura 7a. Error1. Figura 7b. Error 2.
Carolina Bachenheimer. Adriana Martínez Pontificia Universidad Javeriana. Noviembre 22 de 2006
![Page 14: “Control No Lineal Para un ManipuladorRoboticoDe Dos ......Objetivo Describir una forma de control de la trayectoria de un manipulador robótico por modos deslizantes reemplazando](https://reader035.vdocuments.pub/reader035/viewer/2022062612/61355eaddfd10f4dd73c5448/html5/thumbnails/14.jpg)
ConclusiónSe presento un control por modos deslizantespara un manipulador robótico. El sistema esrobusto respecto a las incertidumbres en losparámetros del modelo y el “chattering” esparámetros del modelo y el “chattering” esdisminuido usando la función saturación; loserrores son lo suficientemente pequeños parauna aplicación real. El control presentado solofunciona para el seguimiento de trayectoriasy no para puntos de referencia.
Carolina Bachenheimer. Pontificia Universidad Javeriana. Noviembre 15 de 2006