Added status for robot detection
Merge branch 'master' into feedback
Nearest breakpoint, variable travel speed, robot detection status