Added the check to see if the goal has been sent to the global planner, and thus not pause when it's seen