Working Compass Auto Calibrate function