用C语言编写的PID例程，经过调试。有参考价值。