How to create hierarchical graph from your robot model (URDF)

First install the liburdfdom-tools

Then