741351.fig.001
Figure 1: The correction part, where is the real position and is the EKF-estimated position.