Você está na página 1de 10

1 / 1

Director de la revista
Mg. Enrique Mansilla Pérez

Comité editorial
Mg. Mauricio Aguirre
Mg. Felipe Onchi
CPC Angélica Urquizo

Colaboradores
Mg. Sandra Romero
Ing. Vladimir Barahona

Diseño y diagramación
Juan Carlos Jiménez Flores

Investiga UTP, Nº 1, Marzo 2018


Diseño de un sistema de control
de posición de un robot móvil
omnidireccional
Por: Ing. Jose Luis Bohorquez Bendezú1

Los robots se reirán de nuestra valiente locura -dijo-. Pero algo


en sus corazones de hierro anhelará haber vivido y haber muerto
como nosotros, cumpliendo nuestra misión como héroes.
Bajo la misma estrella 2012 – John Green

Resumen los tres motores de corriente continua.


El Posicionamiento y modelado son Finalmente el controlador usado en este
problemas fundamentales en la navegación prototipo es un controlador proporcional-
de robots móviles. El presente trabajo derivativo (PD).
describe la construcción de un robot móvil
omnidireccional de tres ruedas con tres El trabajo presenta simulaciones de tres
grados de libertad. La configuración elegida tipos de desplazamientos (circular, senoidal
mecánicamente es simple, y proporciona y lineal) que puede realizar el robot móvil
la capacidad al móvil de desplazarse en omnidireccional.
cualquier dirección sin necesidad de realizar
una rotación previa, característica muy útil Palabras claves
en espacios reducidos. Robots móviles, Control Proporcional
Derivativo, Configuración Ackerman.
En la primera parte de este trabajo se
presenta el modelado matemático del Introducción
sistema robot móvil omnidireccional. En espacios reducidos como los almacenes,
En segundo lugar se exhibe el diseño clínicas, edificios, se suelen usar vehículos
mecánico del móvil partiendo de valores omnidireccionales (Fig. 1.), Para controlar
específicos de velocidad, aceleración, estos móviles omnidireccionales
carga requeridas, también se presenta una es necesario realizar un modelado
metodología del cálculo de potencia de matemático del sistema físico (Robot móvil
los motores a partir del análisis del modelo omnidireccional) por lo cual se plantea en
dinámico y cinemático del robot móvil, este proyecto la realización del modelado
seleccionando con los datos obtenidos, cinemático, dinámico y control de un robot

1
Docente del Departamento de Electrónica, Cursos de Sistemas de Control e Ingenieria de Control, Universidad Tecnológica del Perú.
C16337@utp.edu.pe

Investiga UTP, Nº 1, Marzo 2018


móvil omnidireccional como también el I. Modelamiento matemático del sistema
diseño del sistema mecánico del prototipo. En este trabajo se desarrolla el
modelamiento matemático de los
subsistemas que conforman al robot móvil
omnidireccional, con el fin de diseñar el
sistema de control de posición del robot
móvil omnidireccional.

El robot móvil omnidireccional consta de


tres ruedas omnidireccionales3 con rodillos
dispuestos en 90 grados respecto de la
rueda principal, lo cual permite a la rueda
la particularidad de desplazarse de forma
lateral. Las tres ruedas están dispuestas
(a) en los vértices de un triángulo equilátero
que conforman la base del móvil como se
observa en la figura 2.

Estas características descritas permiten


que el móvil se desplace en cualquier
dirección sin necesidad de realizar giros
previos, como son necesarios en otras
configuraciones (diferencial, ackerman,
etc).

(b) El modelo cinemático y dinámico se


obtiene a partir de la mecánica newtoniana
Fig. 1. Vehículo de carga de la empresa o mecánica vectorial, también se obtiene
DEMATIC (a), AVA 500 innovador robot el modelo dinámico de los motores de
móvil de Telepresencia2 corriente directa. Estos modelos sirven para

2
Disponible en la página web http://www.irobot.com/For-Business/Ava-500.aspx .
3
Ruedas omnidireccionales usadas: Disponible en la página web http://www.kornylak.com/wheels/transwheel.html .

24 / 25
realizar las simulaciones correspondientes la velocidad rotacional entorno al eje Z
del comportamiento dinámico del móvil. medida desde el world frame, , , las
velocidades de las ruedas, medidas desde
el body frame, es el radio de la rueda y
la matriz de geometría del móvil.

La ecuación matricial (1.0) se reduce a la


siguiente expresión:

( 2.1 )
Donde:

Vector de velocidades de las ruedas.


Fig. 2. Esquema del móvil omnidireccional.

En la figura 3 se representa un esquema Derivada del vector de estados del robot


del sistema robot móvil en el cual se detalla móvil.
las principales características del mismo
usando una rueda genérica (Rn); vector
posición ( ), Velocidad tangencial de Radio de la rueda (las tres son iguales).
la rueda ( ), Velocidad angular del móvil
( ), todas estas variables útiles para el
modelado cinemático del robot móvil.

BM: Matriz de geometría del móvil.

B Modelo dinámico

( 2.0 )

Fig. 3. Velocidad tangencial de la rueda La ecuación (2.0) se denomina: ecuación


con respecto al centro del móvil (M). dinámica del robot móvil omnidireccional
de tres ruedas o ecuación dinámica del
A. Modelo cinemático móvil, esta relaciona la aceleración que
desarrolla el móvil, con las fuerzas de
tracción en las ruedas, producidas por los
(1.0) motores ( ).

Donde:
Siendo la velocidad en el eje X medida
desde el world frame, la velocidad en
el eje Y medida desde el world frame, Vector de aceleración del móvil.

Investiga UTP, Nº 1, Marzo 2018


Matriz de masa. Matriz de geometría del móvil.

Vector de fuerzas de tracción.

Matriz de rotación, con respecto al eje .

C. Modelo dinámico de los motores de corriente directa

Fig. 4. Circuito equivalente del motor DC, con reductor y rueda.

D. Modelo unificado

Modelo de estado reducido del sistema:

Donde:

Matriz de Constantes de velocidad.

26 / 27
Matriz de constantes.

Vector de estados del robot.

Vector de voltajes de los motores.

Fig. 5. Vista isométrica del robot móvil

II. Diseño virtual (Solidwork) III. Control


En este diseño se consideraron aspectos Para sintonizar los parámetros del
de estabilidad de la estructura, así como controlador, se emplea el modelo
los materiales necesarios para cumplir matemático del móvil omnidireccional y
con los requerimientos de la carga de se usa un método de prueba y error para
diez kilogramos que integra los baterías, la sintonización de los parámetros del
motores, aditamentos que conforman al controlador, de esta forma se determinan
móvil y una carga extra considerada para los valores representados en la figura 6 de
futuros proyectos. forma empírica.

El resultado del diseño base se presenta en la Esto solo se desarrolla como primer paso
figura 5. Se observa la estructura completa, ya que el controlador final se plantea el
así como las ruedas omnidireccionales con uso de un control multivariable.
sus soportes, disposición de los motores,
baterías, tarjetas de control, etc.

Figura 6. Sistema de control PD

Investiga UTP, Nº 1, Marzo 2018


IV. Simulaciones y resultados del sistema móvil a las entradas de:
El objetivo principal del proyecto es desplazamiento en el eje X deseado ( ),
controlar la posición del robot móvil desplazamiento en el eje Y deseado ( ) y
omnidireccional, para que siga una orientación del móvil deseada ( ).
trayectoria deseada, con la configuración
omnidireccional con tres ruedas que tiene. Para el control del desplazamiento se utiliza
un controlador proporcional derivativo (PD),
Se realizó simulaciones en Simulink que es y se realizan pruebas para diferentes tipos
un entorno de programación gráfica, que de desplazamiento en el plano, con lo cual
funciona sobre el entorno de programación se busca medir los parámetros obtenidos
MATLAB. tales como velocidad de desplazamiento
del móvil, desviación de la referencia de
Los resultados de la simulación se desplazamiento deseado, porcentaje de error
han obtenido del modelo matemático de desplazamiento, entre otros factores.

Figura 7. Esquema de control PD detallado, en Simulink.

Se realizó simulaciones del robot móvil para 2 tipos de desplazamientos; desplazamiento


circular y senoidal (Figura 8 y 9).

Figura 8. Desplazamiento sinodal del robot Figura 9. Desplazamiento circular del


móvil omnidireccional. robot móvil omnidireccional.

28 / 29
Conclusiones un FPGA,” INSTITUTO POLITÉCNICO
- Se propuso un diseño mecánico NACIONAL, 2012.
relativamente simple de construir • J. F. Camarena García, “Análisis
para que opere óptimamente, en el cinemático, dinámico y control en
cual se usó materiales en función de tirmpo real de un vehículo guiado
las necesidades de diseño plantadas automáticamente,” Centro nacional de
inicialmente, y se consideró un investigación y desarrollo tecnológico,
margen extra de carga para posibles 2009.
requerimientos de trabajos posteriores. • P. J. Serrano C., “Diseño y construcción
de un robot móvil con dos motores
- Se obtuvo el modelo matemático independientes y una rueda libre,”
unificado del sistema robot móvil Instituto politécnico nacional, 2010.
omnidireccional, que comprende el • V. F. Muñoz Martínez, G. Gil-Gómez,
modelo cinemático, modelo dinámico, and A. García Cerezo, “Modealdo
y modelo de los motores. Con estos, cinematico y dinamico de un robot
se pudo diseñar el controlador, ya nos móvil omni-direccional,” Malaga, p. 9.
permite conocer el comportamiento • S. Domínguez, Control en espacio
del sistema. de estado, Segunda ed. Universidad
Polítecnica de Madrid, Madrid.:
- Se diseñó un control de trayectoria PEARSON, 2006, pp. 1–440.
que contiene tres controladores • “http://www.gizmag.com/darpa-
proporcionales (PD) en paralelo, el cual lc3-robot-quadruped/14256/
se simulo con el modelo matemático picture/111087.” .
de móvil en tres tipos diferentes • “http://www.uni-magdeburg.de/ieat/
de desplazamientos clásicos: robotslab/slair2.php.” .
desplazamiento lineal, desplazamiento • “http://robotics.mech.kit.ac.jp/kimura/
senoidal y desplazamiento circular. research/Quadruped/photo-movie-
- Se emplea un controlador proporcional kotetsu-e.html.” .
derivativo (PD). No se consideró el • “http://robomatter.com/Shop-By-
término integral ya que este tiene R o b o t / V E X- R o b o t s / H a r d w a r e /
un efecto desestabilizador debido al Mechanics/Mecanum-Wheel-4-4-
corrimiento de fase agregado. pack.” .
• L. I. Gracia Calandín, “Modelado
Bibliografía Cinemático y Control de Robots Móviles
• S. G. Tzafestas, “General concepts,” in con Ruedas,” UNiversidad Politécnica
Introduction to Mobile Robot Control, de Valencia.
First edit., National Technical University • R. L. Williams Ii and J. Wu, “Dynamic
of Athens , Greece: Elsevier, 2014, pp. Obstacle Avoidance for an Omni-
1–691. Directional Mobile Robot,” J. Robot., no.
• B. García, “Diseño y construccíon de un 740, p. 30, 2010.
robot móvil controlado con técnicas • Y. Liu, J. J. Zhu, R. L. Williams, and
de lógica difusa implementadas en J. Wu, “Omni-directional mobile

Investiga UTP, Nº 1, Marzo 2018


robot controller based on trajectory de Madrid.
linearization,” Rob. Auton. Syst., vol. 56, • M. Hazas and A. Ward, “A Novel
no. 5, pp. 461–479, May 2008. Broadband Ultrasonic Location
• A. J. R. Neves, A. J. Pinho, D. A. System,” Springer-Verlag., vol. 2498,
Martins, and B. Cunha, “An efficient no. September, pp. 264–280, 2002.
omnidirectional vision system for • V. R. Pérez Miranda, “DISEÑO E
soccer robots: From calibration to IMPLEMENTACIÓN DE UN SISTEMA DE
object detection,” Mechatronics, vol. EN EL BARRIO SANTA LUCIA CENTRO
21, no. 2, pp. 399–410, Mar. 2011. DEL CANTÓN TISALEO,” Universidad de
• R. Hafner and M. Riedmiller, las fuerzas armadas, Ecuador, 2013.
“Reinforcement Learning on a • A. M. Arias Correa, “NAVEGACIÓN
Omnidirectional Mobile Robot,” no. 1, DE ROBOT MÓVIL EN INTERIORES
Universit at Dortmund, pp. 1–6. UTILIZANDO FLUJO ÓPTICO A PARTIR
• O. Purwin and R. D’Andrea, “Trajectory DE IMÁGENES PANORÁMICAS,”
generation and control for four Universidad nacional de Colombia,
wheeled omnidirectional vehicles,” 2009.
Rob. Auton. Syst., vol. 54, no. 1, pp. 13– • H. D. Young and R. A. Freedman, Física
22, Jan. 2006. universitaria, Volumen 1, Decimosegu.
• J. Beristain López and P. D. Espinos México: PEARSON EDUCACIÓN, 2009.
Vázquez, “Sistema de Control para • R. A. Serway and J. W. Jewett Jr., Física
Motores a pasos tipo Unipolar,” para ciencias e ingeniería, Volumen 1,
INSTITUTO POLITÉCNICO NACIONAL, Séptima ed. 2008.
2010. • R. Resnick, D. Halliday, and K. S.
• N. R. Cardenas Calle and G. R. Simbaña Krane, Física Vol.1, Cuarta edi. México:
Quinde, “DISEÑO Y CONSTRUCCIÓN Compañia editorial continental, 2001,
DE UN ROBOT MÓVIL DEDÁCTICO p. 653.
PARA ESTUDIOS EXPERIMENTALES DE • “http://www.princeton.edu/~achaney/
ROBÓTICA COOPERATIVA,” Universidad tmve/wiki100k/docs/Walking.html.” .
Politécnica Salesiana, 2007. • Simulink, Getting Started Guide, R2014a
• J. M. Villadangos Carrizo, “Contribución ed. 2014.
al diseño de un LPS ultrasónico de • “http://www.superdroidrobots.com/
amplia cobertura empleando técnicas shop/category.aspx/gear-motors/7/.” .
de codificación,” Universidad de Alcalá, • Http://www.robotshop.com/media/
2012. files/pdf/datasheet-2111.pdf, “Using
• J. A. Cuenca Retana, “SISTEMA DE the Regulator,” pp. 1–4.
POSICIONAMIENTO EN EINTERIORES • “ h t t p : // w w w . r o b o t s h o p . c o m /
MEDIANTE BALIZAS BLUETOOTH,” m e d i a / f i l e s /p d f/u s e r- g u i d e -
UNIVERSIDAD PONTIFICIA COMILLAS. sabertooth-2-12.pdf.” .
• J. R. Fontana Oneto, “SISTEMA DE
POSICIONAMIENTO 3-D PARA
ESPACIOS INTERIORES BASADO EN
INFRARROJOS,” Universidad autónoma

30 / 31

Você também pode gostar