Added default offset to magnetometer values
Changed CalibrateCompass to rely only on IMU during calibration
Corrected signs in compass