Removed compass calibration function because it somehow breaks wifly...