An efficient implementation of the second order extended Kalman filter
The unscented Kalman filter for nonlinear estimation