Documentos de Académico
Documentos de Profesional
Documentos de Cultura
ISSN: 0123-921X
tecnura@udistrital.edu.co
Universidad Distrital Francisco José de Caldas
Colombia
CARDONA RENDÓN, LORENA; ORTIZ VALENCIA, PAULA ANDREA; BOTERO VALENCIA, JUAN
SEBASTIÁN
Sistema de navegación para un robot limpiador de piscinas
Tecnura, vol. 18, núm. 39, enero-marzo, 2014, pp. 22-33
Universidad Distrital Francisco José de Caldas
Bogotá, Colombia
22 Vol.18
Tecnura Vol. 18 No.
No.39
39 pp.
enero marzoenero
22 - 33 de 2014
- marzo de 2014
* * *
Figura 1. Diagrama de bloques del sistema de navegación aplicado al modelo virtual del robot
Para obtener un modelo del robot, se recurrió a En el modelo de la figura 5, los bloques que re-
un software de modelado en 3D (Autodesk In- presentan los cuerpos tienen puntos de conexión
ventor ® 2011), en el cual se construyeron los que están determinados por coordenadas espacia-
modelos tridimensionales de cada una de las par- les [x, y, z]. Los cuerpos se conectan entre sí a
través de uniones y restricciones. Estas uniones Existe una matriz de rotación que permite pasar del
se crearon en el programa Autodesk Inventor y marco B (unido al robot) al marco local (fijo a la
fueron exportadas automáticamente a Simulink piscina). Esta matriz de rotación tiene la propiedad
por el software SimMechanics Link. que R-1=RT y está definida en la ecuación (1).
(2)
Figura 7. Fuerzas que actúan sobre el robot en el
plano xy
Xu 0,0030
(6)
yv 0,0028
Nr 0,0042
Donde L es la longitud transversal al eje x, y o z,
1,000
es la velocidad en el respectivo eje y μ es la vis-
Ax 0,08166
cosidad dinámica del agua.
Ay 0,06776
μ 0,001003
2.2.4 Segunda ley de Newton aplicada sobre Lx 0,161
el robot
Ly 0,147
Lr 0,22
Para plantear las ecuaciones que rigen el movi-
miento del robot limpiador de piscinas, se aplica b 0,1538
te se suman las fuerzas para hallar la total en cada Fuente: elaboración propia.
eje, ver ecuación (7).
Los valores de los diferentes parámetros usados
(7)
en las ecuaciones desarrolladas en esta sección
se muestran en la tabla 1. Las áreas y longitudes
donde R es la matriz de rotación. transversales, así como la masa y el momento de
inercia, son valores obtenidos con el software Au-
También se suman los torques para hallar el tor- todesk Inventor.
que total en el eje z, ver ecuación (8).
donde b es la distancia entre el punto de aplica- En el sistema de navegación para el robot suba-
ción de las fuerzas Fder y Fizq al centro de gravedad cuático se empleará un acelerómetro triaxial y un
del vehículo (figura 7). compás. A continuación se detallan las caracterís-
ticas de cada uno y se explica cómo fueron mo-
A partir de las ecuaciones anteriores, se tiene la delados.
ecuación (9).
2.3.1 Acelerómetro
(9)
El acelerómetro que se empleará es el MMA7260
Donde m es la masa del vehículo, a es la acelera- de la compañía Freescale Semiconductor. Las es-
ción del vehículo (en el marco local), I es el mo- pecificaciones para este sensor se pueden encon-
mento principal de inercia del vehículo (en el eje trar en [10]. El acelerómetro triaxial se ubica en el
z) y α es la aceleración angular del vehículo (en centro de gravedad del robot, con sus ejes orienta-
el eje z). dos en dirección a los ejes xb, yb y zb. Este sensor
Parámetro Valor
2.3.2 Compás
El compás es un sensor que mide los cambios en Figura 9. Ruido simulado para las medidas de campo
la orientación del robot. El compás que se usará magnético en el eje x
en el robot es el CMPS03 de la compañía Devan- Fuente: elaboración propia.
2.6 Simulación
(12)
El modelo del robot, las ecuaciones de la dinámi-
Donde â es la aceleración estimada, am σ2am es la ca de este, el modelo de los sensores, el estimador
aceleración medida por el sensor y σ2am es la va- (por mínimos cuadrados ponderados) y la integra-
rianza del error en dicha medida, ac es la acele- ción del resultado para obtener la posición y ve-
ración calculada con las ecuaciones desarrolladas locidad del robot, se implementaron en Simulink,
en la sección 2.2.4 y σ2ac es la varianza del error como se muestra en la figura 10.
Figura 10. Diagrama de bloques construido en Simulink para la simulación del sistema de navegación
3. RESULTADOS
Figura 12. Comparación de los errores en los valores
En la figura 12 se graficó el error en los valores medidos y estimados de aceleración en
medidos y estimados de aceleración y orien- el eje (a), aceleración en el eje (b) y de
tación del vehículo. Los errores se calcularon orientación (c)
como la diferencia entre el valor (medido o es- Fuente: elaboración propia.
timado) y el valor real, tomado directamente del
modelo. El valor estimado es el valor obtenido 4. CONCLUSIONES
con la técnica de mínimos cuadrados pondera-
dos. En este trabajo se diseñó un sistema de navegación
para un robot limpiador de piscinas adquirido por
En las figuras 13, 14 y 15 se observan los valo- la Liga de Natación de Antioquia, como primer
res estimados de posición, velocidad y orienta- paso para lograr su automatización. Con el traba-
ción del vehículo, respectivamente, comparados jo realizado se buscaba comprobar si los sensores
con los valores reales de estas mismas variables. seleccionados junto con las ecuaciones que descri-
Figura 13. Gráfica de velocidad en los ejes x e y del Figura 14. Gráfica de posición en los ejes x e y del
marco local marco local
Nota: se muestra el valor real y el valor estimado de las va- Nota: se muestra el valor real y el valor estimado de las va-
riables. riables.
5. AGRADECIMIENTOS
Y FINANCIAMIENTO
REFERENCIAS
[2] Naval Command, Review of autonomous [8] T. Fossen,Guidance and Control of Ocean
underwater vehicle (AUV) developments, Vehicles, 1st. ed.,Chichester: John Wiley &
United States General Books LLC, Wash- Sons, 1994.
ington, 2001.
[9] G. Conte and A.Serrani,“Modellingand si-
[3] M. Simoncelli, G. Zunino, H. Christen- mulation of underwater vehicles”, in Pro-
sen, and K. Lange, “Autonomous pool ceedings of the IEEE International Sympo-
cleaning: self-localization and autonomous sium on Computer-Aided Control System
navigation for cleaning”, Autonomous Ro- Design, Dearborn, USA, pp. 62-67, 1996.
bots, vol. 9, no. 3, pp. 261-270, December
2000. [10] Freescale-Semiconductor, “MMA7260QT
Technical Data”, 2008. [Online]. Available:
[4] P. Vanicek and M. Omerbašic, “Does a http://cache.freescale.com/files/sensors/
navigation algorithm have to use Kalman doc/data_sheet/MMA7260QT.pdf?pspll=1
filter?”, Canadian Aeronautical and Space [consultado el 10 de mayo de 2011].
Institute Journal, vol. 45, no. 3, pp. 292-
296, 1999. [11] P. Savage,“What Do Accelerometers Mea-
sure?”, Strapdown Associates, Inc., 2005.
[5] F. El-Hawary, “A comparison of recursive [Online]. Available:http://www.strapdow-
weighted least squares estimation and Kal- nassociates.com/Accels%20Measure.pdf
man filtering for source dynamic motion [consultado el 7 de abril de 2011].
evaluation”, Canadian Journal of Electri-
cal and Computer Engineering, vol. 17, [12] Hobby-Engineering,“CMPS03 - Robot
no. 3, pp. 136-145, 1992. Compass Module”. [Online]. Available:
http://www.hobbyengineering.com/specs/
[6] M. Gautieraand P. Poignet, “Extended Kal- devantech-cmps03-tech.pdf [consultado el
man filtering and weighted least squares 10 de mayo de 2011].
dynamic identification of robot”, Control
Engineering Practice, vol. 9, no. 12, pp.
1361-1372, 2001.
Sistema
Tecnura de Vol.navegación
18 No. 39 para
pp. un
22 -robot
33 limpiador de piscinas
enero - marzo de 2014 33
LORENA CARDONA RENDÓN / PAULA ANDREA ORTIZ VALENCIA / JUAN SEBASTIÁN BOTERO VALENCIA