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