now using an organized pointcloud in cube identification