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)
}
}