PID算法源码(有注释).,C与C++可用,可以集成到自己程序中