Updated gazebo_ros_pkgs branch