Smoothing of position samples
Quick & hacky controller
Differential position sensing
Merge branch 'dual-sensors'

Conflicts:
	src/main.cpp
Improved debug output
Add position sensor test results