卡尔曼滤波
The conventional extended Kalman filter can be applied with the following substitutions: