New iterated extended kalman filter