您好,欢迎访问三七文档
当前位置:首页 > 高等教育 > 理学 > 倒立摆实验预习报告_张晓德
控制理论专题实验倒立摆建模与控制预习报告院系:自动化系班级:自22姓名:张晓德学号:2012011413邮箱:zhangxdqh@163.com1目录1倒立摆数学建模...........................................................................................................................21.1倒立摆动力学方程.............................................................................................................21.2传递函数.............................................................................................................................21.3状态空间方程.....................................................................................................................31.4判断系统的可控性............................................................................................................41.5判断系统的可观性.............................................................................................................71.5特征值规范型和可控规范型............................................................................................82实验一根轨迹方法控制实验.................................................................................................92.1根轨迹分析.........................................................................................................................92.2根轨迹校正器理论设计...................................................................................................102.3根轨迹校正器进一步设计...............................................................................................123实验二:频域响应方法控制实验.............................................................................................124实验三极点配置控制方法实验...............................................................................................164.1方法一:采用规范型的方法。......................................................................................164.2方法二:采用改进算法..................................................................................................172倒立摆建模与控制预习报告自动化系自22张晓德20120114131倒立摆数学建模1.1倒立摆动力学方程在忽略了空气流动和各种摩擦之后,可将倒立摆系统抽象成导轨、小车和匀质杆组成的系统,其受力分析图如下所示倒立摆本体主要由小车和摆杆组成。运用牛顿力学原理,得到两部分的微分方程模型如下:)cossin(sincoscossin22mlmgPmlmlxmNNlPlINxbFxM(1)1.2传递函数我们需要将非线性的倒立摆模型在其工作点附近进行线性化。倒立摆的工作点就是它的平衡点,即φ=0。当φ很小时(如φ≤5°),我们可以作如下的近似处理:sinφ≈φ,cosφ≈1,φ2≈0,φ2≈0对公式(1)进行化简可得3mgPmlxmNNlPlINxbFxM(2)假设模型的初始状态为零,对线性化后的微分方程(2)进行拉普拉斯变换得:mgPssmlssmXsNlsNsPlssIsNssbXsFssMX2222)()()()()()()()()()((3)对上式进行推导,得到传递函数的表达式如下,其中A(s)为小车加速度(I)bmglsmglmMsmlIbsMmlMImIsmlssFs)()()()()(223242(II)mglsmlImlsAs22)()()((III)bmglsmglmMsmlIbsMmlMImIsmglsmlIsFsX)()()()()()(2232422将已知数据(指导书12页)代入以上各式可得(I)ssssssFs0267.03217.000159.0018432.002725.0)()(2342(II)26705.00159125.002725.0)()(2ssAs(III)ssssssFsX0267.03217.000159.0018432.026705.00159125.0)()(23421.3状态空间方程选定外力F给小车施加的加速度a为控制信号,而选取小车的位置x和倒立摆的角度φ为输出变量,即xau,Tx][y请根据线性化后的微分方程,建立倒立摆本体的状态空间方程DuCxyBuAxx4其中Txxx结合(2)式可以得到如下的状态方程组xImlmlImlmglxxxx22(4)将其写成矩阵的形式uImlmlxxImlmglxx22010000100000000010(5)uxxx0001000001代入具体数值可得:uxxxx7125.101007824.1600100000000010uxxx00010000011.4判断系统的可控性07824.1600100000000010A7125.1010B501000001C00D方法一:利用状态可控性的代数判据线性定常系统的状态完全可控的充分必要条件是,系统的可控性矩阵][12BABAABBQnC的秩为n所以系统可控。方法二:对角线规范型判据系统完全可控的充要条件是对角规范型的输入系数~B没有全零行。求状态转移矩阵60966.400000966.40000000010~ATBTB]418.0418.010[1~5.05.0000001~CDD~~B没有全零行,所以可控。方法三:线性定常系统可控的充要条件是状态系数矩阵A的任意特征值都满足nBIArank][7对每个特征值进行判断可以看出系统可控。1.5判断系统的可观性方法一:代数判据:线性定常系统完全可观的充要条件是:系统可观矩阵的秩为n,即nrankQ0所以系统可观。方法二:系统完全可观的充要条件是:~C不存在全零列,所以可控方法三:模态判据:线性定常系统完全可观的充要条件是:状态系数矩阵A的任意特征值都满足nCIArank8所以系统可观1.5特征值规范型和可控规范型通过坐标变换的方法将上述的状态空间方程转化为特征值规范型和可控规范型,并给出相应的变换矩阵。①特征值规范型由上述可知,特征值规范型为ux0966.4418.0100966.400000966.40000000010~~X~5.05.0000001xy变换矩阵为:10000100000.50.5002.04832.0483T②可控规范型关键代码如下求得,第一可控规范型为000101007824.160100001000011ccBA7399.2807125.1000101cC9第二可控规范型是100007824.160010000100001022ccBA07125.1000107824.162cC2实验一根轨迹方法控制实验2.1根轨迹分析当倒立摆系统的输入为小车的加速度a(t)=x(t),输出为摆杆的角度φ(t)时,倒立摆系统的开环传递函数为:7824.167125.1)()()(222smglsmlImlsAs用MATLAB做出其根轨迹图该系统有两个极点为0966.4,0966.421pp,根轨迹如下:系统有两个实极点,并且有一个极点为正,有一条根轨迹从该点出发跑到坐标原点,又从原点跑到正无穷。所以,不管增益如何改变,右半平面总会存在根轨迹,即系统不可能通过调整开环增益使系统稳定。10为了使系统稳定并且改善动态性能,需要使根轨迹左移,即需要超前校正。2.2根轨迹校正器理论设计设计控制器()Ks,使得校正后系统稳定且满足在摆杆角度施加0.05弧度信号时调整时间0.5sts(2%的误差),超调量10%的瞬态性能指标。①确定希望的闭环主导极点根据超调量%1021e得591.0,取7.0根据调整时间stns5.04得43.11n,取12n所以希望的主导极点为57.84.821jjsnnd计算出的闭环主导极点在未校正系统根轨迹的左侧,这也进一步说明应该进行超前校正。系统超前校正后,根轨迹向左方移动,可以使闭环系统有更高的稳定裕度以及更快的响应时间。②计算所需的超前角设校正前的传递函数为)(sGp,校正装置的传递函数为ccccpszsKsG)(22.262]7824.16)57.84.8(7125.1arg[)]57.84.8(arg[2jjGp上述角度应增加22.82才能满足幅角条件,即需要超前角22.82③选择超前校正装置传递函
本文标题:倒立摆实验预习报告_张晓德
链接地址:https://www.777doc.com/doc-2693917 .html