Fixed D in PID!

The D term was the wrong sign! That caused the slides and arm to move
erratically. Fixed now. Also changed some PID parameters to make lift
smoother.