Added HSV translation code and basic goal finding