Clean up the SDFormat file creation using the lxml library. This should produce better-formatted files than the current manual string formatting. This does not matter much for the sim2sim pipeline but will be nice once we want to export the SDFormat files for external distribution. See this repo for example usage.