finish kalman filter