Issue #17: Add color information to published PointCloud2 messages