Tweaks from robot, added erode for goal, switch stops program