updated PID control function