Added oscillation detection and filled in more gazebo parameters