Adds replanning once we reach goal