Optimized Filtering

Based on observing signal while ball spun by hand, optimized algorithm
to filter velocity output. Currently loop runs at 1 kHz, discards
samples where Motion = 0 (since this almost never happens in reality)
unless there are 30 Motion = 0 samples in a row. Then filters output
with a time constant of 10 samples (10ms at this rate)