Fixed pointcloud to cv::Mat
Voxelfilter and outline filter work , but not tuned