Updated to Gazebo 1.3.1