Found error in PID. The d-portion was not working