disparity_image_proc: Work in progress, based off stereo_image_proc pointcloud2 nodelet