Étape 4: Code Final pour coupure de Signal
Servo ThrottleServo ;
int PWMpin = 2 ; Connectez le récepteur RC ici.
int ServoVal ;
int RCinput ;
void setup()
{
Serial.Begin(9600) ;
ThrottleServo.attach(9) ; attache le servo sur la broche 9 à l’objet de servo
ThrottleServo.write(97) ; aller à nuetral
pinMode (13, sortie) ;
}
void loop()
{
RCinput = pulseIn (PWMpin, haute, 20000) ;
ServoVal = carte (RCinput, 520, 2370, 0, 180) ;
if(RCinput== 0) {/ / Signal a expiré !
digitalWrite (13, HIGH) ; ATTIRER L’ATTENTION !
ThrottleServo.write(97) ; Aller à la position neutre gaz
}
else {}
digitalWrite (13, faible) ; tout va bien.
ThrottleServo.write(ServoVal) ; Répéter les données à ESC du camion
Serial.Print ("PulseMicros") ; Cette partie est utilisée pour déboguer les valeurs d’étalonnage
Serial.Print(RCinput) ;
Serial.Print ("ServoRead") ;
Serial.println(ServoVal) ;
}
}