rough magnetometer calibration

I’ll learn the calibration of IMU later.