四、控制器设计
如前文所述,倒立摆状态空间方程表明系统能够被控制、被观测。倒立摆或者其它受控系统达到受控稳定状态,其实质上是指系统的各状态量收敛至一目标稳定值。对于状态空间描述而言,系统矩阵A的特征值为负数,对传递函数而言其特征值在复数平面的左半平面系统状态收敛。因此,设计系统控制器,其本质上是对系统极点进行从新配置。理论上,系统矩阵特征值越远离左半平面,收敛速度越快。但实际上,系统状态收敛速度受到外在物理条件限制。
1.系统矩阵极点配置 系统极点配置就是对输入变量u'进行设计,故假设u'=r-KX。其中K=[k1 k2 k3 k4]。化简之后系统 矩阵变为(A-BK),其中BK为对原状态矩阵A进行配置的反馈量。计算det(sI-(A-BK))=0得到加入控制律之后的特征值方程,将特征值方程因式分解,根据实际需求配置合适的极点即可。 适用于低阶(二阶、三阶)状态方程极点配置。
(15)
高阶状态方程极点配置可使用线性代数解法。
2.传递函数描述下的控制器设计
传递函数描述下,需要考虑摆杆起摆的过程,在考虑摆杆镇定问题。以下,先介绍摆杆镇定问题。
在传递函数描述下,常用的控制器是比例-积分-微分组成的控制器或称为PID控制器。由于传递函数只能描述一对输入输出关系,因此,最简单的控制结构就是一个PID控制器。倒立摆模型有四个状态量需要控制,分别为小车位置、小车速度、摆杆角度、摆杆角速度。其中,小车速度量引起摆杆状态变化,小车位置不起直接控制作用。因此,可以先考虑控制小车速度、摆杆角度、摆杆角速度。
对于这三个状态量,可以采用串级PID进行控制,再采用负反馈进行反馈控制。其串级PID控制框图可以表述为
第一个PID控制器对小车速度进行控制,目标值为0m/s、第二个PID控制器对摆杆角速度进行控制,目标值为0rad/s、第三个PID控制器对摆杆角度进行控制,目标值为0°。三个状态量对应有三个负反馈环节。当其中某一个目标值未达到预期范围时,控制器调节过程不会停止。
串级PID控制器仿真:略
其它博文链接:直线型一阶倒立摆1---概念篇
直线型一阶倒立摆2---建模
有需要直线型一阶倒立摆的VREP仿真文件:可点击