用C语言编写仿真程序，主要功能是卡尔曼滤波算法的实现。