Added visited set to global_planner A* 

This change was made to prevent loops, to improve speed, and for correctness.

(Thanks to Sachi Hemachandra.)
This is not needed because the outlineMap function is called. https://github.com/ros-planning/navigation/blob/hydro-devel/global_planner/src/planner_core.cpp#L55