本人手写的简单的平方根无迹卡尔曼滤波程序,包含注释,对刚接触滤波算法的新手有一定帮助,可以适当参考。