目前来说大部分做倒立摆的都是用的PID算法,算法方面这里有篇文章可以参考一下基于STM32的单级旋转倒立摆控制系统的设计与实现_王立谦.pdf
你不如说一下具体遇到了什么困难,代码方面的还是说物理学方面的
建議您可以看加州大學的碩士論文,文末有附整個演算法(PID)的Code,了解精神以後在下手去改
4 22 09 Jose Miranda(1).pdf
以上