odometry for floordetection
Merge branch 'master' into camusb

Conflicts:
	robot_controller.cpp
Merge branch 'camusb' into tmp
fix horizon