Changed to just use integral control on the top right motor to eliminate
some noise, and softened up the response of the controller a bit.