Paso 7: código de
básicamente cuando el sensor está a metro y medio de la pared, los servos deben empezar a trabajar
#define trigPin 12
#define echoPin 11 #include
Servo servoOne; Servo servoTwo; Servo servoThree; Servo servoFour; void setup() {Serial.begin (9600); pinMode (trigPin, salida); pinMode (echoPin, entrada); servoOne.attach(3); servoTwo.attach(5); servoThree.attach(6); servoFour.attach(9);}
void loop() {int duración, distancia, pos = 0, i; digitalWrite (trigPin, bajo) delayMicroseconds(2); digitalWrite (trigPin, alto); delayMicroseconds(10); digitalWrite (trigPin, baja); duración = pulseIn (echoPin, HIGH); distancia = (duración/2) / 29,1; Serial.Print(Distance); Serial.println ("cm"); if(Distance<150) {servoOne.attach(3); servoTwo.attach(5); servoThree.attach(6); servoFour.attach(9); servoOne.write(180); servoTwo.write(180); servoThree.write(180); servoFour.write(180); delay(30000); / / / / servoOne.detach(); / / servoTwo.detach(); / / servoThree.detach(); / / servoFour.detach(); / / delay(2000); servoOne.write(0); servoTwo.write(0); servoThree.write(0); servoFour.write(0); delay(30000);} else {servoOne.detach(); servoTwo.detach(); servoThree.detach(); servoFour.detach();} delay(100); }
