finishing kalman filter