这是本人参考网上的资料，然后总结写下的PID控制算法，属于最基本的版本，对于后期的参数调节，和算法使用可根据实际情况做调整。就是赚个辛苦费。