This algorithm is an extended Kalman filter which adopts the Cartesian coordinates and pseudomeasurements.

• 通过选取直角坐标及伪测量量构成扩展Kalman滤波。