这是一个Kalman Filter的程序，内含状态量为标量和二维矢量的C程序实现