随机卡尔曼滤波器有两个模型,静态和动态,这是动态模型程序