Fix integral gain. Probably only working for Gazebo 3.0