Multiple samples using median filter working, but it appears taking a single sample every 40ms performs better