扩展卡尔曼滤波算法，具有详细的函数说明，可以根据情况进行调用。