Fix compass's offset in calculation
Merge branch 'fix/compass_calc' into develop