Helper functions for displaying and debugging MoveIt! data in Rviz via published markers - View it on GitHub