Académique Documents
Professionnel Documents
Culture Documents
Facultad de Ingeniera
Robtica
Profesor
Ing. Erick Pea Medina
Integrantes:
De la Mora Pacheco Jimena
Hernndez Mendoza Oscar
Malagn Snchez Eduardo
Objetivo
Esta prctica consiste en la medicin del error que presenta el movimiento del SCARA,
comparando la simulacin contra las posiciones captadas mediante una cmara.
Material
Microcontrolador Arduino UNO
Protoboard
Fuente de poder
Jumpers
Cmara
Robot SCARA
Mathematica
Interface Arduino
Modelado
Se realiz mediante la reduccin a coordenadas cilndricas, como una variacin del
mtodo de Denavit-Hartenberg, definiendo los siguientes sistemas de referencia:
Cinemtica inversa
Para obtener la solucin se utiliz el comando FindRoot que utiliza el mtodo
numrico Newton-Raphson.
Trayectoria
Esta imagen representa la trayectoria establecida como tarea para el SCARA:
Comunicacin
Para establecer comunicacin con Arduino, se utiliza el comando de Mathematica
DeviceOpen en el que se establece el puerto COM al que est conectado el Arduino y
la frecuencia de muestreo con la que se quiere trabajar. De esta manera se accede al
puerto serial de Arduino. Posteriormente se pueden transmitir datos escribindolos
desde Mathematica en el puerto Serial de Arduino y para finalizar se cierra la
comunicacin. A continuacin, se muestra una imagen ejemplificando lo descrito.
Muestreo de imgenes
A pesar de que no se pudo utilizar este mtodo para la obtencin de errores, el
programa tiene la programacin necesaria para tomar fotografas por cada dato
recibido y analizarlas para detectar la posicin del robot a lo largo de su trayectoria.
Desarrollo
Se comenz a trabajar con el programa de Mathematica que ya se tena, sin embargo,
haba ciertos valores que desplazaban los brazos de su lugar de origen y no realizaba
la trayectoria que se le programaba.
Se realiz un programa en Arduino para recibir datos desde Mathematica y transmitirlos
a cada servo; primero se realizaron pruebas mandando ngulos especficos y
observando de qu manera se comportaba el robot.
Para hacer las pruebas se utiliz otro juego de servos porque el eje del SCARA no
estaba bien acoplado y no serva para establecer puntos de referencia.
Se calibraron los servos para que en su posicin inicial ambos estuvieran sobre un
mismo eje y desde ah se realizara la trayectoria deseada.
Una vez calibrados los servos y probado que se desplazaban en el sentido que se
quera se utiliz el programa de Mathematica para enviar la solucin de posicin.
Se debi modificar la cantidad de datos transmitidos a Arduino para que los servos no
se saturaran y realizaran su tarea adecuadamente. Adems, se manejaron nicamente
valores positivos para los ngulos ya que los servos no reconocan valores negativos.
Conclusiones
Una vez realizado el modelado de la trayectoria del SCARA, se procedi con el control
de los servomotores que permitan el giro de los brazos del robot. Se observ que, al
enviar toda esa informacin el control del motor se saturaba, por lo que no se llegaba a
mover, entonces se redujeron los puntos de la trayectoria. De esta manera los motores
podan moverse, aunque no con una ruta fiel a la simulada.
Al querer tomar fotografas en la trayectoria del lugar geomtrico, no concordaban con
el movimiento real del robot, por lo que la comparacin de la simulacin con la de la
vida real a travs del anlisis de imgenes, no es un recurso certero para calcular el
error.
Se observ tambin que el acoplamiento del primer servomotor a la base no era fijo,
por lo que no se poda asegurar una posicin especfica. Entonces el clculo del error
no slo iba a deberse a la diferencia en la posicin causada por los motores, sino
tambin la originada por la falla en el acople, por lo que sta prctica no iba a cumplir el
objetivo e iba a acumular ms errores.