Robolt fase 5
UNIVERSIDAD DEL VALLE
INTRODUCCIÓN A LA INGENIERÍA ELECTRÓNICA
INGENIERÍA ELECTRÓNICA
Septiembre 2021
Isaac Arias (2127306) / Zuly Valentina Rodríguez (2128691) / Anderson Cuaspud (2077336)
ROLBOLT FASE 5
En esta quinta fase del robot seguidor de línea 'Robolt', hablaremos sobre todos los cambios por los cuales ha pasado el robot, en cuanto a las partes que se pensaban implementar en primera instancia, cuales continuaron y lugares se decidieron cambiar, seguidamente se mostrara la plataforma final en la que se encontrará el robot para la ultima entrega, veremos el robot en funcionamiento en la pista que se solicitó con la línea negra.
Igualmente, dejaremos por aquí un enlace donde se podrá visitar la primera y segunda fase realizada de nuestro seguidor de línea. ROBOLT FASE 1, ROBOLT FASE 2, ROBOLT FASE 3 y ROBOLT FASE 4.
Los principales cambios que sufrió el diseño inicial del robot seguidor de línea, es en cuanto a su estructura de conexión y el método para suministrarle energía a los componentes del robot.
En primera instancia planeábamos a utilizar una protoboard de tamaño estándar
int MdireccionA = 3, velocidadA = 5; int MdireccionB = 6, velocidadB = 9; // VELOCIDAD Y DIRECCION DE LOS MOTORES A Y B int pinD = 7, sensorD; int pinI = 8, sensorI; // PINS DE LOS SENSORES SEGUIDORES DE LÍNEA void setup() { //CONFIGURACIÓN DE LOS PUERTOS DE LA PLACA BUILD&CODE 4IN1
pinMode ( MdireccionA, OUTPUT); pinMode ( velocidadA, OUTPUT); pinMode ( MdireccionB, OUTPUT); pinMode ( velocidadB, OUTPUT); pinMode (pinD, INPUT); pinMode (pinI, INPUT); } void loop() { // LECTURA DE LOS SENSORES SEGUIDORES DE LÍNEA sensorD= digitalRead (pinD); sensorI = digitalRead (pinI); if ((sensorD == 0)& (sensorI == 0)) // AVANZAR HACIA DELANTE { //MOTOR B analogWrite (velocidadB, 150); // VELOCIDAD EL MOTOR-B, ES DE 0 (STOP) A 255 (MAXIMA VELOCIDAD) digitalWrite ( MdireccionB,LOW); // SENTIDO DE GIRO MOTOR-B, LOW (DELANTE), HIGH (ATRÁS) //MOTOR A analogWrite (velocidadA, 150); // VELOCIDAD EL MOTOR-A, ES DE 0 (STOP) A 255 (MAXIMA VELOCIDAD) digitalWrite ( MdireccionA,HIGH); // SENTIDO DE GIRO MOTOR-A, HIGH (DELANTE), LOW (ATRÁS) } if ((sensorD == 1)& (sensorI == 1)) // ATRÁS { //MOTOR B analogWrite (velocidadB, 150); // VELOCIDAD EL MOTOR-B, ES DE 0 (STOP) A 255 (MÁXIMA VELOCIDAD) digitalWrite ( MdireccionB,HIGH); // SENTIDO DE GIRO MOTOR-B, LOW (DELANTE), HIGH (ATRÁS) //MOTOR A analogWrite (velocidadA, 150); // VELOCIDAD EL MOTOR-A, ES DE 0 (STOP) A 255 (MÁXIMA VELOCIDAD) digitalWrite ( MdireccionA,LOW); // SENTIDO DE GIRO MOTOR-A, HIGH (DELANTE), LOW (ATRÁS) } if ((sensorD == 0)& (sensorI == 1)) // DERECHA { //MOTOR B analogWrite (velocidadB, 0); // VELOCIDAD EL MOTOR-B, ES DE 0 (STOP) A 255 (MÁXIMA VELOCIDAD) digitalWrite ( MdireccionB,LOW); // SENTIDO DE GIRO MOTOR-B, LOW (DELANTE), HIGH (ATRÁS) //MOTOR A analogWrite (velocidadA, 150); // VELOCIDAD EL MOTOR-A, ES DE 0 (STOP) A 255 (MÁXIMA VELOCIDAD) digitalWrite ( MdireccionA,HIGH); // SENTIDO DE GIRO MOTOR-A, HIGH (DELANTE), LOW (ATRÁS) } if ((sensorD == 1)& (sensorI == 0)) // IZQUIERDA { //MOTOR B analogWrite (velocidadB, 150); // VELOCIDAD EL MOTOR-B, ES DE 0 (STOP) A 255 (MÁXIMA VELOCIDAD) digitalWrite ( MdireccionB,LOW); // SENTIDO DE GIRO MOTOR-B, LOW (DELANTE), HIGH (ATRÁS) //MOTOR A analogWrite (velocidadA, 0); // VELOCIDAD EL MOTOR-A, ES DE 0 (STOP) A 255 (MÁXIMA VELOCIDAD) digitalWrite ( MdireccionA,LOW); // SENTIDO DE GIRO MOTOR-A, HIGH (DELANTE), LOW (ATRÁS) } } |
Comentarios
Publicar un comentario