Move IMU calibration to main CPU