PID performance improvement