updated to allow the global planner to optimize the goal location such that if there is a close by cell with a lower obstacle cost - it will modify this to be the goal - configurable using clear_goal_tolerance
updated with the comments
Merge pull request #13 from bosch-ros-pkg/global_planner_goal_threshold

Feature to allow the global planner to find a close by point with a better clearance from obstacles