#define trigPin 2 #define echoPin 10 int m1b = 3; int m1f =5; int m2f = 6; int m2b = 9; void setup(){ pinMode(m1f, OUTPUT); pinMode(m1b, OUTPUT); pinMode(m2f, OUTPUT); pinMode(m2b, OUTPUT); pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); } void loop(){ int duration, distance; digitalWrite(trigPin, HIGH); delayMicroseconds(1000); digitalWrite(trigPin, LOW); duration = pulseIn(echoPin, HIGH); distance = (duration/2) / 29.1; if (distance >= 25){ digitalWrite(m1f, HIGH); digitalWrite(m1b, LOW); digitalWrite(m2f, HIGH); digitalWrite(m2b, LOW); delay(100); } else { digitalWrite(m1f, HIGH); digitalWrite(m1b, LOW); digitalWrite(m2b, HIGH); digitalWrite(m2f, LOW); delay(800); } }