Documentos de Académico
Documentos de Profesional
Documentos de Cultura
V5n1a3 PDF
V5n1a3 PDF
1, Enero-Junio 2014
RESUMEN
En este trabajo se desarrolla un sistema de control, aplicado en un robot mvil de configuracin diferencial, para seguir una
trayectoria determinada. Para dar solucin al problema, primero se implementa la cinemtica directa del robot para simular el
comportamiento del mismo. Luego para cumplir el objetivo, dos sistemas de control (holonmico y no-holonmico), fueron
desarrollados e implementados a partir de la cinemtica inversa. Posteriormente, se desarrollan pruebas que permiten comparar
el rendimiento de los dos controladores, determinando cul proporciona la mejor solucin.
Palabras clave
Configuracin diferencial, modelado cinemtico, Robtica mvil, trayectorias.
ABSTRACT
This paper presents a study of path following methods, especially for mobile robots with differential configuration. This paper
searches for a simple control system exhibiting good performance, allowing robots to follow a certain path. Different numerical
methods are to be implemented for achieving this goal.
Keywords
Mobile robotics, Differential configuration, Kinematic modeling, Path-following.
Rsum
Cet article prsente une tude des mthodes, en particulier, pour des robots mobiles avec configuration diffrentiel. Pour russir
cet objectif on cherche dutiliser un systme de contrle simple mais et avec bon performance, qui permet aux robots de suivre une
trajectoire spcifique. On va implmenter des diffrentes mthodes numriques pour russir cet objectif.
Mots-cls
Configuration diffrentiel, Modlisation cinmatique, Robotique mobile, Trajectoires
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
26
Ing. USBMed, Vol. 5, No. 1, Enero-Junio 2014
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
27
Ing. USBMed, Vol. 5, No. 1, Enero-Junio 2014
2. MODELADO DE CINEMTICA DIRECTA DEL Saber con exactitud la posicin y orientacin del robot
ROBOT DIFERENCIAL con respecto al sistema global, son las incgnitas que
se tienen en un robot mvil. Para poder lograr un
Para realizar el modelado del robot se deben tener en movimiento controlado, se deben tener dominio sobre
cuenta ciertas hiptesis que generalizan el Vr la velocidad de la rueda derecha y Vl la velocidad
comportamiento del robot, por ejemplo, se asume que de la rueda izquierda, ver figura 4.
el robot se desplaza en una superficie plana idealmente
sin rozamiento, tambin se toman los ejes de las El objetivo de modelar el robot es buscar una relacin
ruedas como perpendiculares al suelo por donde se directa de cmo afectan las entradas Vr y Vi, a los
desplaza. Por ltimo el robot se debe mover estados del sistema X, Y, .
nicamente por las fuerzas ejercidas por el movimiento
rotacional de las ruedas [9].
V V
w R
r l
2
L
Luego de tener las velocidades que se presentan en el
desplazamiento del robot se procede a integrarlas en
un primer concepto del movimiento del robot. Se
desarrollan unas ecuaciones que definan la dinmica
del movimiento de un robot en cada eje.
Fig. 3. Variables fsicas del Robot diferencial.
Fuente. Autores.
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
28
Ing. USBMed, Vol. 5, No. 1, Enero-Junio 2014
x v * cos 3
y v * sen 4
w 5
Para definir el modelo del robot que interesa para la
aplicacin, se reemplazan las velocidades lineales y
angulares que se obtuvieron anteriormente. Con esto
obtenemos el modelo del robot con configuracin
diferencial con el cual se va a trabajar. Adicionalmente
de las condiciones de velocidad, se plantea una matriz
de rotacin, ya que no en todo momento el robot se
Fig. 5. Modelo Cinemtico Robot diferencial en Simulink
encuentra alineado con el eje global.
de MatLab. Fuente: Autores.
x cos 0
v
y sen 0 6
0 w
1
V Vl
x cos 0 R r
y sen
0 2
V V
7
0
1 R r
l
L
Luego de tener el modelo de la cinemtica directa del
robot podemos obtener las ecuaciones que determinen
el movimiento del robot. Para esto se multiplican las
matrices, de rotacin y la matriz de velocidades del
robot, obteniendo de esta manera una ecuacin
matricial que representa las velocidades en X, Y y
angular del robot en el sistema global. Esta ecuacin
matricial, es tambin representada por las siguientes
tres ecuaciones. Dando como resultado el modelo
cinemtico directo del robot diferencial con el cual se
desarrolla el sistema de control, para seguir la
trayectoria.
R cos R
cos
2
x 2
y R sen sen wr
8
2 w
R Fig. 6. Respuesta del modelo del robot ante velocidades
2 l iguales en mismo sentido. Fuente: Autores.
R R
L L
Posteriormente se realiza la prueba con velocidades de
Se desarrolla un modelo en Simulink de Matlab, para igual magnitud pero en sentido contrario, esperando
realizar una simulacin que permite comprobar el obtener un movimiento rotacional, pero sin translacin
comportamiento del modelo (figura 5). Se hicieron alguna. Las respuestas se muestran en figura 7.
pruebas donde la velocidad de cada rueda sea la
misma, esperando obtener como resultado un
movimiento a lo largo del eje x. Las respuestas
obtenidas se pueden observar en la figura 6.
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
29
Ing. USBMed, Vol. 5, No. 1, Enero-Junio 2014
1
R cos R
cos
2 2
wr sen x
sen
w R 2 y 9
2
Fig. 7. Respuesta modelo del robot ante velocidades R
l R
R
iguales en sentido contrario. Fuente: Autores.
Por ltimo se realiza una prueba con una velocidad L L
mayor que la otra, esto nos permite tener un
movimiento rotacional con desplazamiento circular. La Al realizar este paso se encuentra el primer
Fig.8 muestra las respuestas obtenidas. inconveniente, puesto que es necesario determinar la
inversa de una matriz no cuadrada. La solucin a este
problema es encontrar la pseudoinversa de dicha
matriz. Esta matriz se define como:
A
T
( A * A)
1
*A
T
10
R cos R
cos
2 2
sen sen
A R
2
R
2
11
R R
L
L
cos sen L
R R R 12
A cos sen L
R
R R
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
30
Ing. USBMed, Vol. 5, No. 1, Enero-Junio 2014
Como resultado final obtenemos una expresin Luego de que el error de orientacin sea igual a cero,
matricial, que nos permite calcular la velocidad que se procede a realizar el movimiento de traslacin, el
debe tener cada rueda, para cumplir el objetivo de cual debe ser en lnea recta, la velocidad a la cual se
tener las velocidades lineal y angular deseadas. mueve, se define como la distancia que se desea
recorrer sobre el tiempo en que se debe ejecutar la
accin. Este clculo se explica en la Fig.11.
d dX 2 dY 2 15
4. RESULTADOS
14
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
31
Ing. USBMed, Vol. 5, No. 1, Enero-Junio 2014
Se ingresa la trayectoria como la referencia del presentan en un robot diferencial. Con el sistema de
sistema, en esta se ingresan las posiciones en los ejes control que se implement se puede observar que el
X, Y, al derivar esta informacin se logran calcular las robot controla las velocidades de las ruedas de manera
velocidades lineales en cada eje. Al obtener las que sigue la trayectoria satisfactoriamente omitiendo
velocidades de los ejes, podemos obtener la velocidad estas pequeas perturbaciones logrando un error igual
angular y a su vez podemos conocer la orientacin del a cero. Ver figura 15.
mvil.
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
32
Ing. USBMed, Vol. 5, No. 1, Enero-Junio 2014
TRABAJOS FUTUROS
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
33
Ing. USBMed, Vol. 5, No. 1, Enero-Junio 2014
L. E. Solaque, M. A. Molina, E. L. Rodrguez. Seguimiento de trayectorias con un robot mvil de configuracin diferencial.
Ing. USBMed, Vol. 5, No. 1, pp. 26-34. ISSN: 2027-5846. Enero-Junio, 2014.
34