倒立摆在matlab的simulink库下的仿真

1、倒立摆在matlab的simulink库下的仿真倒立摆是处于倒置不稳定状态，人为控制使其处于动态平衡的一种摆。对于 倒立摆系统的控制研究长期以来被认为是控制理论及其应用领域里引起人们极 大兴趣的问题，倒立摆系统是一个典型的快速、多变量、非线性、不稳定系统。 研究倒立摆控制能有效地反映控制中的许多问题，倒立摆研究具有重要的理论价 值和应用价值，理论上，它是检验各种新的控制理论和方法的有效实验装置。应 用上,倒立摆广泛应用于控制理论研究!航空航天控制，机器人、杂技顶杆表演等 领域，在自动化领域中具有重要的价值。另外，由于此装置成本低廉，结构简单，便于 用模拟、数字等不同方式控制，在控制理论教学和科

2、研中也有很多应用。本论文中，以一级倒立摆为研究对象，对它的起摆以及稳定控制做了研究，主 要研究工作如下：1. 首先介绍了倒立摆系统的组成和控制原理，建立了一级倒立摆的数学模型, 对倒立摆系统进行定性分析，但在平衡点是能控的、能观的。2. 分析了倒立摆的起摆过程，对倒立摆的起摆能量反馈控制进行分析与说明。3. 在matlab2014a的siinuliiik库下对倒立摆构造单级倒立摆状态反馈控制系 统的仿真模型和构造具有状态观测器的单级倒立摆状态反馈控制系统的仿真模 型。4. 对这次仿真的总结。一、倒立摆的控制目标倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置，并且使之没有大的 振荡和过大的角度

3、和速度。当摆杆到达期望的位置后，系统能克服随机扰动而保 持稳定的位置。二、建立单级倒立摆系统的状态空间模型其中，质量为M的小车在水平方向滑动，质量为m的球连在长度为L的刚 性摆一端，x表示小车的位移，u是作用在小车上的力，通过移动小车使带有小 球的摆杆始终处于垂直的位置。为了简单起见，假设小车和摆仅在一个平面内运 动，且不考虑摩擦、摆杆的质量和空气阻力。如图1设系统的动态特性可以用小车的位移和速度及杆偏离垂线的角度e和角速 度&來描述。设小车位移为x,则小球中心位置是x + lsm&在水平方向，应用牛顿第二定律:d2 xdF+md2(x + Z sin 0) = u在垂直于摆杆

4、方向，应用牛顿第二定律： j2m -5- (x + Z sin 0) = mg sin &求微分方程得：2(sin&) = (cos&) &dtd 2(sin 0) = (- sill 0) - O2 + cos&&Q(cos0) = (-sin&)0 dtd25- (cos 0) = (- cos &) & + (- sin &) &化简得(M + uumy ml 6 mg 6线性化：当和较小时，有冋和同较小时，有sing 0cos&a 1化简得严-些0 +丄况MM选择状态变量小车的位移、小车的速

5、度、小车的角度、小车的角速度分别为兀2 = y 0兀4 = 9u为输入,A'0100_Tx200Mg0x2+i0001兀3000(M+m)g Ml0勺1_ a7/_y为系统的输出u状态图为三、单级倒立摆系统的极点配置1.状态反馈系统的极点配置及其MATLAB/Simulink仿真取适当的参数M小车质量0. 1 Kgm小球质量0. OlKg1摆杆的长度lmu加在小车上的力y小车位移0摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下将参数代入后得到新的矩阵接下来使用matlab和线性系统的能控性判据，通过是否为满秩来判断能控 性命令行窗口» A=LO 1 0 0:0 0 -

6、1 0:0 0 0 1:0 0 11 0J ;B=EO; 1 :0 ：-1:C=E1 0 0 0;rct=rank (ctrb根据判别系统能控性的定理，该系统的能控性矩阵满秩，所以该系统是能控 的。因为系统是能控的，所以，可以通过状态反馈来任意配置极点。不失一般性，不妨将极点配置在© = 6 s2 = 6.5 s3 = 7 s4 = 7.5在matlab下输入命令弟令仃阖|_1» A=LO 1 0 0:0 0 -1 0:0 0 0 1:0 0 11 0：B=0: 1 :0 ;-1:p= -6 -6. 5 -7 -7. 5:K=place(A, E7p)K =-204. 75

7、00 -122.1750 -488.5000 -149. 1750得到状态反馈矩阵为K = -2M,75 -122.175 - 488.5 -149.175采用MATLAB/Simuluik构造单级倒立摆状态反馈控制系统的仿真模型，如下图所示。Matrix AMat ix K首先，在MATLAB的Command Window中输入各个矩阵的值，并且在模型中的积分器 中设置非零初值（这里我们设置为0 0 0.1 0。然后运行仿真程序。得到的仿真曲线从仿真结果可以看出，可以将倒立摆的杆子与竖直方向的偏角控制在&=0 （即小球和杆子被控制保持在竖直倒立状态），另外说明下黄线代表位移，紫线 代

8、表角度。2.设计状态观测器实现状态反馈极点配置及其仿真首先，使用MATLAB,判断系统的能观性矩阵是否为满秩。输入以下程序命令行窗口» A=LO 100:00 -10:0001:00 11 OJ;B=CO; 1 ;0 ;-l;C=：l 0 0 0:0 0 1 0：rob=rank (obsv(A, C)因为该系统的能观测性矩阵满秩，所以该系统是能观测的。因为系统是能观 测的，所以，可以设计状态观测器。而系统又是能控的，因此可以通过状态观测 器实现状态反馈。设计状态观测器矩阵，使的特征值的实部均为负，且其绝对值要大于状态反 馈所配置极点的绝对值。通过仿真发现，这样才能保证状态观测器有足

9、够快的收 敛速度，才能够保证使用状态观测器所观测到的状态与原系统的状态充分接近。 不妨取状态观测器的特征值为：s】=-20s2=-21s3 = 22s4=-23输入以下的命令命令彳苕口» A=C01 0 0:00 -1 0:0 0 0 1:0 0 11 0A1=AJ :C=l 00 0;0 01 o;CK1 ;P=-20-21 -22-23:Gl=place (Al, Cl, P):G=GT42.85141. 0395458.356521. 39140.938443. 148620.1527475.6411得到状态观测器矩阵G如果釆用MATLAB/Simulink构造具有状态观测器的单级倒立摆状态反馈控 制系统的仿真模型，如下图所示。Matrix K首先，在MATLAB的Command Window中输入各个矩阵的值，并且在模型 中的积分器中设置非零初值这里设置初值为0 0 0.1 0o然后运行仿真程序。得 到的仿真曲线。从仿真结果可以看出，可以将倒立摆的杆子与竖直方向的偏角控制在&=0（即小球和杆子被控制保持在竖直倒立状态），另外说明下黄线代表位移，紫线 代表角度。3 总结由仿真结果对比可知，加不加观测器都可以很好的控制摆杆不倒，完全可以 达到控制要求。但是加观测器的系统控制效果要优于没有加观测器的系