Added debug point cloud output