Étape 5 :
#include < Servo.h >
Servo myservo ;
Servo myservo2 ;
const int pingPin = 50 ;
const int pingPin2 = 52 ;
void setup() {}
Serial.Begin(9600) ;
myservo.Attach(10) ;
myservo2.Attach(11) ;
}
void loop()
{
longue durée, pouces, cm ;
pinMode (pingPin2, sortie) ;
digitalWrite (pingPin2, basse) ;
delayMicroseconds(2) ;
digitalWrite (pingPin2, HIGH) ;
delayMicroseconds(5) ;
digitalWrite (pingPin2, basse) ;
pinMode (pingPin, entrée) ;
durée = pulseIn (pingPin, HIGH) ;
po = microsecondsToInches(duration) ;
cm = microsecondsToCentimeters(duration) ;
Si {(pouces < 5)
myservo.writeMicroseconds(2000) ;
myservo2.writeMicroseconds(2000) ;
}
Si {(pouces > 5)
myservo.writeMicroseconds(1000) ;
myservo2.writeMicroseconds(1000) ;
}
Serial.Print(inches) ;
Serial.Print ("in") ;
Serial.Print(cm) ;
Serial.Print("cm") ;
Serial.println() ;
Delay(100) ;
}
long microsecondsToInches(long microseconds)
{
retourner les microsecondes / 74 / 2 ;
}
long microsecondsToCentimeters(long microseconds)
{
retourner les microsecondes / 29 / 2 ;
}