Add function to write an urdf file from an RBDyn MultiBody.