Add de-jitter
De-jitter using median value between old and new reading