Professional Documents
Culture Documents
http://revistas.udistrital.edu.co/ojs/index.php/Tecnura/issue/view/650
DOI: http://dx.doi.org/10.14483/udistrital.jour.tecnura.2016.2.a09
Estudio de caso
Cmo citar: Hernndez Milln, G., Ros Gonzales, L. H., & Bueno Lpez, M. (2016). Implementacin de un
controlador de posicin y movimiento de un robot mvil diferencial. Revista Tecnura, 20(48), 123-136. doi:
10.14483/udistrital.jour.tecnura.2016.2.a09
Resumen
Contexto: La robtica mvil contina siendo un
rea de constante actualizacin, donde se busca tener aplicaciones que permitan mejorar la calidad de
vida de los seres humanos. Con base en lo anterior,
en este artculo se presenta un novedoso diseo de
un controlador de posicin y movimiento para un
robot mvil diferencial, utilizando redes neuronales
artificiales y cuyo fin es llevarlo a aplicaciones reales en diferentes campos de accin.
Mtodo: La propuesta presentada est basada en un
controlador PID, el cual ha sido sintonizado con una
red neuronal y requiere conocer el modelo cinemtico del robot.
Resultados: Las simulaciones muestran la eficiencia
del control de posicin para el seguimiento de caminos explcitos, en este caso para el seguimiento
de trayectorias rectilneas y curvilneas. La interfaz
grfica presentada permite ajustar las ganancias con
facilidad y verificar el seguimiento de la trayectoria
en lnea.
1
2
3
Abstract
Context: Mobile robotics remains being an area of
constant updating, which seeks to have applications
to improve the life quality of human beings. Therefore, the paper presented a novel design of a position
and move controller to a differential mobile robot
using artificial neural networks, which aims is to
bring a real applications in different fields.
Method: The proposal is based on a PID controller,
which has been tuned using a neural network and requires knowledge of the kinematic model of the robot.
Ingeniero Electricista, Magister en Ingeniera Elctrica, Universidad Tecnolgica de Pereira. Pereira, Colombia. Contacto:
germanhernadez08@gmail.com
Ingeniero Electrnico, Especialista en Computadores y Sistemas Digitales, Master of Science in engineering, Diploma de Estudios Avanzados (DEA), Magister en Ingeniera Elctrica. Docente de la Universidad Tecnolgica de Pereira- UTP. Pereira, Colombia. Contacto:
lhgonza@utp.edu.co
Ingeniero Electricista, Magister en Ingeniera Elctrica, Doctor en Ingeniera, Director Programa de Ingeniera en Automatizacin Universidad de La Salle. Bogot D.C., Colombia. mbueno@lasalle.edu.co
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 123 ]
INTRODUCCIN
Los robots mviles son dispositivos electromecnicos capaces de desplazarse en un espacio de trabajo con cierto grado de autonoma. De acuerdo
con su forma de locomocin se clasifican en: robots mviles de locomocin mediante orugas, mediante patas y mediante ruedas.
Los robots mviles propulsados por ruedas, a su
vez, se clasifican segn el nmero y el tipo de grados de libertad (Blazic, 2014).
Cuando se trata de generar trayectorias o caminos en sistemas no holnomos, hay caractersticas
relevantes directamente relacionadas con el tipo
de trayectorias que pueden seguir estos sistemas;
en efecto, una configuracin inicial y una final
no pueden unirse mediante cualquier trayectoria.
Las restricciones cinemticas del sistema imponen
unas condiciones que solo algunos caminos cumplirn, entendiendo por camino la discretizacin
de una funcin continua que interpola las configuraciones definidas en una ruta. Por ltimo, cuando
se habla de trayectoria, se hace referencia a un camino que tiene asociado un perfil cinemtico; es
decir, a cada configuracin perteneciente al camino se le asocia una velocidad (Campion, Bastin y
dAndra Novel, 1993).
Para poder llevar el robot mvil hasta una posicin deseada siguiendo una trayectoria se han propuesto diferentes estrategias de control (Kwon, y
Dongkyoung, 2012; Jingkui, Wenxin y Liangliang,
2010; Rezaee y Abdollahi, 2014; Yandong, Zongyi y Ling, 2010), algunas no requieren la utilizacin del modelo matemtico, por el contrario otras
required information is generally deliver by mobile robot sensors. Finally, tuning PID controller with
the neural network allows obtaining a correct performance for trajectory tracking.
Keywords: Automatic Control, Differential mobile
robot, Dynamic model.
requieren obtener el modelo cinemtico y dinmico. En este artculo se obtuvo un modelo cinemtico del robot asumiendo que el punto de referencia
se encuentra en medio de las dos ruedas de traccin de la plataforma, optando as por un mtodo basado en el centro de masa con restricciones
no holonmicas. Este control utiliza un modelo
geomtrico, el cual emplea el clculo del radio
de curvatura para realizar el seguimiento de una
trayectoria deseada. Con las primeras simulaciones se pudo comprobar que este mtodo funciona
muy bien tanto para seguimiento de trayectorias
rectilneas como curvilneas.
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 124 ]
Tcnica basada en teoras de control, la cual utiliza los modelos matemticos del robot para encontrar un controlador que lo estabilice y a la
vez consiga la tarea deseada.
Tcnica basada en mtodos geomtricos para seguir
trayectorias o planificar caminos matemticamente.
Tcnica basada en sistemas inteligentes, como
redes neuronales, algoritmos genticos o lgica
difusa, para el control de movimiento y la coordinacin de comportamientos.
Todas estas suposiciones se cumplen razonablemente bien en la mayora de los robots mviles
actuales. El deslizamiento es de hecho el mayor problema con que se encuentra cualquier robot mvil a
la hora de establecer una autolocalizacin precisa.
Modelo jacobiano
Asumiendo que p representa un lugar en el espacio con n coordenadas generalizadas y q un vector
de m variables de actuadores (para n > m), y asumiendo que
y
son las respectivas derivadas de
tales vectores, entonces el modelo directo es obtenido por la matriz jacobiana, J (p) dado por la
ecuacin (1).
p = J p q .
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 125 ]
(1)
p=f p +
!
!!!
g(p)! q! , (2)
sin
0
p = cos v + 0
. (3)
1
0
x
sin 0
y = cos 0 v
.
0
1
x cos + y sin = 0 ,
x
y
(7)
v
sin cos 0
=
0
0
1
x
y
.
(8)
(5)
v = x sin + y cos
(9)
q = [J p ! J p ]!! J p ! p .
(4)
Para q = v !
De la ecuacin 4 se puede obtener la ecuacin 5:
para llevar al robot a un lugar deseado, proporcionando las velocidades angulares que deben tomar
las ruedas del robot para una posicin y orientacin conocidas.
La cinemtica inversa del sistema implica la inversa del jacobiano. Cuando este ltimo no es una
matriz cuadrada, es necesario calcular su seudoinversa, multiplicando ambos lados por JT, y resolviendo para
, con lo cual se obtiene la ecuacin 7:
La figura 1 muestra el clsico vehculo de traccin diferencial, el cual usa en ambas ruedas,
(6)
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 126 ]
v! + v! ! + !
v=
=
r,
2
2
v! v! ! !
=
r.
b
b
(10)
(11)
! =
! =
v (b 2)
r
v + (b 2)
r
(12)
(13)
Sustituyendo las ecuaciones 10 y 11 en el modelo de robot mvil (3) se obtienen las ecuaciones
14 y 15:
x
(rsin) 2
(rsin) 2
y = (rcos) 2 ! + (rcos) 2 !
r b
r b
x
(rsin) 2 (rsin) 2
!
y = (rcos) 2
(rcos) 2
!
r b
r b
(14)
(15)
IMPLEMENTACIN DEL
CONTROLADOR DE POSICIN Y
MOVIMIENTO DEL ROBOT MVIL
DIFERENCIAL
El siguiente paso es representar las ecuaciones
del modelo cinemtico (15) en un diagrama de
bloques del SimuLink, el cual permite calcular
la posicin del robot mvil en cada instante de
tiempo. Este bloque se llama cinemtica directa
diferencial y servir para probar el control de posicin, el cual ser diseado posteriormente. El
bloque cinemtica directa diferencial se muestra
en la figura 2.
[ 127 ]
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 128 ]
Figura 4. Comparacin del comportamiento de las RNA y el PID frente a un tren de pulsos
Fuente: elaboracin propia.
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 129 ]
a)
b)
Figura 6. a) Simulacin para ! = 427 rad s , ! = 0 rad s
. b) Simulacin para ! = 427 rad s , ! = 4.27 rad s
Fuente: elaboracin propia.
Considrese un sistema de referencia local asociado al movimiento del vehculo, tal como se muestra en la figura 7.
d! + y ! = r ! .
(17)
[ 130 ]
(r x)! + y ! = r ! .
(18)
r=
x ! + y !
.
2x
(19)
Por tanto, la curvatura que es necesario suministrar al vehculo se expresa por la ecuacin 20:
! =
1
2x
= !
,
r
L
(20)
Un mtodo prctico para aplicar la ley de control consiste en obtener a la tasa de muestreo, el
punto (xobm, yom) del camino objetivo que est ms
prximo al vehculo (x, y) y elegir el punto (xob, yob)
a una distancia fija s sobre el camino tomado en el
sentido de avance a partir de (xobm, yobm) tal como se
muestra en la figura 6; posteriormente se calcula L
y se aplica la ley de control 20 y 21. El clculo de
L se realiza con el teorema de Pitgoras mediante
la ecuacin 22:
L=
x!"# x
+ y!"# y .
(22)
! =
! =
v (b 2)
r
v + (b 2)
r
(23)
(24)
Aislando las velocidades lineales de cada rueda, y sabiendo que v = r* estas ecuaciones se pueden reescribir mediante las ecuaciones 25 y 26:
V! = ! r =
r(v b 2 )
b
= v b 2 V! = v(1
),
2r
r
V! = ! r =
r(v + b 2 )
b
= v + b 2 V! = v(1 +
)
.
2r
r
(25)
(26)
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 131 ]
Se comprobara cmo evoluciona el robot diferencial al momento de seguir una trayectoria rectilnea de la forma y = x.
Se comprobara cmo se comporta el robot diferencial ante el requerimiento de seguir una parbola de la forma y = x2.
Se comprobara cmo se comporta el robot diferencial ante el requerimiento de seguir una trayectoria en forma de circunferencia de la forma
y = sen (t) y y = cos(t).
[ 132 ]
RESULTADOS OBTENIDOS.
SIMULACIN DEL CONTROL DE
POSICIN
Se implement una interfaz grfica GUI para la
presentacin de las diferentes trayectorias seguidas por el robot mvil. En la figura 10 se muestra
la GUI implementada.
Se simularon trayectorias realizadas controlando solamente el ngulo de giro y utilizando el control de posicin mediante el mtodo geomtrico
de persecucin pura implementado. Las simulaciones que se implementaron utilizando el control
de posicin mediante el mtodo geomtrico de
persecucin pura fueron las siguientes:
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 133 ]
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 134 ]
Seguir una trayectoria en forma de circunferencia de la forma y = sen (t) y y = cos(t) (figura 13).
CONCLUSIONES
REFERENCIAS
De las simulaciones se puede observar la eficiencia del control de posicin para el seguimiento de
caminos explcitos, en este caso para el seguimiento de trayectorias rectilneas y curvilneas. Como
se puede apreciar en estas simulaciones se observa
que el control de posicin se comporta muy bien
al momento de seguir cualquier curva, en especial
frente a curvas suaves.
En algunas simulaciones donde se trat de seguir trayectorias rectilneas muy inclinadas y x se
hace muy pequeo este controlador presenta fallas,
debido a que la funcin del radio de curvatura para
2 x
una trayectoria vertical es =
= 0
, y en ese
L
momento los perfiles de velocidad sern cero (0) y
por este motivo se pierde el control de seguimiento.
El trabajo realizado permite la implementacin
prctica de las tcnicas estudiadas en una plataforma real, garantizando el xito de dichas tcnicas.
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 135 ]
Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 20 No. 48 Abril - Junio de 2016 pp. 123-136
[ 136 ]