Publishing points as point cloud to display on RVIZ everytime coag is pressed