Added support to urdf export in staticInertiaIdentification