Have Gazebo stuff working a little better. Yaml dumps work as well