Compass calibration

Porting kingfisher style compass calibration script to the husky. Ideally, we could have a clearpath general package with this kind of script because it applies to all our platforms with slight modifications on control output  and debug messages.