Adding a collision object to MoveIt!