Move several utilities for roscpp from jsk_pcl_ros