Sunteți pe pagina 1din 16

Tecnura

http://revistas.udistrital.edu.co/ojs/index.php/Tecnura/issue/view/725
DOI: http://dx.doi.org/10.14483/udistrital.jour.tecnura.2015.4.a04

Investigacin

Metodologa para el uso de la tcnica de localizacin de races en la


planeacin de rutas para robots mviles
Methodology for using root locus technique for mobile robots path planning

Mario Ricardo Arbul Saavedra1, Fernando Martnez Santa2, Holman Montiel Ariza3

Fecha de recepcin: 12 de noviembre de 2014 Fecha de aceptacin: 24 de agosto de 2015

Como citar: Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H. (2015). Metodologa para el uso de
la tcnica de localizacin de races en la planeacin de rutas para robots mviles. Revista Tecnura, 19(46), 49-64.
doi:10.14483/udistrital.jour.tecnura.2015.4.a04

Resumen evaluados, bajo 20 pruebas para cada uno, obte-


Este artculo presenta el anlisis y la metodologa niendo un valor del 65% para el mtodo selecciona-
de implementacin de la tcnica de localizacin do. Tambin se proponen modificaciones o posibles
de races de sistemas dinmicos para la planeacin mejoras a la metodologa propuesta.
de rutas libres de obstculos para robots mviles. Palabras clave: Localizacin de races, planeacin de
En primera instancia, se realiza un anlisis e iden- rutas, robots mviles, procesamiento de imgenes.
tificacin del comportamiento morfolgico de las
trayectorias en dependencia de la ubicacin de las Abstract
races en el plano complejo, identificndose el tipo This paper shows the analysis and the implemen-
de trayectorias curvas y la caracterstica de atraccin tation methodology of the technique of dynamic
y repulsin de estas en presencia de otras races, de systems roots location used in free-obstacle path
forma similar al obtenido con la tcnica de cargas planning for mobile robots. First of all, the analysis
de potencial artificial. Se plantea una metodologa and morphologic behavior identification of the paths
para implementacin de esta tcnica para la planea- depending on roots location in complex plane are
cin de rutas de robots mviles, partiendo de tres performed, where paths type and their attraction and
mtodos diferentes de ubicacin de las races para repulsion features in the presence of other roots si-
los obstculos presentes en el escenario. Dichas tc- milarly to the obtained with artificial potential fields
nicas varan dependiendo de los puntos clave del are identified. An implementation methodology for
obstculo que son seleccionados para las races, ta- this technique of mobile robots path planning is pro-
les como los bordes, los cruces con las trayectoria posed, starting from three different methods of roots
original, el centro y los vrtices. Finalmente, se rea- location for obstacles in the scene. Those techniques
liza un anlisis de funcionamiento de la tcnica en change depending on the obstacle key points selec-
general y de la efectividad cada uno de los mtodos ted for roots, such as borders, crossing points with

1
Ingeniero Mecnico Elctrico, magister en Ingeniera Elctrica, Electrnica y Automtica, doctor en Ingeniera Elctrica, Electrnica y
Automtica. Director de investigacin Escuela de Ingeniera, Corporacin Unificada Nacional de educacin superior CUN, Profesor
Asociado Ingeniera Informtica Universidad de la Sabana, integrante del grupo de Investigacin CAPSAB. Bogot Colombia. Contacto:
mario_arbulu@cun.edu.co, mario.arbulu@unisabana.edu.co
2
Ingeniero en Control Electrnico e Instrumentacin, magister en Ingeniera Electrnica y de Computadores. Docente Investigador Ingeniera
Electrnica, Corporacin Unificada Nacional de educacin superior CUN. Bogot Colombia. Contacto: fernando_martinez@cun.edu.co
3
Ingeniero en Control Electrnico e Instrumentacin, especializacin en Telecomunicaciones, candidato a magister en Seguridad Informti-
ca. Docente Asistente Universidad Distrital Francisco Jos de Caldas. Bogot, Colombia. Contacto: hmontiela@udistrital.edu.co

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 49 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

original path, center and vertices. Finally, a behavior method. Modifications and possible improvements
analysis of general technique and the effectiveness to this methodology are also proposed.
of each tried method is performed, doing 20 tests for Keywords: Root locus, path planning, mobile robots,
each one, obtaining a value of 65% for the selected image processing.

INTRODUCCIN de retroalimentacin negativo (Rairn A., 2007).


Las trayectorias generadas se pueden definir como
Uno de los problemas ms evaluados en el rea de funciones paramtricas de geometra conforme
la robtica es la planeacin de rutas libres de obs- (Landi & Paoletti, 1995), por tanto la mayora tiene
tculos para robots mviles autnomos, los cuales una forma curva. A su vez, cada una de estas tra-
se encuentran inmersos en ambientes con obstcu- yectorias se caracteriza por avanzar continuamen-
los conocidos. Las investigaciones han mostrado te desde un polo hasta un cero del sistema.
gran variedad de enfoques; esto, sumado a que en Dadas las caractersticas de las trayectorias que
la actualidad se siguen haciendo nuevas propues- se pueden generar por medio de la localizacin
tas al respecto, da a entender que no existe una de races, el presente artculo propone utilizarlas
solucin absoluta al problema y que sigue siendo como una posible solucin al problema de la pla-
un nicho de investigacin activo. Entre las diferen- neacin de rutas libres de obstculos para robots
tes tcnicas exploradas para solucionar el proble- mviles con sensores externos. Para esto, el punto
ma de la planeacin de rutas para robots mviles de partida y el de llegada del robot se ven plasma-
con sensores externos (Ziaei, Oftadeh, & Matilla, dos como un polo y un cero respectivamente, ubi-
2014) se encuentran: campos de potenciales ar- cados en el plano complejo.
tificiales (Maarouf & Saliah-Hassane, 2011; Min- Conociendo el hecho de que ante la varia-
Ho, Jung-Hun, Yuanlong, & Min-Cheol, 2011), cin continua de una retroalimentacin negativa
diagramas de Voronoi (Vachhami, Mahindrakar, & los polos de un sistema dinmico tienden en una
Sridharan, 2010), grafos de visibilidad (Ganguli, trayectoria paramtrica determinada hacia los ce-
Corts, & Bullo, 2009), entre otros. La mayora de ros en el plano complejo, se procede a analizar
estas tcnicas estn soportadas por medio de algo- el procedimiento para aplicar esta tcnica para el
ritmos o tcnicas de procesamiento de imgenes, clculo de rutas libres de obstculos para robots
con el fin de hacer un procesamiento previo de las mviles con sensores externos. Se busca principal-
imgenes entregadas por la cmara y entregar una mente formular una metodologa que permita la
versin simplificada del entorno, incluyendo ubi- aplicacin prctica de esta tcnica en un entorno
cacin del robot, punto de llegada y obstculos, al real. Dicho entorno es un robot en un ambiente
algoritmo principal de planeacin (Yi-Han, Ming- rectangular con uno o varios obstculos distribui-
Chang, I-Hsum, Wei-Yen, & Shun-Feng, 2013). dos en l; todo esto es capturado en imgenes por
Por otra parte, la localizacin de races es una medio de una cmara ubicada en la parte superior,
tcnica utilizada para el clculo y sintonizacin de perpendicularmente al suelo.
compensadores o controladores en sistemas din-
micos (Hellerstein, Diao, Parekh, & Tillbury, 2004; METODOLOGA
Ogata, 2010; Ordoez L., Martnez S., & Garca
B., 2013). Partiendo de un sistema dinmico con Localizacin de races
races complejas, esta tcnica genera una grfica
con las trayectorias recprocas de dichas races en La localizacin de races es utilizada para el
un plano complejo, ante la inclusin de un lazo anlisis de la respuesta en tiempo y clculo de

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 50 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

controladores en sistemas dinmicos. Esta consiste


en partir de un sistema dinmico predeterminado,
con un nmero y ubicacin de races fijo y agre-
garle una retroalimentacin negativa, por lo gene-
ral una ganancia proporcional; de tal forma que la
ubicacin de cada uno de los polos o races del
denominador sea en funcin de esta ganancia. Se Figura 1. Retroalimentacin negativa.
parte de un sistema dinmico con una funcin de
Fuente: Elaboracin propia.
transferencia con un polo y un cero, ambos reales,
como el mostrado en la ecuacin (1), donde a y
b son las posiciones del cero y el polo en el plano 1
complejo respectivamente.
1 (2)

1

(1)
1
(3)
1
Se aplica una ganancia proporcional k en re-

troalimentacin negativa como la mostrada en la 1
1

figura 1. Del diagrama de bloques de la figura 1 y
aplicando lgebra de bloques se obtiene la nueva Aplicando la ganancia proporcional se modi-
funcin de transferencia de las ecuaciones (2) y fica la ganancia total del sistema, as como la po-
(3), las cuales estn en funcin de k. sicin del polo, quedando intacto el cero. Tanto

Figura 2. Grfica de localizacin de races para la funcin de trasferencia de la ecuacin (2), con a=-2 y b=-5.

Fuente: Elaboracin propia.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 51 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

la ganancia como el polo quedan ahora en fun- ve atrada hacia la ubicacin del cero, cuando se
cin de la ganancia k, por tanto se puede variar aplica una ganancia en retroalimentacin negati-
gradualmente el valor de k y graficar la trayecto- va. As mismo cuando se tienen sistemas con ml-
ria formada por todas las posibles posiciones del tiples polos y ceros, como el de la ecuacin (4). Se
polo del sistema. Si la ganancia k es cero, de la tienen tantas trayectorias como el orden mayor de
ecuacin (2) se obtiene que la posicin del polo es los polinomios de numerador y denominador de la
b, es decir que se ubica en su posicin original. funcin de trasferencia, es decir max(m, n), donde
Cuando k tiende a infinito, la posicin del polo m es el nmero de polos y n el de ceros.
es ahora la misma posicin del cero del sistema,
como se puede apreciar en la ecuacin (3). De lo (4)


anterior se concluye que en un sistema dinmico
con un polo y un cero, ambos reales, se puede gra-
ficar una trayectoria continua partiendo desde el En la figura 3 se muestra la grfica de locali-
polo hacia el cero si realizamos una retroalimen- zacin de races de un sistema con cuatro polos
tacin negativa con una ganancia proporcional k, complejos conjugados, cuatro ceros complejos
donde dicha trayectoria se define como una fun- conjugados y un polo real. En el caso de tener ra-
cin paramtrica de k en un plano complejo. Para ces complejas, es necesario que estas siempre sean
el ejemplo propuesto, la trayectoria es una lnea conjugadas con respecto a la coordenada imagina-
recta horizontal desde el polo hacia el cero, debi- ria, esto produce que las trayectorias sean recpro-
do a que se tratan de races reales. Esto se puede cas con respecto al eje real. En este caso cada polo
observar en la figura 2. tiende hacia un cero, generando cuatro trayecto-
Se puede inferir que la trayectoria se genera rias simtricas en pares con respecto al eje real del
debido a que la posicin del polo del sistema se plano complejo; el polo restante tiende hacia el

Figura 3. Grafica de localizacin de races para una funcin de trasferencia con 5 polos y 4 ceros.

Fuente: Elaboracin propia.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 52 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

infinito, dado que no existe ningn otro cero hacia Caracterizacin de la tcnica de localizacin
el cual avanzar. Ntese que existe una nica tra- de races
yectoria que une cada polo con un cero, pero esta
se ve afectada por el resto ceros existentes. Adicional al comportamiento bsico descrito de
Las trayectorias generadas con este mtodo se los polos en la tcnica de localizacin de races,
pueden definir como funciones paramtricas de existen otras caractersticas importantes para tener
geometra conforme (Landi & Paoletti, 1995), es en cuenta antes de realizar una implementacin
decir que las trayectorias generadas para sistemas completa de planeacin de rutas. La primera es
de orden 2 coinciden con segmentos de circunfe- que la escala de la posicin de las races no cam-
rencia. Para sistemas de orden superior, la forma bia la forma de la trayectoria generada. Si parti-
de dichas trayectorias puede variar dependiendo mos de un sistema dinmico con dos polos y dos
del orden mismo de los polinomios de numera- ceros complejos conjugados como el mostrado en
dor y denominador del sistema dinmico; estas la ecuacin (5), y si se aplica un factor de escala
pueden ser: rectas, parablicas, circulares, elp- (ecuacin (6)), la forma de la trayectoria resul-
ticas y curvas complejas. A su vez, cada una de tante no se vea afectada, como se muestra en la
estas trayectorias se caracteriza por avanzar con- figura 4).
tinuamente desde un polo hasta un cero del siste-
ma, presentando repulsin entre races del mismo
tipo y atraccin entre tipos diferentes de races, de 
(5)
forma similar a como lo hacen las cargas que re-
presentan el robot, el punto de llegada y los obs-
tculos en la tcnica de campos de potenciales  (6)

artificiales (Maarouf & Saliah-Hassane, 2011).

Figura 4. Grfica del cuadrante superior izquierdo de la localizacin de races para un sistema con ceros en -1+i,
-1-i y polos en -9+9i, -9-9i (parte media), con =0.001 (superior) y con =1000 (inferior).

Fuente: Elaboracin propia.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 53 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

Por otro lado, as como las trayectorias genera- el semiplano inferior. En la figura 7 se muestran
das por cada par de polos complejos conjugados las grficas de localizacin de cuatro sistemas di-
son recprocas, es decir que son simtricas con res- nmicos diferentes sobrepuestos uno al otro en los
pecto al eje real, si se tiene la misma disposicin cuadrantes superior e inferior derecho. Se observa
de polos y ceros en dos sistemas diferentes, pero se la tendencia que tienen las curvas generadas ale-
intercambia el semiplano derecho por el izquier- jndose del eje real, as como tambin se ve una
do, las trayectorias generadas para los dos sistemas trayectoria totalmente recta, en el sistema cuyo
presentan simetra con respecto al eje imaginario. polo y cero comparten la misma coordenada real.
Esto se puede observar en la figura 5). La forma de las trayectorias de los polos se defi-
Sabiendo que cada polo de un sistema avanza ne por medio de funciones paramtricas en un pla-
por una trayectoria definida hasta alcanzar la po- no complejo, la cual depende de la ubicacin de
sicin de un polo, se puede decir tambin que se todas las races del sistema dinmico representado,
genera la misma trayectoria si se parte de un punto por tal razn hallar una funcin generalizada para
p(a,c) hacia un punto q(b,d) o viceversa. Es decir un sistema de orden superior es una tarea demasia-
que las trayectorias de las races de los sistemas do ardua, de tal forma que se procede a utilizar el
mostrados en las ecuaciones (5) y (7) son iguales, algoritmo de root locus en el software MATLAB.
tal como se muestra en la figura 6.

Utilizacin de la tcnica de localizacin de


(7) races

Las trayectorias generadas para sistemas con un Una vez conocidas las caractersticas morfolgicas
par de polos y de ceros complejos tiende hacia de las trayectorias generadas a partir de la tcnica
arriba en el semiplano superior y hacia abajo en de localizacin de races en el plano complejo, se

Figura 5. Grfica del cuadrante superior izquierdo de la localizacin de races para un sistema con ceros en -1+i,
-1-i y polos en -9+9i, -9-9i (superior) y del cuadrante superior derecho para un sistema con ceros en 1+i, 1-i y
polos en 9+9i, 9-9i (inferior).

Fuente: Elaboracin propia.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 54 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

Figura 6. Grfica del cuadrante superior derecho de la localizacin de races para un sistema con ceros en 1+i, 1-i
y polos en 9+9i, 9-9i (superior) y para un sistema con ceros en 9+9i, 9-9i y polos en 1+i, 1-i (inferior).

Fuente: Elaboracin propia

Figura 7. Grfica del semiplano derecho de la localizacin de races para cuatro sistemas diferentes, cada una con
dos ceros y dos polos complejos conjugados.

Fuente: Elaboracin propia.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 55 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

procede a plantear un procedimiento metodolgi- original del escenario con el del plano complejo.
co para su utilizacin como tcnica de planeacin Teniendo en cuenta que el sistema coordenado de
de rutas libres de obstculos para robots mviles. una imagen digital avanza de izquierda a derecha
Dicho procedimiento metodolgico consiste en y de arriba hacia abajo, esta se hace coincidir con
tres pasos. Primero se identifican las coordenadas el cuadrante superior derecho del plano complejo
del robot y de los obstculos utilizando algoritmos para obtener solo distancias y posiciones positivas.
de procesamiento de imgenes; luego se genera Para lo cual es necesario una transformacin entre
la funcin de transferencia del sistema dinmico el sistema coordenado de la imagen de entrada (x1,
ubicando races en las coordenadas previamente y1) y el sistema coordenado del plano complejo
obtenidas. Finalmente se obtiene la grfica de root (x2, y2), como lo definen las ecuaciones (8) y (9),
locus correspondiente a las rutas viables para la donde S es el factor de escala y maxyi es el mximo
navegacin del robot. nmero de pixeles en la coordenada y, de la ima-
gen de entrada.
Captura y procesamiento de las imgenes del
entorno  (8)

La captura y procesamiento de las imgenes del  (9)


entorno es el paso previo a la aplicacin del algo-
ritmo de localizacin de races. Su objetivo es en-
tregar la menor cantidad posible de informacin al La figura 8 muestra la transformacin corres-
algoritmo de planeacin, es decir que de una ima- pondiente a la imagen de entrada a coordena-
gen a color con el robot, los obstculos y la marca- das en el plano complejo. Se observa en la parte
cin del punto de llegada se obtenga una imagen izquierda la imagen de entrada y sobre el fondo
en blanco y negro con los obstculos, las coorde- negro se identifica el punto de partida en azul, el
nadas de ubicacin y la orientacin del robot y las punto de llegada en rojo y los obstculos en blan-
coordenadas del punto de llegada (Torres, Vifara, co. En la parte derecha se observa el mapeo de los
& Martnez S., 2014). Esto se realiza utilizando di- puntos de partida y llegada y el obstculo. Aunque
versos algoritmos de procesamiento de imgenes, para esta aplicacin solo se visualiza uno de los
tales como segmentacin por colores y clculo de cuadrantes del plano complejo, cabe recordar que
centroides (Akita, Watanabe, Tooyama, Miyami, & todas las races del sistema dinmico son comple-
Yoshimoto, 2003). jas conjugadas, es decir que se tiene un compor-
El algoritmo de segmentacin por colores con- tamiento simtrico con respecto al eje real en el
siste en extraer de la imagen del escenario ni- cuadrante inferior derecho. Para este ejemplo se
camente las partes de la imagen de determinado tiene una imagen de entrada de 500*500 pixeles
color, en este caso los marcadores ubicados sobre y el semiplano de salida va desde 0 a 10 en cada
el robot, en el punto de llegada y el color de los uno de los ejes coordenados, lo cual implica el
obstculos (Torres, Vifara, & Martnez S., 2014). uso de un factor de escala S de 0,02.
Despus de conocer la ubicacin exacta del ro-
Localizacin de las races en los puntos clave bot y del punto de llegada se localizan sobre estos
del escenario un polo y un cero respectivamente, de tal forma
que al realizar la grfica de root locus se obtiene
Para utilizar la tcnica de localizacin de ra- una trayectoria semicircular entre el punto de lle-
ces para la navegacin de robots es necesario ha- gada y el punto de salida como se muestra en la
cer coincidir el sistema coordenado de la imagen figura 9.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 56 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

Figura 8. Conversin de coordenadas entre la imagen del escenario y el plano complejo.

Fuente: Elaboracin propia.

Figura 9. Trayectoria inicial desde el punto de partida hasta el de llegada.

Fuente: Elaboracin propia.

La trayectoria inicial generada depende nica- obstculos presentes, para esto se proponen tres
mente del punto de partida y del de llegada, sin mtodos diferentes los cuales usan como refe-
tener en cuenta el obstculo. Por tal motivo esta rencia diferentes puntos clave de cada obstculo.
trayectoria puede producir una colisin del robot El primer mtodo es la localizacin de las races
con alguno de los obstculos (figura 9). usando el centro de los obstculos, el segundo es
Por lo tanto es necesario ubicar ms races usando los vrtices de los obstculos y el tercero,
con el fin de desviar la trayectoria original de los usando el borde de los obstculos

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 57 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

Para los tres mtodos propuestos es necesario RESULTADOS


ubicar al menos dos races (un polo y un cero)
por cada obstculo, a una distancia relativamente El primer mtodo consiste en ubicar un polo y
corta entre ellas, con el fin de que se genere una un cero muy cerca al centro del objeto, a una dis-
trayectoria nueva entre este par de races y no se tancia muy pequea entre estos; para este caso se
presente entrecruzamiento con el polo y el cero define como distancia entre races del obstculo la
originales (figura 10), pero que a su vez afecten la centsima parte del tamao mximo del escena-
trayectoria original. rio, en coordenadas del plano complejo. Adems,

Figura 10. Problemas de entrecruzamiento de las nuevas races con las originales. Izquierda: uso de una sola raz
(un polo), derecha: uso de dos races mal ubicadas.

Fuente: Elaboracin propia.

Figura 11. Trayectoria obtenida ubicando un polo y un cero cerca al centro del obstculo.

Fuente: Elaboracin propia.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 58 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

tanto el polo como el cero deben ser ubicados des- completo la colisin), pero genera trayectorias
de el centro del obstculo en direccin hacia su bastante amplias que en dependencia de la ubi-
igual de la trayectoria original con el fin de evitar cacin de los obstculos con respecto al escenario
entrecruzamiento (figura 10, derecha) de trayecto- pueden sobrepasar los lmites de este, lo que im-
rias (figura 11). plica una colisin con las paredes del escenario en
Adicionalmente, en la figura 11 se puede apre- la aplicacin real.
ciar que a pesar de que la trayectoria original se ve En el tercer mtodo se procede a ubicar un polo
afectada por el nuevo par de races, la desviacin y un cero sobre las intersecciones de los bordes
no es lo suficientemente grande como para evitar del obstculo y la trayectoria original. De la mis-
la colisin con el obstculo. Esto se soluciona au- ma forma que los mtodos anteriores, para evitar
mentando la distancia de separacin entre las nue- el entrecruzamiento de las races, el polo y el cero
vas races. deben ser ubicados en el punto ms cercano a su
En el segundo mtodo se ubican un polo y un igual de la trayectoria original, en este caso el pun-
cero en los vrtices del obstculo ms cercanos a to de cruce ms cercano a cada una de las races
las races de la trayectoria original. Adicionalmen- del mismo tipo, como se ve en la figura 13.
te, tanto el polo como el cero deben ser ubicados Este mtodo genera una trayectoria circular de
en el vrtice ms cercano a su igual de la trayecto- desvo sobre la trayectoria principal, como se ve en
ria original para evitar entrecruzamiento, como se la figura 13, donde se observa que la ruta genera-
aprecia en la figura 12. da evita la colisin (izquierda), pero si el obstculo
Este mtodo minimiza altamente el riesgo de est levemente desplazado, se puede producir en-
colisin del robot con el obstculo (en el caso de trecruzamiento o la trayectoria obtenida produce
obstculos con una alta simetra radial evita por colisin con el obstculo (derecha).

Figura 12. Trayectoria obtenida ubicando un polo y un cero en los vrtices del obstculo ms cercanos a las races
originales

Fuente: Elaboracin propia

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 59 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

Figura 13. Trayectoria obtenida ubicando un polo y un cero en los puntos de cruce entre el borde del obstculo y
la trayectoria generada por las races originales.

Fuente: Elaboracin propia.

Tabla 1. Comparativa entre mtodos de ubicacin de races de los obstculos en 20 pruebas diferentes.

Mtodo Colisiones con el obstculo Colisiones con el escenario Rutas vlidas Efectividad [%]
1 4 3 13 65
2 0 9 11 55
3 9 3 9 45

Fuente: Elaboracin propia

En los tres mtodos empleados para la gene- Las 20 pruebas se realizaron con imgenes con
racin de rutas libres de obstculos para robots resolucin de 450*450 pixeles, con las cuales se
mviles se limitaron a un solo obstculo en el es- utiliza una modificacin de la tcnica de proce-
cenario. Se realizaron 20 pruebas para cada mto- samiento de imgenes llamada crecimiento de
do ubicando arbitrariamente el obstculo, despus regiones (Xiaoqi, Jianshuai, Xiaoying, Zhang, &
de lo cual se obtuvieron los resultados mostrados Li, 2014), ampliamente empleada en segmenta-
en la tabla 1. cin de imgenes mdicas, para realizar un con-
La efectividad se calcul como la proporcin teo de la longitud por medio de pixeles de cada
entre las pruebas sin colisin y el total de estas. Lo una de las trayectorias vlidas. Teniendo en cuen-
anterior muestra que el mtodo 1 evita en mayor ta la longitud de una trayectoria ideal hallada con
medida las colisiones tanto con el obstculo como el algoritmo de planeacin de rutas BUG (Langer,
con los bordes del escenario. El mtodo 2 muestra Coelho, & Oliveira, 2007) de 253 pixeles, se cal-
que evita cualquier colisin con el obstculo, pero cula la longitud relativa de cada trayectoria y la
genera una trayectoria tan amplia que muchas ve- longitud relativa promedio sobre las 20 pruebas
ces colisiona con el escenario. El mtodo 3 gene- para cada mtodo. Los resultados se resumen en
ra muchas colisiones con el obstculo, por eso su la tabla 2.
baja efectividad.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 60 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

Tabla 2. Longitud promedio de las trayectorias obtenidas.

Mtodo Longitud Promedio [pixeles] Longitud relativa Promedio [%]


1 295 116.6
2 351 138.7
3 320 126.5

Fuente: Elaboracin propia.

La longitud relativa es calculada como la rela- que el comportamiento de las trayectorias genera-
cin entre el nmero de pixeles de la trayectoria das por root locus presenta convexidad con respec-
de referencia y el nmero de pixeles de las trayec- to al eje real, se obtiene un juego de trayectorias
torias obtenidas con cada una de los mtodos. El limitadas con una tendencia definida que no de-
resultado es que el mtodo 1 obtiene trayectorias pende de los obstculos presentes en el escenario.
ms cortas en promedio que los otros dos mtodos Basta con localizar un par de races (un polo y
probados. un cero) en cada obstculo para obtener un efecto
de repulsin del robot hacia el obstculo, teniendo
CONCLUSIONES en cuenta que estos deben estar ubicados basndo-
se en puntos clave del obstculo, pero siempre en
La caracterizacin realizada sobre las trayectorias direccin a su equivalente en la trayectoria original
generadas usando la tcnica de localizacin de (punto de partida o llegada). En dado caso de que
races en el plano complejo muestra que princi- no se ubiquen correctamente las races, se puede
palmente se pueden obtener curvas semicirculares dar el efecto de entrecruzamiento de races pro-
para sistemas de orden bajo y curvas complejas duciendo trayectorias con colisiones, lo cual hace
para sistemas de orden superior, siendo solo po- que la metodologa propuesta sea sensible a pe-
sibles lneas rectas de forma vertical (solo son po- queos cambios en la posicin de los obstculos.
sibles lneas horizontales sobre el eje real). Este El mtodo de ubicar las races en los vrtices
hecho imposibilita la obtencin de lneas rectas del obstculo evita totalmente la colisin con un
diagonales, las cuales podran ser la solucin pti- obstculo radialmente simtrico, pero aumenta la
ma en algunos de los posibles escenarios presentes. probabilidad de colisin con las fronteras del es-
La seleccin entre un polo o un cero para el cenario (tabla 1) y genera trayectorias mucho ms
punto de partida y por tanto su contraparte parar largas (tabla 2).
el punto de llegada es indiferente a la trayecto- El tercer mtodo que consiste en ubicar las
ria inicial obtenida, solo tenindose en cuenta a nuevas races en las intersecciones del borde del
la hora de ubicar las races correspondientes a los obstculo y la trayectoria original presenta unas
obstculos. trayectorias relativamente cortas, pero con proba-
La escala del plano complejo tampoco tiene bilidades altas de colisin con el obstculo.
efecto sobre la forma de la trayectoria obtenida, Despus de las pruebas realizadas se concluye
por lo que es posible realizar una conversin del que la mejor opcin es el primer mtodo plantea-
sistema coordenado de la imagen de entrada hacia do (ubicar un polo y un cero cerca del centro del
el plano complejo omitiendo el factor de escala S. obstculo), ya que aunque en algunas ocasiones
Los mtodos planteados presentan un mapeo presenta colisiones con el obstculo, muestra un
fijo de la imagen del escenario a uno de los cua- mejor promedio de efectividad con respecto a los
drantes del plano complejo; si a esto se le suma otros dos mtodos (tabla 1 y tabla 2).

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 61 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

TRABAJO FUTURO Sensors in Nonconvex Environments. IEEE Transac-


tions on Robotics, 25(2), 340352. doi:10.1109/
Para mejorar la eficiencia del mtodo que ubica TRO.2009.2013493
un polo y un cero en el centro del obstculo, se Hellerstein, J. L., Diao, Y., Parekh, S., & Tillbury, D. M.
puede aumentar la separacin entre ellos; pero al (2004). Proportional Control (1 ed.). Wiley-IEEE
ser esto un problema que depende tambin de la Press.
forma de los obstculos, se puede hacer que di- Landi, A., & Paoletti, F. (1995). Reciprocal root locus
cha separacin dependa del tamao del objeto, lo approach to path planning for multiple mobile ro-
cual se logra usando tcnicas de procesamiento de bots. INRIA/IEEE Symposium on Emerging Techno-
imgenes. logies and Factory Automation. 2, pgs. 345352.
Es posible plantear otro mtodo usando el pun- Paris: IEEE. doi:10.1109/ETFA.1995.496675
to ms cercano del borde del obstculo en lugar Langer, R., Coelho, L., & Oliveira, G. (2007). K-Bug, A
de los vrtices para ubicar las races. New Bug Approach for Mobile Robots Path Plan-
Se puede utilizar un algoritmo de dilatacin de ning. IEEE International Conference on Control
imgenes sobre la imagen de entrada, con el fin de Applications (pgs. 403-408). Singapore: IEEE.
que cada obstculo tenga en cuenta el radio m- doi:10.1109/CCA.2007.4389264
nimo del robot, ya que hasta el momento se trata Maarouf, J. S., & Saliah-Hassane, H. (2011). An Impro-
al robot como un punto en el escenario. As mis- ved Artificial Potential Field Approach to Real-Ti-
mo, se puede pensar en calcular el esqueleto de la me Mobile Robot Path Planning in an Unknown
imagen de los obstculos y usarla como referencia Environment. IEEE International Symposium on
para obtener los puntos clave en la ubicacin de Robotic and Sensors Environments (ROSE) (pgs.
races. Esto se plantea pensando en que el esque- 208213). Montreal, QC: IEEE. doi:10.1109/
leto es una representacin simplificada del mismo ROSE.2011.6058518
obstculo, el cual lo puede caracterizar de mejor Min-Ho, K., Jung-Hun, H., Yuanlong, W., & Min-Cheol,
forma. Dado que los mtodos planteados funcio- L. (2011). A path planning algorithm using artificial
nan nicamente para escenarios con un obstculo, potential field based on probability map. 8th Inter-
se pueden plantear otros para el problema de ml- national Conference on Ubiquitous Robots and Am-
tiples obstculos. bient Intelligence (URAI) (pgs. 4143). Incheon,
Es posible realizar un algoritmo que ubique Corea: IEEE. doi:10.1109/URAI.2011.6145929
de forma adaptativa los polos y ceros de sistema Ogata, K. (2010). Ingeniera de Control Moderna (5 ed.).
partiendo de su ubicacin base, con el fin redu- Pearson.
cir al mnimo la sensibilidad de la metodologa Ordoez L., R. A., Martnez S., F., & Garca B., H.
planteada a los pequeos cambios de posicin del R. (Marzo de 2013). Proceso agroindustrial de
obstculo. la produccin de panela. Tecnura, 17(35), 47-
54. doi:http://dx.doi.org/10.14483/udistrital.jour.
REFERENCIAS tecnura.2013.1.a04
Rairn A., J. D. (2007). Anlisis de Sistemas Dinmicos y
Akita, J., Watanabe, A., Tooyama, O., Miyami, M., & control PID (1 ed.). Bogot, Colombia: Universidad
Yoshimoto, M. (10 de marzo de 2003). An image Distrital Francisco Jos de Caldas.
sensor with fast objects position extraction func- Torres, J., Vifara, R., & Martnez S., F. (Diciembre de
tion. IEEE Transactions on Electron Devices, 50(1), 2014). Procesamiento de Imgenes para La Pla-
184-190. doi:10.1109/TED.2002.806478 neacin de Rutas para Robots Mviles Basados en
Ganguli, A., Corts, J., & Bullo, F. (27 de Marzo de LEGO Mindstorms NXT. Redes de Ingeniera, 5(2),
2009). Multirobot Rendezvous With Visibility 16-27.

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 62 ]
Metodologa para el uso de la tcnica de localizacin de races en la planeacin de rutas para robots mviles
Arbul Saavedra, M. R., Martnez Santa, F., & Montiel Ariza, H.

Vachhami, L., Mahindrakar, A. D., & Sridharan, K. Yi-Han, C., Ming-Chang, C., I-Hsum, L., Wei-Yen, W.,
(18 de Octubre de 2010). Mobile Robot Naviga- & Shun-Feng, S. (2013). Image-based obstacle avoi-
tion Through a Hardware-Efficient Implementation dance and path-planning system. International Con-
for Control-Law-Based Construction of Generali- ference on System Science and Engineering (ICSSE)
zed Voronoi Diagram. IEEE/ASME Transactions on (pgs. 205209). Budapest: IEEE. doi:10.1109/
Mechatronics, 16(6), 10831095. doi:10.1109/ ICSSE.2013.6614660
TMECH.2010.2076825 Ziaei, Z., Oftadeh, R., & Matilla, J. (2014). Global Path
Xiaoqi, l., Jianshuai, W., Xiaoying, R., Zhang, B., & Li, Planning with Obstacle Avoidance for Omnidirec-
Y. (Mayo de 2014). The study and application of tional Mobile Robot Using Overhead Camera. IEEE
the improved region growing algorithm for liver International Conference on Mechatronics and Au-
segmentation. OptikInternational Journal for Light tomation (ICMA) (pgs. 697-704). Tianjin, China:
and Electron Optics, 125(9), 21422147. IEEE. doi:10.1109/ICMA.2014.6885782

Tecnura p-ISSN: 0123-921X e-ISSN: 2248-7638 Vol. 19 No. 46 Octubre - Diciembre 2015 pp. 49-64
[ 63 ]

S-ar putea să vă placă și