PID loop with derivative filter