Stap 7: Code
in principe wanneer de sensor een en een halve meter van de muur is, de servo's moeten aan de slag
#define trigPin 12
#define echoPin 11 #include
Servo servoOne; Servo servoTwo; Servo servoThree; Servo servoFour; void setup {Serial.begin (9600); pinMode (trigPin, OUTPUT); pinMode (echoPin, INPUT); servoOne.attach(3); servoTwo.attach(5); servoThree.attach(6); servoFour.attach(9);}
void loop {int duur, afstand, pos = 0, ik digitalWrite (trigPin, laag); delayMicroseconds(2); digitalWrite (trigPin, hoge); delayMicroseconds(10); digitalWrite (trigPin, laag); duur = pulseIn (echoPin, hoge); afstand = (duur/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); }