Removed old Gazebo XML handling functions - has been replaced by SDF, various code cleanup