Helper functions for displaying and debugging MoveIt! data in Rviz via published markers