- todo updated
Merge branch 'Simulation' of https://github.com/villj2/ch.bfh.bti7301.searchrobot into Simulation
- after collision go back to last valid waypoint