Implement magnetometer calibration (untested)