状态反馈地倒立摆PID控制

《状态反馈地倒立摆PID控制》由会员上传分享，免费在线阅读，更多相关内容在工程资料-天天文库。

1、实用文档基于LMI的单级倒立摆的状态反馈PID控制摘要本文以单级倒立摆为研究对象，通过物理规律得到系统的传递函数和状态方程，并结合状态反馈的概念，将约束条件转化为线性矩阵不等式求解反馈矩阵并得到PID控制器，最后进行MATLAB仿真得到仿真曲线进行对比分析指出该方法的优缺点。关键字单级倒立摆PIDMATLABLMI状态反馈前言倒立摆系统是一种典型的非线性的，不稳定的复杂系统。是控制理论教学与科研中研究诸如鲁棒问题、非线性系统的控制等问题的良好实验对象。同时，倒立摆系统作为机器人行走中平衡控制、火箭垂直姿态控制和

2、卫星飞行中姿态控制的最简单模型在航空航天以及军工等领域有着广泛的用处。倒立摆可以根据摆杆数量的不同分为一级、二级和三级等，多级摆杆间采用自由连接。一级倒立摆的仿真与控制已广泛应用于教学科研，而二级倒立摆也已在大部分实验室中实现，至于三级倒立摆的控制问题则是国际上公认的难题。然而我国学者李洪兴教授在2002年实现了国际上首次四级倒立摆实物系统的控制，这是我国学者采用自己提出的理论完成世界性难题的重大科学成就。本文中以单级倒立摆为研究对象，根据物理定律进行建模得到数学模型，在此基础上进行PID控制，并通过MATLA

3、B仿真对比加入PID控制器前后的响应曲线进行分析。数学模型的建立直线一级倒立摆是由小车、摆杆等部件构成。现假设有一个一级倒立摆系统，其中摆杆的长度为，，质量为，小车质量为，为作用在小车上的外力，为摆杆与垂直向上方向的夹角，为小车的水平位移。若不考虑小车与导轨，摆杆与小车之间的摩擦并且不计各种空气阻力，则倒立摆系统的受力分析如图1所示。标准文案实用文档Figure1规定摆杆重心的坐标为，则采用隔离法，对小车有(1)其中为摆杆所受沿水平方向的力。对于摆杆，在水平方向上有(2)在竖直方向上有(3)其中为摆杆所受沿垂直

4、方向的力。以摆杆质心为旋转中心建立动力学方程有(4)其中为摆杆绕其质心的转动惯量。标准文案实用文档此时，发现(2)(3)(4)均为非线性方程，为了简化计算并且便于进行控制器设计，要对上述方程进行近似线性化处理。由于控制目标是使摆杆处于垂直稳定状态，即尽可能的小，甚至接近于，因此可以认为、、、。这里需要注意，因此方程(2)(3)(4)化为(5)(6)(7)消去中间变量、，由(1)(5)式得到(8)由(6)(7)式得到(9)由(8)(9)得到单级倒立摆方程(10)(11)设小车的质量为，摆长为，摆杆质量为，重力加速

5、度取带入上述方程，可以得到角度与外力之间的传递函数，(12)标准文案实用文档由于系统有位于复平面右半平面的极点显然其不稳定，在阶跃函数作用下的响应的响应曲线如下图所示，同样说明系统是不稳定的，因此需要加入PID控制来改变系统的性能。Figure2状态反馈PID设计令，，，建立状态方程，则由(10)(11)可得倒立摆系统的状态方程为(13)其中，，，接下来我们要用状态反馈的方法设计此倒立摆系统的PID控制器。采用文献[4]的方法，在控制输入点之前引入一个积分环节，其中给定。记，，因此得到增广系统的状态方程(14)

6、标准文案实用文档设状态反馈(14)(16)因为，则可逆，从而可以将控制输入用状态及状态的导数表示，即(17)将上式代入(16)式中，得到(18)记为，为，在零初始条件下对上式积分得到(19)可以看出这是状态反馈加状态积分反馈的形式。如果能够找到一组状态变量，使得状态反馈就是比例积分加微分，那么该状态反馈策略就是PID控制。对于阶系统，微分部分包括了系统从阶到阶的微分；若是二阶系统，该部分就是一个工程中常用的PID控制器。现在讨论反馈增益矩阵，使得增广系统满足稳定的指标。即设计反馈矩阵使得闭环系统稳定。此时闭环系

7、统的状态方程为(20)根据Lyapunov理论可得，存在对称正定矩阵使得(21)在上式左右两边左乘，右乘，并令则得到标准文案实用文档(22)这是关于与的线性矩阵不等式，又由于正定则正定，因此上述LMI可以改写为(23)通过MATLAB可以求得与，由此可以解出对称正定矩阵与反馈增益。下面通过MATLAB进行仿真和计算。仍然采用之前仿真时使用的小车质量与摆杆质量等数据，可以得到增广系统的状态方程的系数为，通过MATLAB计算可得反馈增益为，因此，，代入控制器的表达式中得到，仿真曲线图如下所示。标准文案实用文档Fig

8、ure3Figure4标准文案实用文档Figure5Figure6标准文案实用文档Figure7结论由图2可知系统在没有控制其作用下是不稳定的，通过状态反馈PID控制之后的系统状态的响应曲线分别为图3~6，可以看出，只在稳定的约束下，系统的四个状态可以在18秒左右达到稳定，证明方法的可行性。同时也发现了只对稳定性约束时的不足，即系统达到稳定所需的时间过长，为此可以在考虑稳定性的条件下加