see Extended Kalman Filter