Fix gazebo stuff