Set velocity to zero when MADQG sample is rejected
Median-sliding-window TF EKF