URDF import and export support for KDL