Python tools to construct a KDL tree from an XML robot representation in URDF
https://wiki.ros.org/kdl_parser_py