   }
 }
 
-void setServo(int side, int angle) {
+void setServo(int side, int angle, int servoFix) {
   int servoPwm = getServoPwm(side, angle, servoFix);
   servo.write(servoPwm);
 }

const int MIN_ENGINE_SPEED = 80;

// cmd:
// ^ [1|2] [0-100] | [1|2] [0-100] [0-100]$
// ^direction speed | side   angle  servo-fix$
char START_CMD_CHAR = '^';
char END_CMD_CHAR = '$';

  Serial.print(" ");
  Serial.print(newAngle);
  Serial.print(" ");
  Serial.print(newServoFix);
  Serial.println(END_CMD_CHAR);

  // Side or angle has changed
  if (side != newSide || angle != newAngle || servoFix != newServoFix) {
    setServo(newSide, newAngle, newServoFix);

    side = newSide;
    angle = newAngle;
    servoFix = newServoFix;
    Serial.println("Servo moved");
  }

