This section first describes the use of the EKF to estimate the state variables and their corresponding covariances based on the system and measurement models.
A strategy is proposed to eliminate abnormal GPS measurements.