use A* to get robot a good path to follow