PID算法,写成公式的话就一句话
画成图形形式可能更好理解,算法流程图是这样的
当然,也有现成的代码可以抄,我这儿就有一个
//www.icxbk.com/community/thread-96649-1-1.html
具体算法可以参考下这个:https://wenku.baidu.com/view/db1e22762e3f5727a5e96267.html
我当初用这个移植过,但可能是没理解好,运动不怎么好,最重要还是要理解原理才能设计出适合的算法
先P再I最后D,希望这网址对你有用
https://github.com/search?utf8=%E2%9C%93&q=pid&type=