Professional Documents
Culture Documents
Resumen—El presente artı́culo muestra la forma de obtener Los RMRs no omnidireccionales se enmarcan en el área
los modelos cinemáticos y dinámicos de un robot móvil omnidi- de sistemas no-holonómicos, los cuales se caracterizan por
reccional. El robot móvil a analizar pertenece a la empresa Nexus estar sujetos a restricciones no integrables en las velocida-
modelo RB011, el cuál cuenta con cuatro ruedas suecas en una
configuración rectangular. Para el modelo cinemático se realiza el des; es decir, su plano de velocidades está restringido. Los
análisis desde la obtención de las restricciones de movimiento de problemas de control más importantes son los asociados al
cada rueda. Para el modelo dinámico se emplea la formulación posicionamiento, regulación o estabilización, seguimiento de
de Lagrange para obtener la dinámica de la parte mecánica. Al trayectorias y evasión de obstáculos.
modelo dinámico, se le agrega la etapa de actuación considerando En el área de control, para los RMRs algunos controles
motores de corriente directa con inductacia despreciable.
se diseñan considerando únicamente la cinemática del robot
y en otros casos un modelo dinámico, el cual tiene como
I. I NTRODUCCI ÓN entrada los torques aplicados en cada rueda. En [1] se presenta
un método para obtener la dinámica de cualquier RMR que
Un Robot Móvil con Ruedas (RMR) es un vehı́culo terrestre cumpla con ciertas condiciones, se emplea la formulación
equipado con ruedas que tiene la capacidad de realizar movi- Lagrangiana junto con los multiplicadores de Lagrange para
mientos autónomos (sin interacción humana), porque está dis- considerar las restricciones no holonómicas. En [3] se realiza
puesto con motores que son controlados por una computadora un análisis de las propiedades holonómicas de distintos RMRs.
a bordo [1]. Para realizar el modelado del RMR se supone que En [4] se presenta la validación del modelo cinemático del
los componentes que conforman al robot son rı́gidos (incluidas RMR Rovio. En [5] se detalla el modelo cinemático de un
las ruedas),y que éste se mueve en un plano horizontal. RMR omnidireccional de 4 ruedas tambien con validación
En [2], se menciona que un RMR está conformado por experimental. En [6] se diseña un control considerando los
tres subsistemas (véase Figura 1): Arreglo cinemático, el cual torques aplicados en cada rueda como la entrada del modelo
se genera de las configuraciones relativas a la disposición de dinámico.
las ruedas en la estructura del robot. Los principales arreglos El presente trabajo describe la obtención del modelo dinámi-
son: sı́ncrono, triciclo, Ackerman, diferencial, omnidireccional co de un RMR omnidireccional, tomándose en consideración
y skid steer; Sistema de actuadores, los cuales permiten el la dinámica de los actuadores. El robot analizado es de
movimiento de la estructura cinemática, siendo en la mayorı́a la empresa Nexus modelo RB011. Este robot cuenta con
de los casos un sistema de motores de Corriente Directa (CD); cuatro ruedas suecas de ±45◦ , conocidas también como ruedas
Convertidor de potencia, que permite el accionamiento de los Mecanum, colocadas en un chasis rectangular. Para mover las
actuadores. ruedas se cuenta con un motor de corriente directa en cada
una. Este robot es de bajo costo y es únicamente para fines
académicos.
El documento está conformado en cuatro secciones. La
sección II contiene la forma en como se describe la postura del
robot, los pasos para obtener las restricciones de movimiento
de las ruedas suecas y como obtener el modelo cinemático
del robot. En la sección III se presenta la determinación del
modelo dinámico de la parte mecanica del robot, y posterior-
Figura 1. Subsistemas de un robot móvil mente al modelo se le agrega la dinámica de los actuadores
R
Rw (θ)[T ]ξ + E ⊤ [T ]ϕ = E ⊤ τϕ , (26)
con
d ∂T ∂T
[T ]ψ = − y (27)
dt ∂ ψ̇ ∂ψ
⊤
τϕ = τϕ1 τϕ2 τϕ3 τϕ4 , (28)
donde T es la suma de las energı́as cinéticas del robot y τϕi
es el torque aplicado en la rueda i. Sean mR la masa total del
robot (chasis y ruedas), IRz la inercia total del robot (chasis y
ruedas), e Iϕy la inercia de las ruedas en el eje de giro. Para
Figura 5. Parámetros de las ruedas
un robot móvil omnidireccional T puede ser expresada de la
El modelo cinemático de postura para un robot omnidirec- siguiente manera:
cional está dado por la ecuación
R R
w
ξ̇ = RR (θ) η (19) T = ξ̇ ⊤ (Rw (θ))⊤ M Rw (θ)ξ̇ + ϕ̇⊤ Iϕ ϕ̇ (29)
III-B. Dinámica de los motores donde v1 , v2 , v3 , v4 son los voltajes aplicados a los motores
Para analizar la dinámica del motor se considera un motor de las llantas 1, 2, 3 y 4 respectivamente.
de corriente continua con inductancia despreciable en cada una Para obtener el modelo dinámico del robot tomando en
de las ruedas. El diagrama del motor se presenta en la Figura cuenta la dinámica del motor se realiza el siguiente proce-
6. Las ecuaciones que describen el comportamiento del motor dimiento.Sustituyendo ϕ̇ y ϕ̈ por sus equivalencias en η y η̇,
fueron obtenidas de [8]. Sea v el voltaje de armadura del motor respectivamente (ecuaciones (20) y (44)) obtenemos
([V]), ia es la corriente en el motor ([A]), Ra es la resistencia ka 1
de armadura ([Ω]), ka la constante de torque ( Nm A
]), kb la Jm re E η̇ = (u − kb re Eη) − f¯m − τϕ (58)
V-s Ra re
constante de fuerza contraelectromotriz ( rad ), Jm la inercia
de la flecha ([Kg m2 ]), fm (qm ) la fricción en el eje del motor Enseguida se sustituye la ecuación (45) en (58) y despejando
en [Nm], re es la relación de reduccion de engranes, ϕi es el el término que multiplica a u se llega a:
angulo en la rueda i ([rad]) y τϕi es el torque en la rueda i ka ⊤
E u = M̄v η̇ + C̄v η + E ⊤ f¯m (59)
([Nm]). Las ecuaciones que describen el comportamiento del Ra
motor son donde
1
M̄v = J m re E ⊤ E + M̄
v = i a Ra + e b (48) re
eb = q̇mi kb (49) ka 1
C̄v = kb re E ⊤ E + C̄.
q̇mi = re ϕ̇i (50) Ra re
τm = ia ka (51) La ecuación (59) represente el modelo dinámico del robot
τϕi considerando tanto los parámetros del robot como los paráme-
Jm q̈mi = τm − fm (q̇mi ) − (52) tros del motor.
re
q̈mi = re ϕ̈i (53) IV. VALIDACI ÓN DEL MODELO
Para validar el modelo y los parámetros obtenidos, se
realizaron dos experimentos. El primer experimento fue para
observar el desplazamiento lineal y el segundo para observar
el desplazamiento rotacional. Ambos experimentos se reali-
zaron sobre una base de fomi, con la finalidad de eliminar
el deslizamiento que existe en las ruedas. Para captar los
movimientos del robot, se utilizó una cámara fijada en el
techo del laboratorio cuyos parámetros son conocidos. Los
parámetros que se utilizaron para realizar las simulaciones se
Figura 6. Diagrama de un motor de corriente directa muestran en la Tabla II.
Para el primer experimento se aplicó un voltaje constante
Despejando ia de (48) y sustituyendo (50) se tiene de 6.5 volts a las ruedas 1 y 4, y un voltaje de 6.6 a las
Velocidad rotacional
Inercia de las ruedas 4,2 × 10−3 Kg m2 −20
−30
Resistencia de armadura 1,9 Ω −40
−70
Reducción de engranes 64 : 1
Radio de la rueda 0,05 m Figura 8. Gráfica de velocidad lineal rotacional por el robot en simulación y
Distancia l1 0,1524 m en experimentación.
Distancia l2 0,1505 m
Tabla II
PAR ÁMETROS CINEM ÁTICOS Y DIN ÁMICOS DEL ROBOT N EXUS
V. C ONCLUSIONES
En este trabajo se presentó el desarrollo para obtener el
modelo dinámico de un robot omnidireccional con cuatro
ruedas 2 y 3, la duración del experimento fue de 6 segundos. ruedas mecanum, dispuestas en un chasis rectangular. Para
En la Figura 7, se muestra la velocidad lineal alcanzada tanto obtener el modelo se consideró el movimiento en un plano, con
en simulación como en experimentación. La gráfica muestra partes del robot rigı́das y sin fricción en el punto de contacto de
en el eje de las abscisas el tiempo ([s]) y en el eje de las las ruedas con el piso. Como contribución al modelo dinámico,
ordenadas la velocidad lineal ([ ms ]). La curva de color azul se consideró tomar en cuenta la dinámica de los motores. Esto
representa la velocidad alcanzada por el robot durante el ex- es una variación a los modelos que se acostumbran usar. En
perimento y la curva de color verde es la velocidad alcanzada este caso la señal de entrada del modelo del robot son los
en la simulacı́ón. El ruido que se presenta en la curva del voltajes de armadura de cada motor, mientras que lo común
experimento, es debido a las perturbaciones existentes en las es que la señal de entrada sean los torques aplicados en cada
imágenes obtenidas por la cámara. La velocidad alcanzada en rueda.
experimentación oscila alrededor de los 0,25 ms , mientras
m Si se desprecia la fricción en los motores, el modelo no
que la velocidad alcanzada simulación es de 0,35 s . El
men dependerı́a de la velocidad a la que giran los motores. Siendo
error obtenido es de 0,1 s . posible diseñar una ley de control sin el uso de encoders, pero
siendo necesario otro sensor para cerrar el lazo de control.
0.4
Experimento
Algunos de los sensores que pueden usarse podrı́an ser una
0.35 Simulación
0.3
cámara o una Laser Ranger Finder para medir la posición y
Velocidad lineal
0.15
0.1
AGRADECIMIENTOS
0.05
0
Este proyecto ha sido parcialmente financiado por los pro-
0 1 2 3 4 5 6 7
Tiempo yectos TNM, PRODEP y CONACYT 134534.
Figura 7. Gráfica de velocidad lineal alcanzada por el robot en simulación y R EFERENCIAS
en experimentación.
[1] G. Campion, G. Bastin, and B. D’Andréa-Novel, “Structural Properties
and Classification of Kinematic and Dynamic Models of Wheeled Mobile
Para el segundo experimento se aplicó un voltaje de 6.5 Robots,” IEEE Transactions on Robotics and Automation, vol. 12, no. 1,
volts para los motores 1 y 4, y un voltaje de -6.6 volts para pp. 47–62, 1996.
los motores 2 y 3, la duración del experimento es de 15 [2] R. S. Ortigoza, M. M. Aranda, G. S. Ortigoza, V. M. H. Guzmán,
M. A. M. Vilchis, G. S. González, J. C. H. Lozada, and M. O. Carbajal,
segundos. En la Figura 8, se muestra la velocidad rotacional “Wheeled Mobile Robots : A Review,” vol. 10, no. 6, pp. 2209–2217,
alcanzada tanto en simulación como en experimentación. La 2012.
gráfica muestra en el eje de las abscisas el tiempo [3] J. Batlle and a. Barjau, “Holonomy in mobile robots,” Robotics and
h ([s])i y en Autonomous Systems, vol. 57, pp. 433–440, Apr. 2009.
el eje de las ordenadas la velocidad rotacional ( gradoss ). Los [4] E. Bugarin and A. Gutierrez, “Modelado Cinemático de un Robot Móvil
datos experimentales muestran hque la ivelocidad rotacional se Omnidireccional no Estándar,” in Congreso Latinoamericano de Control
Automático, (Lima, Perú), 2009.
mantiene alrededor de los 40 grados s , y la simulaciones se [5] E. Bugarin, A. Aguilar-Bustos, and O. A. Borrego-Ramirez, “Validación
h
grados
i h i Experimental del Modelo Cinemático de un Robot Móvil Omnidireccio-
mantiene en 72 s . El error obtenido es de 32 grados
s . nal de 4 Ruedas,” in Congreso Internacional de Robótica y Computación,
En ambos experimentos se observa que el error es con- pp. 24–29, 2013.
[6] D. Devon and T. Bretl, “Kinematic and Dynamic Control of a Wheeled
siderablemente grande, esto se debe a muchos factores que Mobile Robot,” in IEEE/RSJ International Conference on Intelligent
se desestimaron. Algunos de estos pueden ser la fricción de Robots and Systems, (San Diego, California), pp. 4065–4070, 2007.
la rueda con el piso y la dinámica de la etapa de potencia. [7] F. P. Beer, E. R. J. Johnston, and E. R. Eisenberg, Mecánica Vectorial
para Ingenierios: Dinámica. McGraw-Hill Interamericana, 2007.
Sin embargo esta información es importante, ya que en las [8] R. Kelly and V. Santibáñez, Control de movimiento de robots manipula-
actividades posteriores servirán como punto de referencia para dores. Pearson Prentice Hall, 2003.
la prueba de controladores.