Compass autocalibration

Compass autocalibration method added