这是关于EKF的滤波程序,是以组合导航系统为应用背景的。