 
   heading *= RAD_TO_DEG;
 }
-
+*/
+
+/*
 void readAltitude() {
   // Get altitude in meters.
   altitude = (altitude * 0.98f) + (barometer.readAltitude() * 0.02f);

  Serial.println(F("Accel initialized"));
  delay(250);

  Serial.println(F("Finding Compass..."));
  compass = HMC5883L();
  int error;

// Hold sensor values and calibration
L3G gyro;
ADXL345 accel;
//HMC5883L compass;
//Adafruit_BMP085 barometer;
int calIdx = 0;
float rollCalibration, pitchCalibration, yawCalibration;
float gyroRollRaw, gyroPitchRaw, gyroYawRaw;
