Add a planner directory
Make use of goal provided by planner
Call directly advance method of robots