Added thresholded Kalman filter