Several changes to robot control
Experimental continous piloting implemented.
Improvements to route calc
Merge branch 'newRobot' into feedback
Two robots with feedback driving
Further improvements
Merge branch 'master' into feedback
Nearest breakpoint, variable travel speed, robot detection status