A MoveIt1 PR that started working on this is here. https://github.com/ros-planning/moveit/pull/2894