PID values fixed

D value should be negative.