一级倒立摆分析.

1一级倒立摆的极点配置及仿真摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，是学习和研究现代控制理论最合适的实验装置。倒立摆的控制是控制理论应用的一个典型范例，一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。本文主要研究的是一级倒立摆，首先应用动力学方程建立一级倒立摆的非线性数学模型，采用小偏差线性化的方法在平衡点附近局部线性化得到线性化的数学模型。然后通过输入单位阶跃信号分析系统的开环稳定性，由线性化得到的状态方程判断系统的能控性和能观性，结合系统的稳定性条件、调整时间以及超调量找到合适的极点，运用极点的配置方法（Matlab的acker函数）算出状态反馈增益矩阵K，运用状态空间分析方法，采用状态反馈为倒立摆系统建立稳定的控制律，并判断加入反馈矩阵K后的能观性和能控性是否改变。最后应用Matlab中的Simulink建立相应框图，得到输出变量水平位置和角度随时间的变化曲线，验证加入反馈矩阵K后一级倒立摆系统的稳定性。关键词：一级倒立摆状态反馈极点配置MatlabSimulink2目录1、一级倒立摆系统简介...........................................................................................32、一级倒立摆系统的数学模型............................................................................42.1、数学模型的建立..........................................................................................42.2、运动分析.........................................................................................................52.2.1、沿水平方向运动（直线运动）...................................................52.2.2、绕轴线的转动（旋转运动）........................................................73、状态空间极点配置................................................................................................93.1、系统开环稳定性分析................................................................................93.2、开环系统的能控性分析..........................................................................113.3、开环系统的能观性分析..........................................................................123.4、系统极点配置.............................................................................................133.5、闭环系统的能控性和能观性分析......................................................164、一级倒立摆系统Matlab仿真...........................................................................174.1、系统开环Simulink搭建及仿真..............................................................174.2、系统极点配置后的Simulink仿真.........................................................205、总结........................................................................................................................246、参考文献...............................................................................................................2531、一级倒立摆系统简介倒立摆系统是一种很常见的又和人们的生活密切相关的系统，它深刻揭示了自然界一种基本规律，即自然不稳定的被控对象，通过控制手段可使之具有良好的稳定性。倒立摆系统是一个非线性，强耦合，多变量和自然不稳定的系统。它是由沿导轨运动的小车和通过转轴固定在小车上的摆杆组成的。在导轨一端装有用来测量小车位移的电位计，摆体与小车之间由轴承连接，并在连接处安置电位器用来测量摆的角度。小车可沿一笔直的有界轨道向左或向右运动，同时摆可在垂直平面内自由运动。直流电机通过传送带拖动小车的运动，从而使倒立摆稳定竖立在垂直位置。图1一级倒立摆装置简图由图1中可以看到，倒立摆装置由沿导轨运动的小车和通过转轴固定在小车上的摆体组成。导轨的一端固定有位置传感器，通过与之共轴的轮盘转动可以测量出沿导轨由图中可以看到，倒立摆装置由沿导轨运动的小车和通过转轴固定在小车上的摆运动的小车位移；小车通过轴承连接摆体，并在小车与摆体的连接处固定有共轴角度传感4器，用以测量摆体的角度信号；并通过微分电路得到相应的速度和角速度信号；导轨的另一端固定有直流永磁力矩电机，直流电机通过传送带驱动小车沿导轨运动，在小车沿导轨左右运动的过程中将力传送到摆杆以实现整个系统的平衡。倒立摆的种类很多，有悬挂式倒立摆、平行式倒立摆、和球平衡式倒立摆；倒立摆的级数可以是一级，二级，乃至更多级。控制方法也是多种，可以通过模糊控制，智能控制，PID控制，LQR控制等来实现倒立摆的动态平衡，本文介绍的是状态反馈极点配置方法来实现一级倒立摆的控制。2、一级倒立摆系统的数学模型2.1、数学模型的建立一级倒立摆系统示意图如下图所示，系统由小车、小球和轻质杆组成。倒摆通过转动关节安装驱动小车上，杆子的一端固定在小车上，另一端可以自由地左右倒下。通过对小车施加一定的外部驱动力，使倒摆保持一定的姿势。5图2一级倒立摆系统示意图一级倒立摆系统所用到的各变量的取值及其意义如下表1所示：表1各变量的取值及其意义变量符号变量意义变量取值M小车质量2.0kgm小球的质量0.1kgl倒摆的杆长0.5mg重力加速度9.81m/s^2(t)倒摆偏离垂直方向的角度角度随时间变化u(t)小车受到的水平方向的驱动力驱动力u随时间变化2.2、运动分析假设轨道是光滑的，忽略摆杆的质量，系统所受的外力包括小球受到的重力和小车水平方向的驱动力u。x(t)和(t)分别表示小车的水平坐标和倒摆偏离垂直方向的角度。由此分析可知一级倒立摆有两个运动自由度：一个是沿水平方向运动（直线运动）；另一个是绕轴线的转动（旋转运动）。2.2.1、沿水平方向运动（直线运动）通过受力分析，由牛顿第二运动定律，系统的运动满足下面的方程：6图3倒立摆系统水平方向受力分析图X轴方向：uxdtdmxdtdMG2222①小球的重心坐标满足：cossinlylxxGG②将小球的重心坐标代入①式得：ulxdtdmxdtdM)sin(2222③联立①②③式得：umlmlxmM..2...)(cos)(sin)(XYFyFxGx水平方向受到的合外力竖直方向受到的合外力),(GGyx72.2.2、绕轴线的转动（旋转运动）图4倒立摆系统转动受力分析图小球的力矩平衡方程：lmglFlFyx)sin()sin()cos(④④式中xF、yF分别为：...222...2..22])(sin)(cos[])(cos)(sin[llmydtdmFllxmxdtdmFGyGx⑤将⑤式代入④式整理得：sincos....mgmlxm最后得到倒立摆系统的动力学方程为：XYFyFxGxL8.......2..sincos)(cos)(sin)(mgmlxmumlmlxmM⑥显然该系统为明显的非线性系统。但是对小车施加驱动力的目的是要保持小球在垂直方向的姿态，因此，我们关注的是小球在垂直方向附近的动态行为变化，为此将系统在该参考位置（＝0）附近进行线性化处理。2.3、模型转化(微分方程→状态方程)由倒摆系统的动力学模型⑥式，取如下状态变量：1Z1..2ZZxZ3.3.4ZxZ可得到倒摆系统的状态方程：12112214122211112..cossincos)(sin)(cos)sin(cossin)(coszmmMzzmgzzmluzlmMzmlzzzmlzgmMzuzxxdtdzdtd2.4、状态方程的线性化采用Jacobian矩阵线性化模型，最终得到系统的线性化状态方程为：9uMMlzMmgMlgmMdtdz10100001000000)(0010假定系统的输出为倒摆的角度和小车的x轴坐标，则系统的输出方程为：..00100001xxCZxy3、状态空间极点配置3.1、系统开环稳定性分析由状态方程的标准形式：XAXBuYCXDu结合表1中各变量的值可得：0004905.01000000601.200010A105.0010B00100001C00D上面已经得到系统的状态方程式，对其进行阶跃响应分析，在MATLAB指令区中键入以下命令：A=[0100;20.601000;0001;-0.4905000];B=[0;-1;0;0.5];C=[1000;0010];D=[0;0];step(A,B,C,D);图5系统稳定性仿真图11可以看出，在单位阶跃响应作用下，小车位置(x)和摆杆角度(θ)都是发散的。即系统是不稳定的。3.2、开环系统的能控性分析采用状态反馈对系统进行任意配置极点的充要条件是系统完全能控，因此本小节对所建立的系统状态方程运用Matlab进行能控性的分析。系统的能控性是指系统的输入能否控制状态的变化。对于n阶线性定常系统：)()()()()()(.tDutCxtytButAxtx能控性矩阵为BABAABBUnc12...当rankUc=n时，系统状态完全能控，否则系统不能控。在Matlab中，可利用ctrb()函数直接求出能控性矩阵，从而确定系统的状态能控性，它的调用格式为：Uc=ctrb(A,B)。在MATLAB指令区中键入以下命令：A=[0100;20.601000;0001;-0.4905000];B=[0;-1;0;0.5];Uc=ctrb(A,B);n=4;if(n==rank(Uc))disp('系统能控')End其结果为：系统能控。可以看出，系统的状态完全可控性矩阵的12秩等于系统的状态变量维数，系统的输出完全可控性矩阵的秩等于系统