卡尔曼滤波算法的推导与C语言实现,可以作为参考资料。