一个C编写的卡尔曼算法程序,用于跟踪定位,大家可以用程序练习一下