Beispiel #1
0
void loop() {
    const auto sp = ppm_sp.as_float();
    const auto rl = ppm_rl.as_float();

    const auto speed_r = (sp-rl)*0.5f;
    const auto speed_l = -(sp+rl)*0.5f;
    Serial.print(speed_r); Serial.print(' '); Serial.println(speed_l);

    motor_r.set_speed(speed_r);
    motor_l.set_speed(speed_l);
}