PID algorithm demo program