 #define leftMotorPin1 9
 #define leftMotorPin2 10
 
-#define starterServoPin 7
+#define starterServoPin 15
+
+#define rotateTime 750
 
 // Globals vars
 Servo starterServo;

void rotateRight() {
  setLeftSpeed( 60 );
  setRightSpeed( -60 );
  delay(1500);
  stopMotors();
}


  {
    case 'I': // Initialize
      setLeftSpeed(20);
      break;
    case 'R': // Rotation
      if (serialInput[1] == 'L') rotateLeft();
      else rotateRight();
      break;

    case 'F': // Front direction
      setLeftSpeed( serialInput[1] * 100 + serialInput[2] * 10 + serialInput[3]);
      setRightSpeed( serialInput[1] * 100 + serialInput[2] * 10 + serialInput[3]);
      delay(1500);
      setLeftSpeed( -2 );
      setRightSpeed( -2);
      delay(400);
      stopMotors();
      break;

    case 'B': // Back direction
      setLeftSpeed( (serialInput[1] * 100 + serialInput[2] * 10 + serialInput[3]) * -1);
      setRightSpeed( (serialInput[1] * 100 + serialInput[2] * 10 + serialInput[3]) * -1);

      break;

    case 'S': // Starting block
