publishes segmented point cloud. need to add coloring code.