kalman filter only for constant velocity