Robust extended Kalman filter (REKF)