Modefilter

@priseborough @dominiho This adds a mode filter to reject ultrasound spikes. Tested in unit test, not tested on device yet. A quick test would be appreciated (please include the plot of the test here).