#include "ColorICP.h"
#include "ObjectHypothesis.h"
#include <pcl/point_cloud.h>
#include <pcl/point_types.h>