Added the a node that subscribe and republish a point cloud. I also cleaned the code a little bit.