Professional Documents
Culture Documents
Robtica
Trabajo Bimestral
Donde G representa el centro de masa y se encuentra ubicado a una distancia a por delante del
centro del eje que une las ruedas, siendo (x, y) la posicin del punto h respecto al sistema de referencia
global, y define su orientacin respecto a {R}. Por lo tanto el modelo cinemtico del robot uniciclo,
puede ser representado por:
x = u cos a sen
y = u sen a cos
=
Donde los estados son x, y, y las entradas del sistema son u y .[1]
Configuracin Diferencial:
Adems de esas relaciones matemticas son necesarias las frmulas que relacionan las velocidades angulares de las llantas con la velocidad angular y lineal del sistema total, estas vienen dadas por:
v=
v R +v L
2
L
= R +
r
2
v R v L
b
L
= R
r
b
Donde L y R son las velocidades angulares correspondientes a las ruedas izquierda y derecha, r
es el radio de la rueda y b es el sesgo del vehculo (separacin de las dos ruedas centrales).[2]
Simulacin del modelo
El primer paso para la simulacin del robot uniciclo es la seleccin del software que se va a utilizar
para obtener los resultados esperados. En este caso se ha decidido utilizar el software MatLab, con una
caracterstica especial de simulink que permite importar archivos tipo CAD al entorno de simulink y
as obtener una simulacin en 3D del robot que se quiere analizar. Esto se consigue con la instalacin
de SimMechanics, el cual es un complemento para Simulink, y usa una aproximacin esquemtica en
diagramas de bloques para el modelado de sistemas de control en dispositivos mecnicos. El programa
elegido para realizar el modelado mecnico fue SolidWorks, debido a su amigable interface y la forma
relativamente sencilla de editar piezas y ensamblarlas posteriormente.
Se tomo como modelo el ms simple del robot uniciclo, para no tener complicaciones a la hora de disear la estructura mecnica, dando como resultado el siguiente modelo con sus respectivas medidas:
Largo: 50 [cm], Ancho 50 [cm] y Altura 20 [cm]. El radio de las ruedas es de 7 (17,78 [cm]) y distancia
entre las ruedas es de 60 [cm].
El archivo CAD generado se debe exportar a un archivo .xml para que pueda ser usado por MatLab y
genere el modelo necesario de las partes mecnicas que se han construido en SolidWorks, dando como
resultado el siguiente modelo en diagrama de bloques:
En este modelo se representa a cada elemento de la estructura mecnica como un bloque, y el bloque anterior define el movimiento que presenta. Se tiene de igual forma la referencia a tierra que es
necesaria para cualquier anlisis.
Sin embargo an no se puede simular el robot tipo uniciclo. Es necesario agregar el modelo cinemtico, es decir, las ecuaciones que gobiernen el movimiento del robot, esto se lo hace como subsistemas
que se aaden. Adems se debe configurar los bloque de revolute (que representan el movimiento de
las ruedas para que proporcionen una medicin de velocidad que es necesaria para los clculos).
Finalmente a cada revolute (movimiento de las llantas) se les agrega una constante y un integrador para
que mantengan el movimiento a la velocidad que define la constante, ya que se pone una rampa con
pendiente c a la entrada que representa la posicin angular, la velocidad de entrada esta en [rad/s].
Despus de realizar todas estas tareas el modelo resultante es el siguiente:
3
Resultados
Despues de obtener el modelo es necesario comprobar la validez de los bloques que lo constituyen,
para ello se simulo para diferentes condiciones de velocidad a las cuales un robot con traccin diferencial debe presentar un movimiento determinado:
L = R , los resultados fueron los siguientes:
Se puede apreciar que el robot sigue una trayectoria recta, por lo tanto los resultados son los esperados.
L = R , los resultados fueron los siguientes:
Se puede apreciar que el robot gira en su propio eje, por lo tanto los resultados son los esperados.
L > R , los resultados fueron los siguientes:
Se puede apreciar que el robot gira hacia la derecha, por lo tanto los resultados son los esperados.
L < R , los resultados fueron los siguientes:
Se puede apreciar que el robot gira hacia la izquierda, por lo tanto los resultados son los esperados.
En base a los resultados obtenidos se puede concluir que el modelo obtenido se aproxima bastante
bien a un robot uniciclo real, por lo tanto este modelo puede ser usado posteriormente para el diseo
de controladores para este tipo de robot mvil.
SEGUIDOR DE TRAYECTORIA
Se basa en la suposicin de una robot de referencia al cual se busca alcanzar. Tiene una velocidad,
orientacin, etc., que son de referencia y que se busca alcanzar.
xr = u cos a sen
yr = u sen a cos
r = r
Se supone: lm u r (t ) 6= 0
Definicin de errores de control:
Figura 1: Esquema general del uso de fuerzas ficticias para la evasin de obstculos
El mtodo de las fuerzas ficticias, genera un campo de fuerza virtual que continuamente va cambiando en funcin de la distancia al obstculo, velocidades real y mxima del robot mvil. Esta fuerza
est dada por:
Donde:
d k Es la distancia entre el objeto y el robot.
d mi n Es la distancia mnima de no contacto del robot con el obstculo.
d max Es la distancia que define la zona repulsiva y cuando se utiliza el algoritmo de evasin.
c f Es una constante positiva que define el rea cobertura del campo.
Se define como:
k = k k
RESULTADOS OBTENIDOS AL REALIZAR LA SIMULACIN DEL ROBOT MVIL
Como se ha venido trabajando, se ha venido utilizando la herramienta de MATLAB, para ir obteniendo las respuestas al sistema ingresado. Con la ayuda del simulink se obtuvo el siguiente diagrama
de bloques:
Para el diagrama de bloques presentado, se tiene que las entradas utilizadas son (x) y (y), ademas
de el angulo los cuales son los que permiten la realizacin de los distintos clculos y como se puede
observar van hacia el algoritmo implementado. Y ademas que permiten la realizacin de la simulacin
del robot de manera interactiva.
Ademas que los 2 ltimos bloques son las velocidades lineal y angular respectivamente, los que entran en el algoritmo para de este modo obtener las velocidades de los revolute(llantas)
Esta imagen representa el robot mvil siguiendo una trayectoria previamente definida y en movimiento.
La imagen es la respuesta del robot al seguir una trayectoria, y al encontrarse con un obstculo, se
observa como lo evade, y continua la trayectoria antes definida.
10
Imagen obtenida de la respuesta del sistema, al ser ejecutado desde el archivo .m.
Si comparamos ambas imgenes es apreciable que las 2 son similares, por lo que nos indica que
tanto el algoritmo implementado en el script como en el simulink funciona correctamente, ademas que
el algoritmo implementado funciona correctamente ya que no existe un error considerable o que sea
catastrfico.
Conclusiones
La utilizacin del modelo cinemtico es de suma importancia para el inicio de entender la movilidad del uniciclo escogido ya que al realizar este anlisis solo se lo considera como una partcula
ideal sin considerar otros parmetros como rozamiento, aerodinmica, etc. Y solo se considera la
movilidad del mismo, lo que conlleva a considerar el ngulo con el cual el robot va a movilizarse,
y la longitud a la cual el robot va a desplazarse.
Tambin se ha incluido la velocidad a la cual se van a mover las llantas que puede ser un parmetro
importante para posteriores clculos, pero por el momento se los ha definido con una constante
para que el movimiento de las llantas sea constante en todo momento de la trayectoria.
Se experiment los tipos de movimientos que se generara al variar la velocidad de cada llanta,
y se observar que con tan solo variar estos parmetros ya el robot toma trayectorias propias no
definidas, por lo que este parmetro es de suma importancia a considerar.
El modelo cinemtico como las constantes de velocidad son parmetros fundamentales para tener movimiento deseado al robot, siempre se los debe de considerar juntos para que el robot pueda seguir algn tipo de movimiento (trayectoria) deseado.
El control de robot moviles por seguimiento de trayectoria, tiene aspectos muy importantes a
considerar como es la parametrizacin en el tiempo, ademas que solo se limita al seguimiento de
una trayectoria previamente definida.
Para este modelo se busca que el error que siempre va a existir ya que el robot nunca va a alcanzar
al robot ficticio tienda a 0.
11
12