First commit:
--wall detection by color thresholding
--goal detection by color thresholding and moments to find center point