 int pos4 = 0;
 int pos5 = 0;
 
-//orientation of MPU
-
-int prevX = 0;
-int prevY = 0;
-int prevZ = 0;
-
 int ByteReceived;   // store byte recieved via serial
 
 bool stabilizingOn = false;       // stores wheter self-stabilizing is on.

// SENSORS
long gyroX, gyroY, gyroZ;
float rotX, rotY, rotZ;

// VARIABLES
// Default positions for servos

  upDown.write(pos5);

  // Set up LED
  pinMode(LED_PIN, OUTPUT);
}

// UPDATE
