Image converter from ROS to OpenCV + Color recognition + Shape recognition