CalibrateMagneto

Background calibration for magnetometers, both gain and offset errors are removed (hard/soft iron).