adds goal to end of path in global_planner, makes move_base's planService search outwards

fixes #207
Previously, this was run before any planning, should it still be called before the first makePlan? (I initially commented on the commit, not the PR, recreating comment here)