Вы находитесь на странице: 1из 8

1

Modelo Dinmico de La Suspensin de un Robot


de Traccin Tipo Oruga

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]

Un anlisis dinmico permite estudiar la calidad de


marcha del robot evaluando las irregularidades presentes en II. M ODELO MATEMTICO DE 12 GRADOS DE LIBERTAD
el terreno, para mejorar el confort del robot en movimiento DEL SISTEMA DE SUSPENSIN
implementando un sistema de suspensin en el cual cobra
relevancia el anlisis de la trayectoria.[7]
La implementacin de un sistema de suspensin en un
La dinmica de un robot es esencial para su anlisis robot de traccin tipo oruga, es primordial debido a que su
terico, debido a que representa el comportamiento en tiempo trayectoria presenta obstculos que pueden evitar el contacto
real de las variables del sistema, por lo cual el modelo entre las orugas y el suelo provocando la inestabilidad del
matemtico debe ser detallado y simple, para simular con robot, por lo tanto se realiza un modelo matemtico que
precisin el comportamiento dinmico. Se elige un enfoque permita representar el sistema de suspensin.
axiomtico para la realizacin del modelo matemtico, el
cual hace hincapi en los principios fsicos fundamentales Para realizar el modelo matemtico del robot, se escogen
de la estructura y parmetros conocidos o desconocidos del dos puntos en los centros de radio de curvatura de cada
sistema, que son validados empricamente de acuerdo al oruga, para analizar el comportamiento dinmico respecto a
anlisis de los resultados obtenidos en simulacin.[8] la trayectoria. Se eligen estos puntos por su ubicacin, la cual
presenta mayor desplazamiento respecto a la superacin de
El modelo dinmico de un sistema est dado por las un obstculo, esto tiene como objetivo principal obtener el
ecuaciones diferenciales que son obtenidas por diversos coeficiente de rigidez y viscosidad para el diseo del sistema
mtodos, estas representan el modelo matemtico de la de suspensin.
dinmica de un sistema fsico. Los dos mtodos comnmente
utilizados involucran la aplicacin de las leyes fsicas Para el anlisis del comportamiento dinmico del robot
(Newton-Euler y Euler-Lagrange). El enfoque de Newton- se utiliza un sistema de referencia ubicado en su centro de
Euler o tambin denominado mtodo sinttico obtiene las gravedad el cual sirve para determinar las posiciones relativas
ecuaciones diferenciales que representan el sistema mediante de los puntos de inters, luego se analiza el desplazamiento
el diagrama de cuerpo libre. El mtodo Lagrange se basa en lateral Y, y el desplazamiento vertical Z. Adicionalmente
las ecuaciones de energa y movimiento del sistema sin tener se representa el desplazamiento angular asociado a los ejes
en cuenta las fuerzas de reaccin involucradas.[8] Y y X que dan lugar al angulo de balanceo y cabeceo
respectivamente. De esta forma se estudia el movimiento de
Los modelos matemticos se representan en diferentes la masa suspendida y las masas no suspendidas asociadas a
formas dependiendo del sistema. Una representacin en cada punto de anlisis. [14].
el espacio de estados es aconsejable en problemas que
involucren control ptimo, sin embargo para el anlisis de El siguiente esquema paramtrico (Figura 1) del robot
respuesta transitoria es conveniente usar una representacin representa un modelo de 12 grados de libertad debido
mediante la funcin de transferencia.[9] al desplazamiento en Z y Y de cada uno de los puntos
de referencia y del cuerpo rgido ms , al igual que la
Para el modelo dinmico del sistema de suspensin se contemplacin de los ngulos pitch y roll .
3

representan las fuerzas asociadas al sistema.

F Kz = F Kcos

F Bz = F Bcos

F K0 z = F K0 cos

P1 z = P1 cos

1) Anlisis en Z para el punto 1:


X
F = mo Z1

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

B. Anlisis respecto al eje vertical Z (masa suspendida)


Debido al peso de la masa no suspendida y el sistema de
suspensin se produce un desplazamiento en el eje vertical Z,
Se realiza un anlisis en el eje vertical teniendo en cuenta las
luego se deben analizar las fuerzas que actan en el sistema.
fuerzas que actan sobre la masa suspendida. Las siguientes
Al existir un angulo de apertura tambin se produce un
ecuaciones representan las fuerzas actuantes respecto a los 4
movimiento lateral respecto al eje Y el cual se debe analizar.
puntos de referencia:
Fuerzas actuantes en el lado izquierdo:
A. Anlisis respecto al eje vertical Z (masa no suspendida)
F Iz = F1 z + F3 z

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

Las constantes de rigidez y viscosidad son las mismas


F By = F Bsen
para cada uno de los puntos de referencia:
F K0 y = F K0 sen
K1 = K2 = K3 = K4 = K

P1 y = P1 sen
B1 = B2 = B3 = B4 = B

1) Anlisis en Y para el punto 1 : Realizando la sumatoria de fuerzas:


X
F = mo Z1 X
F y = ms Ys(t)
F Kz + F Bz F K0 W = mo Y1

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

E. Anlisis respecto a los ngulos de rotacin pitch y roll


3) Anlisis en Z para el punto 3:
   
Bsen Ksen + K0 sen
Y3(t) + Y3(t) + Y3 (t) = Debido que la velocidad del robot es de 90 cm/s, y la
mo mo
    rotacin generada por los motores es mnima, no se considera
Bsen Ksen
Ys(t) +
2
Ys (t) + K0 (sen) p3 (t) (8) un estudio que analice el movimiento angular producido por la
mo mo
rotacin del motor. Solo se considera el anlisis de los ngulos
de rotacin producido por la superacin de obstculos.
5

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

I = (F1 z)Df + (F2 z)Df (F3 z)Dr (F4 z)Dr


I = (F1 z)Rf (F2 z)Rf + (F3 z)Rr (F4 z)Hr

(F1 y)Df + (F2 y)Df + (F3 y)Dr (F4 y)Dr


I = F1 Rf cos F2 Rf cos + F3 Rr cos F4 Rr cos
I = F1 Df cos + F2 Df cos F3 Dr cos F4 Dr cos
Se utilizan las ecuaciones de aproximacin antes mencionadas
F1 Df sen + F2 Df sen + F3 Dr sen F4 Dr sen (11)

2 2
I = 4BR (cos) 4KR (cos) BR (cos) Z1

Debido a que el angulo roll y pitch son pequeos, las


ecuaciones de aproximacin son:
KR (cos) Z1 + BR (cos) Z2 + KR (cos) Z2 BR (cos) Z3
Zs1 = Zs Df Rf

KR (cos) Z3 + BR (cos) Z4 + KR (cos) Z4 (13)


Zs2 = Zs Df + Rf

Zs3 = Zs + Dr Rr III. S IMULACIN

Zs4 = Zs + Dr + Rr

El desplazamiento del robot en una trayectoria determinada,


Y s 1 = Ys + D f puede presentar perturbaciones ocasionadas por obstculos
presentes en esta, por esta razn se simula el sistema de
Y s 2 = Ys + D f suspensin respecto a una seal de excitacin pulso aplicada
en distintos puntos de referencia segun el caso que se desee
Y s3 = Ys Dr simular
Se realiza la simulacin con ayuda del software matlab,
Y s4 = Ys Dr teniendo en cuenta los parmetros del robot mostrados en el
cuadro II.
Derivando
1 = Zs Df Rf
Zs
Parmetros Valores
Masa suspendida 28 kg
2 = Zs Df + Rf
Zs Masa no suspendida 10 kg
Distancia entre el centroide y las orugas 0,025 m
3 = Zs + Dr Rr Distancia entre el centroide y los ejes 0,0195 m
Zs
Momento de inercia I 0,024733kg.m2
Momento de inercia I 0,022449kg.m2
4 = Zs + Dr + Rf
Zs Rigidez de la oruga 160,000 N/m
Rigidez del sistema de suspensin 800 N/m
Viscosidad del sistema de suspensin 8000 N/m
Y s1 = Ys + Df
Cuadro II
PARMETROS DEL ROBOT
Y s2 = Ys + Df

Y s3 = Ys Dr
A. Simulacin respecto al eje vertical Z
Y s4 = Ys Dr

A continuacin se exponen 3 casos que muestran la res-


I = 4BD
2
(cos + sen) 4KD
2
(cos + sen) BD (cos) Z1 puesta generada en la masa suspendida en el eje vertical Z.

KD (cos) Z1 BD (cos) Z2 KD (cos) Z2 + BD (cos) Z3 + KD (cos) Z3


1) Caso I: En la Figura 2 se observa la respuesta del
sistema, al tener una seal de entrada pulso con amplitud de
+BD (cos) Z4 + KD (cos) Z4 + BDsenY1 + KDsenY1 + BDsenY2
0.1 y un periodo de un segundo en los puntos de referencia 1
y 3, y en los dos puntos restantes un cero. Adicionalmente en
+KDsenY2 BDsenY3 KDsenY3 BDsenY4 KDsenY4 (12) esta simulacin la apertura de las orugas es 30 grados.
6

B. Simulacin respecto al eje lateral Y

A continuacin se exponen 3 casos que muestran la res-


puesta generada en la masa suspendida en el eje lateral Y.

1) Caso I: En la Figura 5 se observa la respuesta del


sistema, al tener una seal de entrada pulso con amplitud de
0.1 y un periodo de un segundo en los puntos de referencia 1
Figura 2. Simulacin en el eje vertical Z, caso I y 3, y en los dos puntos restantes un cero. Adicionalmente en
esta simulacin la apertura de las orugas es 30 grados.

2) Caso II: En la Figura 3 se observa la respuesta del


sistema, al tener una seal de entrada pulso con amplitud de
0.1 y un periodo de un segundo en los puntos de referencia 1
y 2, y en los dos puntos restantes un cero. Adicionalmente en
esta simulacin la apertura de las orugas es 30 grados.

Figura 5. Simulacin en el eje vertical Y, caso I

2) Caso II: En la Figura 6 se observa la respuesta del


sistema, al tener una seal de entrada pulso con amplitud de
Figura 3. Simulacin en el eje vertical Z, caso II 0.1 y un periodo de un segundo en los puntos de referencia 1
y 2, y en los dos puntos restantes un cero. Adicionalmente en
esta simulacin la apertura de las orugas es 30 grados.

3) Caso III: En la Figura 4 se observa la respuesta del


sistema, al tener una seal de entrada pulso con amplitud de
0.1 y un periodo de un segundo en el punto de referencia
1 y una seal de entrada pulso con amplitud de -0.1 y un
periodo de un segundo en el punto de referencia 2, y en los dos
puntos restantes un cero. Adicionalmente en esta simulacin
la apertura de las orugas es 30 grados.

Figura 6. Simulacin en el eje vertical Y, caso II

3) Caso III: En la Figura 7 se observa la respuesta del


sistema, al tener una seal de entrada pulso con amplitud de
0.1 y un periodo de un segundo en el punto de referencia
1 y una seal de entrada pulso con amplitud de -0.1 y un
Figura 4. Simulacin en el eje vertical Z, caso III periodo de un segundo en el punto de referencia 2, y en los dos
puntos restantes un cero. Adicionalmente en esta simulacin
la apertura de las orugas es 30 grados.
7

Figura 7. Simulacin en el eje vertical Y, caso III Figura 9. Simulacin ngulo de rotacin roll (caso I)

IV. A NLISIS DE RESULTADOS

Al superar un obstculo la masa no suspendida presenta


C. Simulacin ngulo de rotacin pitch
una oscilacin que puede afectar los elementos mecnicos
y electrnicos del sistema, luego las grficas obtenidas por
simulacin deben demostrar que el sistema de suspensin
A continuacin se exponen 3 casos que muestran la res- reduce la amplitud de las oscilaciones de la masa suspendida
puesta generada en la masa suspendida en el eje lateral Y. respecto a la masa no suspendida. A continuacin se muestra
el anlisis generado para cada grfica expuesta en la seccin
tres.
1) Caso I: En la Figura 8 se observa la respuesta del
sistema, al tener una seal de entrada pulso con amplitud de
0.1 y un periodo de un segundo en los puntos de referencia 1 A. Anlisis respecto al eje vertical Z
y 3, y en los dos puntos restantes un cero. Adicionalmente en
esta simulacin la apertura de las orugas es 30 grados.
1) Caso I: En el primer caso se considera un obstculo
que altera la altura de una de las orugas, en la figura 2 se
puede observar el anlisis para el plano vertical de la masa
suspendida, esta respuesta presenta menor amplitud en las
oscilaciones respecto a la seal de entrada en los puntos 1
(seal de color cian) y 3 (seal de color verde). La seal Zs
es una respuesta subamortiguada, con un overshoot menor en
comparacin con las seales Z1 y Z3 correspondientes a la
oruga, esta seal Zs se estabiliza a un centmetro por debajo
del centro de gravedad, esto se debe a la accin de la pre-carga
y carga del chasis sobre la suspensin.

2) Caso II: En el segundo caso se considera un obstculo


Figura 8. Simulacin en el ngulo de rotacin pitch, caso I
que afecta los puntos de referencia 1 y 2, en la figura 3 se
puede observar el anlisis para el plano vertical de la masa
suspendida, esta respuesta comprueba la estabilidad del robot
al superar un obstculo de forma frontal y no volcarse. Al
igual que en el caso I se produce una reduccin de altura
D. Simulacin ngulo de rotacin roll respecto al sistema de referencia provocado por la gravedad
y la carga del chasis sobre la suspensin Al obtener una
respuesta subamortiguada con menor numero de oscilaciones
respecto a la seal de entrada, implica que la suspensin esta
A continuacin se exponen 3 casos que muestran la res-
absorbiendo la vibracin mecnica generada por la superacin
puesta generada en la masa suspendida en el eje lateral Y.
del obstculo, luego se minimiza notablemente la seal de la
masa suspendida en comparacin con la seal de las orugas.
1) Caso I: En la Figura 9 se observa la respuesta del
sistema, al tener una seal de entrada pulso con amplitud de 3) Caso III: En el tercer caso el robot debe superar un
0.1 y un periodo de un segundo en los puntos de referencia 1 obstculo de 10 centmetros que afecta al punto de referencia
y 3, y en los dos puntos restantes un cero. Adicionalmente en 1 y un hueco con profundidad de 10 centmetros que afecta al
esta simulacin la apertura de las orugas es 30 grados. punto de referencia 2, en la figura 4 se observa que al superar
8

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.

3) Caso III: En el tercer caso el robot debe superar un


obstculo de 10 centmetros que afecta al punto de referencia
1 y un hueco con profundidad de 10 centmetros que afecta al
punto de referencia 2, en la figura 7 se observa que al superar
estos obstculos, se presentan fuerzas de igual magnitud y
direccin, con sentido opuesto que al cancelarse entre si no
producen movimiento alguno en plano lateral del robot.

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.

Вам также может понравиться