Detector d'obstacles KY-032 (Cinta corredera de supermercat)

• Targeta WemosD1R32
• Escut L298
• Motor de continua amb reductora.
• Piles de 1.5V
• Portapiles
• Engranatge gran
• Engranatge petit
• Detector d'obstacles KY_032
• Fustes variades per contruir la cinta corredera
• Cables mascle-mascle i mascle-femella d'Arduino

Fes el muntatge següent:

Fes el programa aquest:

boolean senyal_detectada = 0;
int pinDetector = 4 ;

// Funció Motor A Horari
void Motor_A_Horari() {
  Serial.println("Escut L298 motor A Horari");
  Serial.println("Activem IN1=18");
  digitalWrite(18, HIGH);
  Serial.println("Desactivem IN2=19");
  digitalWrite(19, LOW);
}


// Funció Motor A antiHorari
void Motor_A_antiHorari() {
  Serial.println("Escut L298 motor A antiHorari");
  Serial.println("Desactivem IN1=18");
  digitalWrite(18, LOW);
  Serial.println("Activem IN2=19");
  digitalWrite(19, HIGH);
}


//Funció Atura motor A
void Atura_Motor_A() {
  Serial.println("Escut L298 motor A aturat");
  Serial.println("Desactivem IN1=18");
  digitalWrite(18, LOW);
  Serial.println("Desactivem IN2=19");
  digitalWrite(19, LOW);
}



void setup() {
  pinMode(18, OUTPUT);
  pinMode(19, OUTPUT);
  Serial.begin(115200);
  pinMode(pinDetector, INPUT);

}

void loop() {
    senyal_detectada = digitalRead(pinDetector);
    Serial.println("Senyal_detectada =");
    Serial.println(senyal_detectada);
    if (senyal_detectada == 0) {
      Atura_Motor_A();
      Serial.println("Si  hi ha obstacles");
      Serial.println("Cal aturar la cinta");
      delay(1000);

    }// final if
    if (senyal_detectada == 1) {
      Motor_A_antiHorari();
      Serial.println("No hi ha obstacles");
      Serial.println("Cal moure la cinta");
      delay(1000);

    }// final if

}// Final programa

Abans de provar-lo pensa que depenent de la forma de soldar els cables al motor et caldrà usar la funció Motor_A_Horari o Motor_A_antiHorari, per fer que la cinta correga en la direcció d'on tens el detector d'obstacles. Si la cinta al correr allunya els paquets del detector et caldrà canviar dins del IF la funció esmentada.