卡尔曼滤波器算法以及其C语言实现,对您会有很大的帮助的!