from xacrodoc import XacroDoc
doc = XacroDoc.from_file(path="fanuc_m16ib_support/urdf/fanucM16ib.urdf")
urdf_str = doc.to_urdf_string()
doc.to_urdf_file("urdf/fanucM16ib.urdf")