Updated pcl_snapshot to take snapshots and publish and also read file and publish