Handle virtual link with mass=0 in urdf and continuous joint type
Add Urdf2Graphviz function
Add basic robotgui
Add robot joint position gui