Ir al contenido principal

L298N y TCRT5000

 

Conexión y programa de dos motores controlados con un puente H L298N y con dos sensores infrarrojos TCRT5000


Código


//DECLARACION MOTOR A CON L298N
const int ENA=9;
const int IN1=8;
const int IN2=7;

//MOTOR B
const int ENB=3;
const int IN3=4;
const int IN4=5;

//PUEDES MANIPULAR VELOCIDAD ENTRE 0-255
int vel=200;

//Sensores infrarrojos TCRT5000
const int senDer=10;
const int senIzq=13;


void setup() {
  pinMode(ENA,OUTPUT);
  pinMode(IN1,OUTPUT);
  pinMode(IN2,OUTPUT);
  pinMode(ENB,OUTPUT);
  pinMode(IN3,OUTPUT);
  pinMode(IN4,OUTPUT);
  pinMode(senDer,INPUT);
  pinMode(senIzq,INPUT);

}

void loop() {
  if(digitalRead(senIzq)==1 && digitalRead(senDer)==1){
    avanzar();
  }
  if(digitalRead(senIzq)==0){
    detenerse();
    reversa();
    delay(2000);
    giroDer();
    delay(2000);
  }
  
}


void avanzar(){
  analogWrite(ENA,vel);
  digitalWrite(IN1,LOW);
  digitalWrite(IN2,HIGH);
  analogWrite(ENB,vel);
  digitalWrite(IN3,LOW);
  digitalWrite(IN4,HIGH);  
}
void detenerse(){ 
}

void reversa(){
}

void giroDer(){
}




Revisión del Código:

Primero, analiza detenidamente el código que has escrito para controlar tu sumo bot con Arduino. Trata de comprender su funcionalidad y el propósito de cada sección.

Funciones Faltantes:

Observarás que hay secciones importantes faltantes en tu código, como las funciones para detener, retroceder y girar a la derecha. Es crucial completar estas funciones para asegurar el funcionamiento adecuado de tu sumo bot.

Mejorar el Comportamiento:

Considera cómo deseas que se comporte tu vehículo. ¿Debería detenerse al detectar la línea blanca? ¿Cómo debería realizar la marcha atrás y los giros? Realiza modificaciones en tu código para que el vehículo se adapte a tu estrategia específica.

Realiza Pruebas:

Carga el código en tu microcontrolador (Arduino UNO o nano) y realiza pruebas prácticas. Observa cuidadosamente su comportamiento y verifica si cumple con tus expectativas.

Ajustar Velocidades y Tiempos:

Es posible que necesites ajustar la velocidad y los intervalos de tiempo en tu código, lo cual dependerá del tipo de motores que hayas seleccionado y de la estrategia que estés implementando. Experimenta con diferentes valores hasta que estés satisfecho con el rendimiento del vehículo.

Hacer Notas y Comentarios:

Añade notas y comentarios en tu código para explicar el propósito de cada sección. Esto te ayudará a comprender mejor el código y también será útil para otras personas que revisen tu trabajo.