Documente Academic
Documente Profesional
Documente Cultură
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
Mario Ricardo Arbul Saavedra1, Fernando Martnez Santa2, Holman Montiel Ariza3
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
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.
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.
Figura 2. Grfica de localizacin de races para la funcin de trasferencia de la ecuacin (2), con a=-2 y b=-5.
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.
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).
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).
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).
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.
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)
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.
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.
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.
Figura 11. Trayectoria obtenida ubicando un polo y un cero cerca al centro del obstculo.
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
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.
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
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.
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.
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 ]