编写卡尔曼滤波算法，以匀速直线运动为例，估计运动轨迹和运动速度，以及估计值与真真实值的偏差(kalman filter algorithm,using linear uniform motion as example, eslimate the position.speed,and giving the deviation of estimation value and real value)