A second order dynamicstate estimator which incorporates the full non-linearities of the measurement function is used for the filtering step.

• 包括完全非线性的测量函数的二阶动态状态估计用于过滤步骤。