ANÁLISIS ESTRUCTURAL, CINEMÁTICO Y DINÁMICO DE UN ROBOT MÓVIL EXPERIMENTAL
Hugo G. González Hernández, Bernardo Tame Rivera y Eduardo R. Mondragón Parra
Laboratorio del Centro de Investigación,Universidad La Salle
RESUMEN
En el presente trabajo se muestra un análisis detallado de la dinámica de un robot móvil. Se presenta primeramente un análisis estructural y, posteriormente, el análisis cinemático y dinámico del sistema, por último se muestran algunas simulaciones del comportamiento dinámico. El robot consta de dos motores: uno de tracción y otro de dirección. El robot puede moverse en cualquier dirección en el plano horizontal.
ABSTRACT
The current paper shows a detailed analysis of an experimental mobile robot dynamics. First, an structural ana lysis and then a kinematics and dynam\cs analysis are shown, finally we show sorne simulations of its dynamical behavior. The robot has two de motors: a traction motor and a direction motor. The robot can move in any direction on the horizontal plane.
INTRODUCCIÓN
Un robot móvil omnidireccional permite el seguimiento (1) de diferentes tipos de trayectorias de manera fidedigna. En el presente trabajo se muestra un análisis detallado del comportamiento estructural, cinemático y dinámico de un robot móvil omnidireccional. El robot que se analiza es el segundo prototipo de la serie RoMEO (Robot móvil experimental ominidireccional).
ANÁLISIS ESTRUCTURAL
En la Fig. 1 se muestran dos de las zonas más representativas del análisis estructura!.
Análisis de la Zona 1.
Este análisis resulta ser bastante sencillo, ya que se considera la carga aplicada al poste como axial, además de estática (2).
La carga total de los tres postes se muestra en la tabla 1.
Figura 1.Estructura de mini-RoMEO.
433
Tabla 1.Carga total.
Elemento |
Masa en Q |
Base |
380 |
Tomillos |
(3)(6) = 18 |
Motor |
170.5 |
Circuito |
100 |
Total |
668.5 |
La carga total es de 6.558N. La carga de un solo poste es (por simetría): Wposte = 2.186 N. El área del poste es:
Aposte = 0.25p(O.D115 m)2 ::: 1.039E - 04 m2
los valores de resistencia del aluminio comercial son:
l 1105MPa 1 41]>Pa l 12 Pa 1 48sMa
calculando el esfuerzo de trabajo y
comparándolo con el esfuerzo de fluencia:
St = 2.166N/1.039 E-04 m'= 21.04 kPa
de tal forma que la estructura es suficientemente robusta.
Anál i sis de la Zona 2 .
Para este análisis se considera la sección mostrada en la Fig 2.
Las cargas de 1.093 N son de los postes, mientras que la reacción de 2.186 N es del
rodamiento. Para considerar esta parte en equilibrio estático es necesario considerar un momento en sentido contrario al generado por las dos cargas de 1.093 N. Las distancias de aplicación de fuerzas se obtuvieron mediante el modelo representado en la Fig 3.
Para r = 0.09 m y ang = p/6: conociendo
Y = ((0.09)(6)sen(p/6))/p Y = 0.0859 m;
r-Y = 4.056E-03 m;
X = 0.005 m; 2X ::: 0.01 rn.
ong y
l
( - y
Figura 3. Distancias de aplicación de
fuerzas.
Con estas distancias conocidas podemos obtener los diagramas de esfuerzos cortantes y momentos, los cuales se muestran en la Fig 4.
V
11
Figura 2.Cargas actuantes en la zona 2.
-5.46Sí-03 N-m
Figura 4. Diagramas de esfuerzos cortantes y momentos.
434
El esfuerzo normal es:
|
cr = - -102.47 kPa
1
s = -102.47kPa
ls1I "' (y 1)(r) = Jx + Y
S1COS01= X1
s1sene ,= Y1
donde O :5: q1 < 360° y -a < g 1 < a
(Ec. 1)
(Ec. 2)
(Ec. 3)
< ..: ,).
El esfuerzo cortante es:
De las ecuaciones (1), (2) y (3) se obtiene:
'tmáx = T/Q; Q = bh2/(3+1.8(h/b))
Tmax = 46.55 kPa
x, =(y 1J(r)cose 1
y 1 = (y 1)(r)sen01
(Ec. 4)
(Ec. 5)
Analizando mediante el círculo de Mohr encontramos.
S1 = 46.55 kPa + 102.47 kPa/2 = 97.785 kPa
ANÁLISIS CINEMÁTICO
En el caso del análisis cinemático directo tenemos como variables independientes a e
donde (4) y (5) son las ecuaciones de la
cinemática directa.
La ecuaciones de cinemática inversa son:
(Ec. 6)
{Ec. 7)
El caso general para encontrar la ubicación del centroide del robot:
(ángulo del motor de dirección) y y {ángulo del motor de tracción). Como variables dependientes a x , y . Como parámetro a r.
Xn.1 = Xn + (fo..1 - Y11)(r)cos{0n)
Yn.1 = Yn + (Yn .1 - r)(r)sen(0n)
(Ec. 8)
(Ec. 9)
1 1
Véase la Fig 5.
|
Se considera que no hay deslizamientos y que inicialmente el eje de la rueda está alineado con el eje X.
)( 1
Figura 5. Esquema cinemático.
para un punto Pn. n = 1,2,3,...
ANÁLISIS DINÁMICO
Se considera que el centro de masa está sobre el vástago, el robot requiere balanceo para cumplir esta consideración. Véase la Fig 6.
r
01
r p
Figura 6. Diagrama de cuerpo libre.
435
Por suma de fuerzas P = 3F
por suma de momentos
por lo que
Lo anterior se cumple, apoyado en un análisis geométrico. En a,, a , a , hay una
Se consideraron las variables y parámetros de la Tabla 2:
Tabla 2. Variables y parámetros
2 3
misma fuerza de fricción F, dado que el peso
es distribuido entre los tres apoyos de manera uniforme. Además. son rodamientos del mismo tipo. Véase la Fig 7.
Las ecuaciones de Lagrange son:
y (Ec. 10)
(Ec. 11)
y
La energía potencial es nula. La energía cinética es:
X T = 1 .v2-- + 1 a·2 + 1 ·i2
(Ec. 12)
-M -1
-'-
Figura 7.Esquema dinámico.
con
2 2 1 2 71
Véase además la Fig 8.
V
Figura 8. Rueda de tracción.
v =(rJ(r) (Ec. 13)
el Lagrangiano será
Consideramos la función de disipación de Rayleigh:
(Ec. 15)
De tal forma que las ecuaciones de movimiento del sistema son:
Tenemos como coordenadas generalizadas (3): q = [O y]
110 + b1é = Ti
(Mr2 + r2 r;+(b2 + b3r2}1 = T2
(Ec. 16)
(Ec. 17)
436
|
o -bi o o 1)
Para el motor de tracción se utilizó un torque constante y el comportamiento del angulo y (de tracción) que se muestra en la Fig. 11.
[ ]" 1,
o '•]
o o o 1 o o '2
o
|
+b:,r2 1 .
para:
Mfi +12
XA o Mr2
""1
:[ _/
SIMULACIONES
La dinámica del sistema fue simulada mediante el programa SimnonrM. Se utilizó una señal de torque como la mostrada en la figura 9 para el motor de dírección.
...
º"
? t s 1 10 '2 u 1e n
Figura 11.Ángulo y
La trayectoria resultante está dada por la combinación de las ecuaciones 8, 9, 16 y 17. Graficando en forma paramétrica 8 y 9 se obtiene la trayectoria del robot en el plano (Fig. 12)
---
-11)0
·•60
... º' •.e ' o " 1.1
Figura 9. Torque 1apl cado (detalle)
En la figura 1O se puede observar el comportamiento del ángulo e (ángulo de
dirección) con respecto al tiempo ante esta señal.
Figura 12. Trayectoria del robot en el plano
CONCLUSIONES
181
"
|
• í
/
|
'
i -, • to 1l lA " it z;,
Figura 10. Ángulo O.
La planeación de movimiento en Robótica es un área en la que intervienen conceptos de control. modelado de sistemas y algunas veces de topología. En este trabajo se muestra el análisis de movimiento de un robot móvil omnidireccional, este es un primer acercamiento hacia la planeación del movimiento.
Los resultados hasta el momento son simulados. se está trabajando en la validación experimental del modelo matemático. Una vez
437
validado el modelo procederemos con el control.
Debido a que el modelo matemático es lineal, no se presentan comportamientos dinámicos complicados en la simulación (4 ).
REFERENCIAS
1. Mondragón-Parra, E.R .; Tame-Rivera , 8.; González-Hernández, H. G. (1996) Robot Móvil Omnidireccional Controlado por PC Remota para Seguimiento de Trayectorías Libres de Obstáculos. Memorias del 6to. Congreso Internacional de Electrónica, Comunicaciones y Computadoras. Cholula, Puebla.
2. Kimbrelt, J. (1991) Kínematícs Ana/ysís and
Synthesis. McGraw-Hill. Singapore .
3. Marion, J. B. (1965), Classical Dynamics.
Academic Press, N.Y.
4. Woernle, c. (1995) Nontinear Motion Control of a Nonholonomic Mobile Platform by Exact Linearization. Proceedings of
IFTOMM 95'. Milano, ltaly.