现代控制一级倒立摆

倒立摆实验电子工程学院自动化学号：目录1实验设备简介................................................................................................................................21.1倒立摆介绍.........................................................................................................................21.2直线一级倒立摆.................................................................................................................32倒立摆建模...................................................................................................................................42.1直线一阶倒立摆数学模型的推导....................................................................................42.1.1受力分析..................................................................................................................42.1.2微分方程建模..........................................................................................................62.1.3状态空间数学模型..................................................................................................62.2实际系统模型建立....................................................................................................73系统定性、定量分析....................................................................................................................83.1系统稳定性与可控性分析.........................................................................................83.1.1稳定性分析..............................................................................................................83.1.2能控性分析............................................................................................................104极点配置的设计步骤..................................................................................................................104.1极点配置的计算.......................................................................................................104.2用MATLAB进行极点配置的计算........................................................................124.3极点配置的综合分析...............................................................................................135小结.............................................................................................................................................141实验设备简介1.1倒立摆介绍小车滑轨皮带电机摆杆倒立摆是处于倒置不稳定状态，人为控制使其处于动态平衡的一种摆。如杂技演员顶杆的物理机制可简化为一级倒立摆系统，是一个复杂，多变量，存在严重非线性，非自制不稳定系统。常见的倒立摆一般由小车和摆杆两部分组成，其中摆杆可能是一级，二级或多级，在复杂的倒立摆系统中，摆杆的长度和质量均可变化。1.2直线一级倒立摆根据自控原理实验书上相关资料，直线一级倒立摆在建模时,一般忽略系统中的一些次要因素.例如空气阻力、伺服电机的静摩擦力、系统连接处的松弛程度等，之后可将直线一级倒立摆系统抽象成小车和匀质的杆组成的系统。倒立摆系统是典型的机电一体化系统其机械部分遵循牛顿的力学定律其电气部分遵守电磁学的基本定理.无论哪种类型的倒立摆系统,都具有3个特性,即:不确定性、耦合性、开环不稳定性.直线型倒立摆系统,是由沿直线导轨运动的小车以及一端固定于小车上的匀质长杆组成的系统.小车可以通过传动装置由交流伺服电机驱动.小车导轨一般有固定的行程,因而小车的运动范围是受到限制的。2倒立摆建模2.1直线一阶倒立摆数学模型的推导对于忽略各种摩擦参数和空气阻力之后，直线一即倒立摆抽象为小车和均质杆组成的系统。本系统的参数定义如下：M小车质量m摆杆质量b小车摩擦系数l摆杆转动轴心到杆质心的长度I摆杆惯量F加在小车上的力x小车位置（变量）φ摆杆与垂直向上方向的夹角（输出）θ摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）2.1.1受力分析下面我们对这个系统作一下受力分析。N和P为小车与摆杆相互作用力的水平和垂直方向的分量。应用牛顿第二定律方法来建立系统的动力学方程过程如下：分析小车水平方向所受的合力，可以得到以下方程：NxbFxM(2-1)由摆杆水平方向的受力进行分析可以得到下面等式：22(sin)dNmxldt(2-2)2cossinNmxmlml(2-3)把这个等式代入上式中，就得到系统的第一个运动方程：FmlmlxbxmMsincos)(2（2-4）为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：22(cos)dPmgmldt(2-5)2sincosPmgmlml(2-6)力矩平衡方程如下：INlPlcossin(2-7)注意：此方程中力矩的方向，由于sinsin,coscos,，故等式前面有负号。合并这两个方程，约去P和N，得到第二个运动方程：cossin)(2xmlmglmlI(2-8)2.1.2微分方程建模设，当摆杆与垂直向上方向之间的夹角与1（单位是弧度）相比很小，即1时，则可以进行近似处理：1cos，sin，0)(2dtd。为了与控制理论的表达习惯相统一，即u一般表示控制量，用u来代表被控对象的输入力F，线性化后得到该系统数学模型的微分方程表达式：umlxbxmMxmlmglmlI)(2(2-9)2.1.3状态空间数学模型由现代控制理论原理可知，控制系统的状态空间方程可写成如下形式：DuCXYBuAXX(2-10)方程组（2-9）对,x解代数方程，得到如下解：uMmlmMImlMmlmMImMmglxMmlmMImlbuMmlmMImlIMmlmMIglmxMmlmMIbmlIxxx2222222222)()()()()()()()()((2-11)整理后得到系统状态空间方程：uMmlmMImlMmlmMImlIxxMmlmMImMmglMmlmMImlbMmlmMIglmMmlmMIbmlIxx2222222222)(0)(00)()()(010000)()()(000101000000100xxxyu(2-12)2.2实际系统模型建立实际系统参数如下，求系统的传递函数、状态空间方程，并进行脉冲响应和阶跃响应的Matlab仿真。M小车质量1.096kgm摆杆质量0.109kgb小车摩擦系数0.1N/m/secl摆杆转动轴心到杆质心的长度(本实验为0.3m)0.25mI摆杆惯量0.006kg*m*mF加在小车上的力x小车位置T采样频率0.005秒θ摆杆与垂直向下方向的夹角1）以外界作用力作为输入的系统状态方程：uxxxx2.683800.89060031.69261.9235-0100000.71670.0891-000101000000100xxxyu3系统定性、定量分析3.1系统稳定性与可控性分析3.1.1稳定性分析先分析系统的稳定性，将数据代入状态方程中，利用matlab程序可以求出系统的零极点。程序段如下：[num,den]=ss2tf(A,B,C,D)%状态空间表达式——传递函数为-2.6838/(s^2-31.6926)[z,p,k]=tf2zp(num,den)%传递函数——零极点型结果如下：零点：z=5.43440.5492-5.4344-0.0000极点：p=0-5.65165.6081-0.0456由得到的p（极点）可知，有的极点在单位圆外，所以可知原系统是不稳定。3.1.2能控性分析我们可以利用matlab来得到系统的能控性，源代码如下：uc=ctrb(A,B)%判断能控性r=rank(uc)%求秩r=4由得到的rank（ud）的值可知，原系统的能控性矩阵为4，所以我们可知原系统是能控的。4极点配置的设计步骤4.1极点配置的计算对于如上所述的系统，设计控制器，要求系统具有较短的调整时间和合适的阻尼。倒立摆极点配置原理图如图所示：极点配置步骤如下：（1）检验系统能控性（以证）（2）计算特征值选取期望的闭环极点）（4,3,2,1ii，其中：jj3.32-3.32-10-10-1321期望的特征方程为：14898.69789.194243.323.3210102344321