magnetometer calibration and basic unscented kalman filter structure added