Fixed compilation by reverting cps init changes - we need to find another approach
Try to add dynamic calibration ot the compass