Академический Документы
Профессиональный Документы
Культура Документы
Leonardo Enrique Solaque* , Diego Alejandro Patio , Jhonnatan Eduardo Zamudio y Maria Ines Jaramillo
*
Facultad de Ingeniera Mectronica
Universidad Militar Nueva Granada, Bogot D.C, Colombia
Leonardo.solaque@unimilitar.edu.co
Facultad de Ingeniera Electrnica
Pontificia Universidad Javeriana, Bogot D.C, Colombia
patino-d@javeriana.edu.co
Facultad de Ingeniera Mectronica
Universidad Militar Nueva Granada, Bogot D.C, Colombia
u1801632@unimilitar.edu.co
Facultad de Ingeniera Mectronica
Universidad Militar Nueva Granada, Bogot D.C, Colombia
u1802282@unimilitar.edu.co
AbstractEl presente artculo describe el modelo matemtico method, which allows to obtain the composite by forces and
de la suspensin de un robot de traccin tipo oruga, con el torques acting on the robot in motion differential equations. The
propsito de estudiar el comportamiento dinmico del robot robot in question, has an additional degree of freedom since
cuyo objetivo principal es reducir las vibraciones mecnicas the tracks are not fixed to 90 degrees, but may have a different
producidas por el accionamiento de los motores y la superacin angle of opening.As a result of analysis and mathematical model,
de obstculos presentes en una trayectoria. El anlisis en the elasticity and damping constants are set, adjusted so that the
referencia, cobra relevancia en la medida que las vibraciones system acquires a response such that the sprung mass has a minor
mecnicas generan daos a la estructura y elementos electrnicos impact on the vibrations generated in the distance covered.
presentes en esta cuando se alcanza la frecuencia natural de
ellos. La obtencin del modelo matemtico de la suspensin que Index TermsDynamic model, Newton-Euler, mechanical vi-
representa el comportamiento dinmico del sistema se basa en el bration, path, natural frequency, damping.
mtodo de Newton-Euler, el cual permite obtener las ecuaciones
diferenciales compuestas por fuerzas y torques que actan
sobre el robot en movimiento. El robot en cuestin, cuenta con I. I NTRODUCCIN
un grado de libertad adicional puesto que las orugas no se
encuentran fijas a 90 grados, sino que pueden tener un ngulo
de apertura diferente. Como resultado del anlisis y modelo Actualmente el desarrollo de sistemas robticos se
matemtico, se establecen las constantes de amortiguamiento encuentra en su apogeo, debido a que facilitan la forma
y elasticidad, ajustadas para que el sistema adquiera una de vida y trabajo, estos desempean distintas labores
respuesta, tal que la masa suspendida tenga un menor impacto dependiendo de su estructura mecnica, por ello los robots
en cuanto a las vibraciones generadas en el trayecto recorrido. manipuladores se consideran de tipo industrial, sin embargo
durante los aos ochenta y noventa se dio relevancia a la
Palabras ClavesModelo dinmico, Newton-Euler, vibraciones robtica mvil, que a diferencia de los manipuladores no
mecnicas, trayectoria, frecuencia natural, amortiguamiento.
poseen un rango limitado de movimiento.[1]
AbstractThis paper describes the mathematical model of the
suspension of a caterpillar type traction robot, in order to study Los robots se caracterizan segn su estructura mecnica:
the dynamic behavior of the robot whose main objective is to Manipuladores y Mviles, los robots mviles poseen una base
reduce the mechanical vibrations produced by the engine drive que les permite desplazarse a travs de diferentes sistemas
and overcoming obstacles in a path. The analysis in reference de locomocin. Existen diversos tipos de configuraciones
becomes relevant to the extent that the mechanical vibrations para los robots mviles como: Ackerman, Triciclo Clsico,
generated damage to the structure and electronic elements in
this when the natural frequency of them is reached. Direccionamiento Diferencial, Skid Steer, Sncronas y Pistas
Obtaining the mathematical model that represents the dynamic de Deslizamiento (Traccin Tipo Oruga).[2], [3]
suspension system performance is based on the Newton-Euler
2
Los vehculos de traccin tipo oruga tienen una mayor utiliza el mtodo de Newton-Euler, representado mediante las
su superficie de contacto respecto a las configuraciones ecuaciones diferenciales del sistema. Para resolver el sistema
mencionadas, por lo cual requiere un diferente de ecuaciones se emple la transformada de Laplace, dando
direccionamiento denominado deslizamiento/derrape que como resultado la funcin de transferencia del sistema de
ofrece una ventaja en terrenos irregulares y una desventaja suspensin del robot. El sistema presenta no linealidades
respecto al cambio de posicin que depende directamente de que dificultan el proceso de modelado, por lo cual existen
la friccin del material con el cual las orugas se encuentran mltiples aproximaciones lineales que logran representar el
en contacto.[4] sistema, entre estas se encuentra el modelo de suspensin de
cuarto de carro, medio carro y carro completo.[10]
Cualquier sistema mvil que precise de un desplazamiento en
terreno irregular debe tener mecanismos de suspensin, que El modelo de cuarto de carro es simplificado porque
permitan mantener el contacto entra las ruedas y el suelo para cuenta con dos grados de libertad, que permite determinar
evitar perder la estabilidad del robot. Los mecanismos de la posicin del chasis respecto a tierra y el desplazamiento
suspensin protegen la estructura y los circuitos electrnicos de la llanta, existe un modelo de cuatro grados de libertad
presentes en el sistema al reducir las vibraciones mecnicas. denominado medio carro, porque involucra el ngulo de
Existen diversas fuentes de excitacin que generan las inclinacin (pitch) y cambios de altura, sin embargo existe
vibraciones mecnicas, algunas son ajenas al robot al un modelo que contempla los siete grados de libertad que
originarse a causa de las irregularidades del terreno y otras tiene los ngulos de rotacin pitch y roll, la altura de la
son propias del robot al producirse en los elementos rotativos masa suspendida y la altura de las 4 masas no suspendidas,
como el motor.[5], [6] conocido como modelo de carro completo.[11], [12], [13]
F Kz = F Kcos
F Bz = F Bcos
F K0 z = F K0 cos
P1 z = P1 cos
F Kz + F Bz F K0 W = mo Z1
Bcos Kcos + K0 cos
Figura 1. Esquema paramtrico robot de traccin tipo oruga Z1(t) + Z1(t) + Z1 (t) =
mo mo
Bcos Kcos K0 (cos)2
Zs(t) +
El cuadro I muestra cada una de las nomenclaturas utilizadas mo mo
Zs (t) +
mo
p1 (t) g (1)
en el sistema.
Nomenclatura Significado
K Rigidez del muelle
2) Anlisis en Z para el punto 2:
B Viscosidad del amortiguador
Bcos Kcos + K0 cos
ms Masa suspendida Z2(t) + Z2(t) + Z2 (t) =
mo mo
mo Masa no suspendida
Zs Desplazamiento vertical de la masa suspendida Bcos Kcos K0 (cos)2
Zs(t) + Zs (t) + p2 (t) g (2)
YS Desplazamiento lateral de la masa suspendida mo mo mo
Z1 Desplazamiento vertical masa no suspendida, punto de referencia 1
Z2 Desplazamiento vertical masa no suspendida, punto de referencia 2
Z3 Desplazamiento vertical masa no suspendida, punto de referencia 3
Z4 Desplazamiento vertical masa no suspendida, punto de referencia 4 3) Anlisis en Z para el punto 3:
Y1 Desplazamiento lateral masa no suspendida, punto de referencia 1
Y2 Desplazamiento lateral masa no suspendida, punto de referencia 2 Bcos Kcos + K0 cos
Z3(t) + Z3(t) + Z3 (t) =
Y3 Desplazamiento lateral masa no suspendida, punto de referencia 3 mo mo
Y4 Desplazamiento lateral masa no suspendida, punto de referencia 4
Bcos Kcos K0 (cos) 2
P1 Desplazamiento por trayectoria, seal de entrada 1 Zs(t) + Zs (t) + p3 (t) g (3)
mo mo mo
P2 Desplazamiento por trayectoria, seal de entrada 2
P3 Desplazamiento por trayectoria, seal de entrada 3
P4 Desplazamiento por trayectoria, seal de entrada 4
ngulo de rotacin pitch
ngulo de rotacin roll
4) Anlisis en Z para el punto 4:
I Momento de inercia respecto al eje Y
Bcos Kcos + K0 cos
I Momento de inercia respecto al eje X Z4(t) + Z4(t) + Z4 (t) =
mo mo
Velocidad del robot
D Distancia entre el centroide y las orugas
2
Bcos Kcos K0 (cos)
Zs(t) + Zs (t) + p4 (t) g (4)
R Distancia entre el centroide y los ejes mo mo mo
v Velocidad de la oruga
Cuadro I
N OMENCLATURA DE ESQUEMA
F Iz = F K1 z + F B1 z + F K3 z + F B3 z
Para el anlisis en Z se tiene en cuenta cada punto de
Fuerzas actuantes en el lado derecho:
referencia (1,2,3,4) (Figura 1), teniendo en cuenta el angulo
F Dz = F2 z + F4 z
de inclinacin producido por la apertura de las orugas. Una
vez realizado el esquema se obtienes las ecuaciones que F Dz = F K2 z + F B2 z + F K4 z + F B4 z
4
Las constantes de rigidez y viscosidad son las mismas para 4) Anlisis en Z para el punto 4:
cada uno de los puntos de referencia:
Bsen Ksen + K0 sen
K1 = K2 = K3 = K4 = K Y4(t) + Y4(t) + Y4 (t) =
mo mo
B1 = B2 = B3 = B4 = B
Bsen Ksen
Realizando la sumatoria de fuerzas: Ys(t) +
2
Ys (t) + K0 (sen) p4 (t) (9)
mo mo
X
F z = ms Zs(t)
F Iz F Dz ms g = ms Zs(t)
D. Anlisis respecto al eje lateral Y (masa suspendida)
4Bcos 4Kcos
Zs(t) + Zs(t) + Zs (t) =
ms ms
Se realiza un anlisis en el eje lateral teniendo en cuenta las
Bcos
Kcos
Bcos
Kcos
fuerzas que actan sobre la masa suspendida. Las siguientes
Z1(t) + Z1 (t) + Z2(t) + Z2 (t)+
ms ms ms ms ecuaciones representan las fuerzas actuantes respecto a los 4
puntos de referencia:
Bcos Kcos Bcos Kcos
ms
Z3(t)+
ms
Z3 (t)+
ms
Z4(t)+
ms
Z4 (t)g (5) Fuerzas actuantes en el lado izquierdo:
F Iy = F1 y + F3 y
F Iy = F K1 y + F B1 y + F K3 y + F B3 y
C. Anlisis respecto al eje lateral Y (masa no suspendida)
Fuerzas actuantes en el lado derecho:
Para el anlisis en Y se tiene en cuenta la diferencia del
sentido de las fuerzas actuantes entre los puntos pares e F Dy = F2 y + F4 y
impares.
F Ky = F Ksen F Dy = F K2 y + F B2 y + F K4 y + F B4 y
P1 y = P1 sen
B1 = B2 = B3 = B4 = B
F Iy + F Dy = ms Ys(t)
Bsen Ksen + K0 sen
Y1(t) + Y1(t) + Y1 (t) =
mo mo
Bsen Ksen 2 4Bsen 4Ksen
Ys(t) + Ys (t) + K0 (sen) p1 (t) (6) Ys(t) + Ys(t) + Ys (t) =
mo mo ms ms
Bsen Ksen Bsen Ksen
Y1(t) + Y1 (t) + Y2(t) + Y2 (t)+
2) Anlisis en Y para el punto 2: ms ms ms ms
Bsen Ksen + K0 sen
Y2(t) + Y2(t) + Y2 (t) =
mo mo Bsen Ksen Bsen Ksen
Y3(t) + Y3 (t) + Y4(t) + Y4 (t) (10)
ms ms ms ms
Bsen Ksen 2
Ys(t) + Ys (t) + K0 (sen) p2 (t) (7)
mo mo
1) Anlisis Pitch : I es el momento de inercia generado 2) Anlisis Roll: I es el momento de inercia generado
respecto al eje Y respecto al eje X
2 2
I = 4BR (cos) 4KR (cos) BR (cos) Z1
Zs4 = Zs + Dr + Rr
Y s3 = Ys Dr
A. Simulacin respecto al eje vertical Z
Y s4 = Ys Dr
Figura 7. Simulacin en el eje vertical Y, caso III Figura 9. Simulacin ngulo de rotacin roll (caso I)
estos obstaculos, se presentan fuerzas de igual magnitud y [4] R. Siegwart, I. R. Nourbakhsh, and D. Scaramuzza, Introduction to
direccin, con sentido opuesto que al cancelarse entre si solo autonomous mobile robots. MIT press, 2011.
[5] S.-g. Roh, B. Lim, H. Moon, J.-S. Lee, J. H. Park, J. C. Koo, and H. R.
producen una seal sobreamortiguada que se estabiliza a la Choi, Flexible suspension mechanism for stable driving of a differential
misma altura que los anteriores casos. drive mobile robot, in Intelligent Robots and Systems (IROS), 2013
IEEE/RSJ International Conference on. IEEE, 2013, pp. 55185523.
[6] P. L. Rodrguez, D. . Mntaras, and C. Vera, Ingeniera del automvil:
B. Anlisis respecto al eje lateral Y sistemas y comportamiento dinmico. Editorial Paraninfo, 2004.
[7] J. Campos, L. Davis, F. Lewis, S. Ikenaga, S. Scully, and M. Evans,
Active suspension control of ground vehicle heave and pitch motions,
in Proceedings of the 7th Mediterranen Conference on Control and
1) Caso I: Debido a que existe un angulo de inclinacin Automation. Citeseer, 1999, pp. 222233.
presente en la apertura de las orugas, se produce un movi- [8] M. Krger, K. Popp, L. Panning, and W. Schiehlen, Ground vehicle
miento lateral sobre la masa suspendida. En el primer caso dynamics. Springer, 2010.
[9] K. Ogata, Ingeniera de control moderna. Pearson Educacin, 2003.
se considera un obstculo de 10 centmetros en los puntos 1 [10] C. A. D. Martnez, Desarrollo de un modelo dinmico integral de
y 2, en la figura 5 se puede observar en estado transitorio la un vehculo todo terreno con 6 subsistemas, su validacin y estudio
seal Ys con una respuesta subamortiguada que presenta un de maniobrabilidad y confort, Masters thesis, Instituto Politcnico
Nacional, 2012.
overshoot menor en comparacin con las seales Y1 y Y3 [11] N. Arzola and G. Rojas, Anlisis del comportamiento dinmico de un
correspondientes a la oruga, en rgimen permanente la seal vehculo con suspensin independiente tipo paralelogramo deformable y
Ys llega a cero indicando que el movimiento lateral del robot barras de estabilidad transversal, Revista Facultad de Ingeniera, no. 67,
pp. 112125, 2013.
ha terminado. [12] J. Cao, H. Liu, P. Li, D. Brown, and G. Dimirovski, An improved active
suspension model for attitude control of electric vehicles, in Mechatro-
nics and Automation, 2007. ICMA 2007. International Conference on.
2) Caso II: El segundo caso presenta un obstculo de 10 cm IEEE, 2007, pp. 147152.
en los puntos de referencia 1 (seal de color verde) y 2 (seal [13] S. Ikenaga, F. L. Lewis, J. Campos, and L. Davis, Active suspension
de color magenta), en la figura 6 se observa que la superacin control of ground vehicle based on a full-vehicle model, in American
Control Conference, 2000. Proceedings of the 2000, vol. 6. IEEE, 2000,
de este obstculo produce una seal Ys subamortiguada que pp. 40194024.
representa el movimiento lateral de la masa suspendida, al [14] L. F. Moncayo Ortiz et al., Clculo y anlisis dinmico del automvil
presentar una menor sobreoscilacin respecto a las seales de durante su desplazamiento en carretera, 2004.
entrada se comprueba el correcto desempeo del sistema de
suspensin.
V. C ONCLUSIONES
Un modelo de suspensin permite verificar la estabilidad
del robot al alcanzar un obstculo determinando, este
permite predecir si el obstculo se logra superar o se
pierde la maniobrabilidad del robot.
Las constantes de rigidez y amortiguamiento de un sis-
tema de suspensin al ser calculadas de manera correcta
permiten un adecuado desempeo en el funcionamiento
de la suspensin, reduciendo de manera significativa la
amplitud de las oscilaciones, evitando as daos que se
pueden generar en la estructura debido a las vibraciones
mecnicas producidas por la superacin de un obstculo.
R EFERENCIAS
[1] A. O. Baturone, Robtica: manipuladores y robots mviles. Marcombo,
2001.
[2] L. Sciavicco and L. Villani, Robotics: modelling, planning and control.
Springer, 2009.
[3] G. Dudek and M. Jenkin, Computational principles of mobile robotics.
Cambridge university press, 2010.