PID algorithm demonstration