Updated message passing in Gazebo