Franziska Kunert (Abstandsschalter)

#include <AFMotor.h>


 

AF_DCMotor motor1(1, MOTOR12_64KHZ); // create motor #1, 64KHz pwm
AF_DCMotor motor2(2, MOTOR12_64KHZ); // create motor #2, 64KHz pwm

int sensor = 40;

void setup() {
  motor1.setSpeed(150);    
  motor2.setSpeed(150);
  pinMode(sensor, INPUT);
}

void loop() {   
    if(digitalRead(sensor) == HIGH){
       motor1.run(BACKWARD);
       motor2.run(BACKWARD);
       delay(3000);
       motor1.run(BACKWARD);
       motor2.run(FORWARD);
       delay(3000);
    }
    else{
         motor1.run(FORWARD);     
         motor2.run(FORWARD);
         delay(5000)
         motor1.run(RELEASE);     
         motor2.run(FORWARD);
         delay(3000)
         motor1.run(RELEASE);     
         motor2.run(RELEASE);
         delay(3000)
         motor1.run(FORWARD);     
         motor2.run(FORWARD);
         delay(5000)
         motor1.run(FORWARD);     
         motor2.run(RELEASE);
         delay(3000)
        
         
     }

}