PID的C语言实现，最典型的实现过程。可以在电机调试中使用。