Script for converting simmechanics XML files to URDF