bugfix for PID controller (wrong differential part)