倒立摆自摆起算法,起摆控制采用能量分析法,稳摆控制采用LQR控制,倒立摆模型采用S函数编写,可运行
1