Added filtering to rangefinder data. You can specify a number of samples
to take for each reading. It will drop the high and low samples then
aferage the rest.