Fix build for gazebo4