calibration of strapdown magnetometers in the magnetic field domain .
A New Extension of the Kalman Filter to Nonlinear Systems