An Eigen tool to visualize in Rviz locomotion-related geometric objects - View it on GitHub