Use moveit::planning_interface::PlanningSceneInterface to add/remove
collision objects instead of directly publishing.