More progress on point clouds shape detection
Starting to finalize point cloud shape finding