bugfix
Merge branch 'master' of https://github.com/KTH-RAS-4/wheatley
moved camera_link in .urdf
Merged with HSV color compare, updated values to compare with