   Serial.print(" ");
   Serial.print(newAngle);
   Serial.print(" ");
-  Serial.print(servoFix);
+  Serial.print(newServoFix);
   Serial.println(END_CMD_CHAR);
 
   // Side or angle has changed
-  if (side != newSide || angle != newAngle) {
-    setServo(newSide, newAngle);
+  if (side != newSide || angle != newAngle || servoFix != newServoFix) {
+    setServo(newSide, newAngle, newServoFix);
 
     side = newSide;
     angle = newAngle;
+    servoFix = newServoFix;
     Serial.println("Servo moved");
   }
 

  bluetooth.begin(9600);
  servo.attach(servoPin);

  setServo(side, angle);
  setDirectionPins(direction);
  setEnginePower(direction, speed);
}

  }
}

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