more pathfinding
Merge branch 'master' of https://github.com/laurentN/RoboSim.git
Merge branch 'master' of https://github.com/laurentN/RoboSim.git