Cleaned up controller code,

Added then commented out changing the goal black