Improved Gazebo a little more. Added argument to choose whether to include pids on the motors. Without the pids the motion is very good, but robot slides and in some cases the forces get extremely large. Also, fixed/tweaked values in URDF/xacro