Tweaked PID loop