Added in the second iteration of the goal finding algorithm