TODO
there is already a tool for this
see TODO
write png; clean shutdown
the idea, but does not work ... do hack
https://github.com/ros/urdfdom/tree/master/urdf_parser_py does not work; get joint names manually, nearly finished, see TODO-next
should work now ... test
works