Stap 4: Definitieve code voor signaal Cutoff
Servo ThrottleServo;
int PWMpin = 2; Sluit RC ontvanger hier.
int ServoVal;
int RCinput;
VOID Setup
{
Serial.begin(9600);
ThrottleServo.attach(9); de servo op pin 9 hecht aan de servo-object
ThrottleServo.write(97); Ga naar nuetral
pinMode (13, OUTPUT);
}
void loop
{
RCinput = pulseIn (PWMpin, hoog, 20000);
ServoVal = kaart (RCinput, 520, 2370, 0, 180);
if(RCinput== 0) {/ / signaal een time-out!
digitalWrite (13, hoge); WAARSCHUWEN!
ThrottleServo.write(97); Ga naar neutrale gaspedaal positie
}
else {}
digitalWrite (13, laag); alles is prima.
ThrottleServo.write(ServoVal); Herhaal de gegevens van de truck ESC
Serial.Print ("PulseMicros"); Dit deel wordt gebruikt om te zuiveren van de waarden voor kalibratie
Serial.Print(RCinput);
Serial.Print ("ServoRead");
Serial.println(ServoVal);
}
}