经过测试和设备大批量生产可使用的PID算法程序源码，使用时只需要配合硬件调试下P值、I值和D值，就能应用到自己的系统。本代码原使用环境为做的是PWM控制