基于倒立摆的现代控制模型建立及分析基于倒立摆的现代控制模型建立及分析

1、基于倒立摆的现代控制模型建立及分析姓名:学号：_教师：专业：二。九年十二月二十九日基于倒立摆的现代控制模型建立及分析目录第一章绪论1第二章倒立摆系统建模22.1 状态空间表达式22.1.1 数学模型建立22.1.2 状态变量及状态空间表达式32.1.3 系统的约旦标准型42.1.4 系统的并联实现5第三章倒立摆系统状态空间表达式的解73.1 状态转移矩阵73.2 系统在单位阶跃函数作用下的解7第四章倒立摆系统的能控性和能观性84.1 倒立摆系统的能控性84.2 倒立摆系统的能控标准型84.2.1 能控标准I型84.2.2 能控标准II型94.3 倒立摆系统的能观性104.4 倒立摆系统的能观标

2、准型104.4.1 能观标准I型104.4.2 能观标准H型11第五章倒立摆系统的稳定性与李亚普诺夫方法12第六章倒立摆系统的综合136.1 系统性能指标的确定136.2 系统极点配置136.3 状态观测器146.3.1 全维状态观测器146.3.2 降维观测器156.4 利用状态观测器实现状态反馈18第七章倒立摆系统的最优控制方案及控制器设计20参考文献21基于倒立摆的现代控制模型建立及分析第一章绪论倒立摆作为一个高阶次、多变量、非线性和强祸合的自然不稳定系统，一直是控制领域研究的热点问题。它广泛应用于控制理论研究、航空航天控制、机器人、杂技顶杆表演等领域，在自动化领域中具有重要的理论价值和

3、实践价值。这些物理装置与控制系统的稳定性密切相关，深刻揭示了自然界一种基本规律，即一个自然不稳定的被控对象，通过控制手段可使之具有良好的稳定性。倒立摆的研究具有重要的工程应用价值。如机器人问题，机器人行走类似倒立摆系统，尽管第一台机器人在美国问世以来己有三十多年的历史，但机器人的关键技术至今仍未很好解决。再如太空应用中，倒立摆系统的稳定与空间飞行器控制和各类伺服云台的稳定有很大相似性，它也是日常生活中所见到的任何重心在上、支点在下的控制问题的抽象，因此，倒立摆机理的研究又具有重要的工程应用背景，成为控制理论中经久不衰的研究课题。倒立摆的控制方法，在军工、航天和机器人领域有广泛的用途，对处理一般

4、工业过程亦有指导性作用。倒立摆常见类型有：（1）直线型倒立摆，（2）环型倒立摆，（3）旋转式倒立摆,（4）复合倒立摆系列。由于时间水平有限，本文仅针对一阶直线型倒立摆进行现代控制分析。图1.1为一级倒立摆装置简图。图1.1一级倒立摆装置简图第二章倒立摆系统建模2.1 状态空间表达式2.1.1 数学模型建立倒立摆系统由质量为M的小车和质量为m,长度为L的的连杆即摆构成。连杆的一端与小车通过旋转关节自由连接，即该关节无驱动力矩。该机械系统目的是操作小车的驱动力F,使得摆稳定在倒立点上，即连杆不倒下，即不超过预先定义好的一个垂直偏离角度范围。图2.1为倒立摆系统图，小车位移为x,摆的角度为0。在系统

5、数学模型中，首先假设：（1）摆杆为匀质刚体；（2）忽略摆杆与支点问的摩擦；（3）忽略小车与导轨的摩擦。0mg o(2-2)227.5°系统的初始状态口=0d=0摆杆质心的绝对位移为H =x+lsin日根据牛顿第二运动定律对系统整体水平方向受力分析，求得方程22d xdF(t) = M 2 m 2(x l sin )dt2dt2(2-1)对摆杆。点取力矩平衡，得到方程图2.1倒立摆系统图一d2H，八M0=m-p-cos:-mglsin-=0基于倒立摆的现代控制模型建立及分析方程(1)(2)是非线性方程，由于控制的目的是保持倒立摆直立，在施加的外力条件下，假定8很小，接近于零是合理的。则

6、sine定e,cose之1。在以上假设条件下，对方程线性化处理后，得到倒立摆系统的数学模型为：F(t)=MXmxml4(2-3)(2-4)glu-XlU2.1.2 状态变量及状态空间表达式在用状态空间法分析系统是，系统的动态特性是用状态变量构成的一阶微分方程组描述的。它能反映系统的全部独立变量的变化，从而能同时确定系统的全部内部运动状态，而且还可以方便的处理初始条件1。取(Xi,X2,X3,X4)T=(x,X,e,d)T为系统的一组状态变量，输入为：u=F(t),输出y=x,则系统的状态方程为:0mg一 M0(m M)gMlX2X3、x4 J01M01y = 1,0,0,0XiX2X3H4为便

7、于计算，假设小车的质量M=1kg,摆杆质量m=0.2kg,摆杆长度为l=0.5m,g=10m/s2则系统状态方程为X = Ax bu y = c x0其中A =01 00 -20 00 240、010>"0、1b =1 0 , c = (1,0,0,0 )128倒立摆系统的原始模拟结构图如图2.2所示图2.2倒立摆系统的原始模拟结构图2.1.3系统的约旦标准型根据系统的特征方程1二2对应于对应于P4=1KI-A=0,得至U1（九224）=0,解得特征值为=0,九3=4.899,儿=，899。%=0,由（I-A）R=0,解得特征向量P%=0,由（九2I-A）g=-P,解得特征向量

8、于，一3=4.8,99T4.899-12-58.788)。4.8,99T-4.899-1258.788)0由特征向量组成的变换矩阵14.899-121-4.899-12P2("-A)P3=0(I-A)P4=00.08330-0.0417<0-58.78858.788-0.0417T0)。T00)0特征向量得特征向量00.0833-0.00850.0085约旦标准型矩阵a=T,AT=变换后的相关矩阵为T%=00.8330.0172.1.4系统的并联实现0100、0000004.8990<0004.899,-0.017cTfl系统的传递函数为W(s)=C(SI-A),b=1-

9、100、0、s2010s-100-24s/as00<014W%s2(s2_24)14W(s)1s2s2(s2-24)56s26(s2./6)(s-2:6)6s0.0170.017s4.898s4.898用矢量矩阵形式表示为,000<01000004.8990000-4.899X1X2X3<x4JX1y=0.833000.017-0.017X2X3，0、11倒立摆并联型模拟结构图如图2.3所示u+图2.3倒立摆并联型模拟结构图y基于倒立摆的现代控制模型建立及分析第三章倒立摆系统状态空间表达式的解3.1 状态转移矩阵根据约旦标准型矩阵，求得114=(t)=t1,t=1114.89

10、9489,0-12-120-58.78858.7880t0104.8990e000丫100.08330'00100.0833000-0.0417-0.0085e4899交。0-0.04170.00850.0833-0.00854.899 0.008任4.8990.0833 0.04164.89° 0.041 4899t0.10224.89、0.10公48900.5e4.89。0.5e4899t1t0.08380.04174.8990.0417?.899t01-0.204e4.899+0.204e4899tccnc4.899t,n”.899t000.5e+0.5e4.899t4

11、899:002.451e-2.45t3.2 系统在单位阶跃函数作用下的解初始时刻为t0=0,初始状态x(0)=0,输入u(t)=1(t),根据t_T_0.1666(_T)+0.0174.899(T)_0.01m".899(K'0.8330.083e4.899(T+0.083e4.899i)-0.2044.899(T+0.20卷".899t4.899()_4899tfee2.04t2+0.00347e4.899t+0.00347s4899t0.816+0.0169e4.899t_0.016%4899t-0.0416e4.899t-0.0416e.899t-0.204e

12、4.899t0.204e"899t第四章倒立摆系统的能控性和能观性在现代控制理论中，能控性和能观性是两个很重要的概念，是卡尔曼在1960年首先提出来，它是最优控制和最优估计的设计基础。4.1 倒立摆系统的能控性对于线性连续定常系统，如果存在个分段连续的输入u(t),能在有限时间区间t0,tfIo使系统由某一初始状态x(to),转移到指定的任一终端状态x(tf)。则称此系统是状态完全能控的。系统的能控性完全取决于系统的结构、参数以及控制作用的施加点。判断该倒立摆系统能控性有如下几种方法：(1) 根据图2.2倒立摆系统的原始模拟结构图，可以看出该系统是完全能控的。(2) 由系统约旦标准型

13、矩阵，可以看出输入矩阵b中相应于约旦块的最后一行元素不为零，故该系统是能控的。104040-20-480-4800.C。1(3) 根据能控判别矩阵M=(bAbA2bA3b)=0<-2rank(M)=n=4,故系统是完全能控的。4.2倒立摆系统的能控标准型倒立摆系统属于单输入单输出系统，在能控判别证中只有唯一的一组线性无关量，因此系统的能控标准型是唯一的。4.2.1 能控标准I型进行非奇异变化x=TdX,将原状态空间表达式化成X=AXbuy=Cx基于倒立摆的现代控制模型建立及分析32Ab A bAb b )a3a2a3系统特征方程为 4 -242aia2a3aia?二24-48-2-242

14、0-20I0-48-2-24I0-2-0.05-0.025-0.05-0.0250-0.5-0.5A=TATc1b =C = cT.二广2024当然也可根据系统输入输出传递函数 W(s)s2 -20s4 - 24s24.2.2 能控标准n型进行非奇异变化x=Tc2X,将原状态空间表达式化成x=Ax+bu,y=CX40-4801,231012=M=bAbAbAb=0-2<-20Y800.10-0.02501.201.200.10-0.050<-0.050-0.0250，-20、©000、1000b=0010241©010,<0/C=cTc2=0001A=兀入

15、兀=4.3倒立摆系统的能观性对于线性连续定常系统，对任意给定的输入U(t),在有限观测时间tfAt0,使得根据,tf期间的输出y(t),能唯一的确定系统在初始时刻的状态x(t。)，则称状态(1)(2)x(t0)是可观测的。根据图2.2倒立摆系统的原始模拟结构图，可以看出该系统是完全能观的。由系统约旦标准型矩阵，可以看出输出入矩阵c中相应于每个约旦块开头的一列元素不为零，故该系统是能观的(3)根据能控矩阵N =CCACACA,100010000-20000-2,rank(N)=n=4,故系统是完全14能观的。4.4倒立摆系统的能观标准型4.4.1能观标准I型进行非奇异变化x=ToiX,将原状态空

16、间表达式化成x=Axbuy=CxCCA CA2 vCA3100<0010000-20000-2门000'010000-0.5000-0.5A=11,AT010001000010240010/b =T01b 二-20、0二0 'C = cT0i = 1 0 0 04.4.2能观标准II型进行非奇异变化x=T°2X,将原状态空间表达式化成X=Axbu=CXT02 =a3a3a1a2a3a3 cAcA2cA-24-24-21cl0-20A =T02AT0224b =T01,b =CE = 0 0 0 1<0注释：因为状态空间表达式能观标准I型与能控标准II型对偶

17、，能观标准II型分别与与能控标准I型相对偶，依据对偶原理a=a2Th=c2T,G=b2T,可以直接写出系统的能关标准型基于倒立摆的现代控制模型建立及分析第五章倒立摆系统的稳定性与李亚普诺夫方法倒立摆系统是线性系统，系统的稳定性只取决于系统的结构和参数而与系统的初始条件及外界扰动无关。李亚普诺夫第一法关于线性系统的稳定判据为：线性定常系统£:(Ab,c)X=Ax+buy=cx平衡状态=0渐进稳定的充要条件是矩阵A的所有特征值具有负实部。倒立摆系统的特征方程|?J-A=0,九2(九224)=0,解得特征值为%=%=0,%=4.899,九4=口.899,故该系统的状态不是渐进稳定的。系统输

18、入输出传递函数为W(s)=C(SI-A)b-：2-202,传递函数的极点为s-24sSi=S2=0,S3=4.899,S4=-4.899,并不是都位于s平面的左半平面，故该系统输出不是渐进稳定的。16第六章倒立摆系统的综合6.1系统性能指标的确定本文中的倒立摆系统是四阶的高阶系统，忽略某些留数很小的或离虚轴很远的极点所对应的瞬态分量，可以用一个二阶的低阶系统来近似。各瞬态响应分量衰竭快慢取决于对应的闭环极点距离s平面虚轴的远近，其中最靠近虚轴的闭环极点对系统的瞬态响应起主导作用，称为闭环主导极点。若其他非主导极点的实部比主导极点的实部大5倍以上，则主导极点对应的瞬态分量衰减到进入稳态（即=&#

19、177;2%或=±5%所需要的调整时间比其他非主导极点所需时间慢5倍以上2。与1_2配置二阶系统的性能指标，超调量Mp=e"'乂100%=15%,得出阻尼比U=0.2727。0<2<0.8时，对应于稳态允许误差范围=±2%调整时间计算公式4ts=L=2s,算出无阻尼固有频率8n=7.334rad/s。故二阶主导极点为%Si,2=上0n±*Jl-“=-2±j7.056,远离这两个主导极点配置系统的另外两个极点S3=-15,S4=-18。6.2系统极点配置由极点§,2=2±j7.056,Sj=-15,S4=1

20、8,系统的期望特征多项式为f(')=('22n'n2)(-3)('-4)432=，37'455.78812855'14522.76倒立摆系统的能控标准I型为000<01000010240010基于倒立摆的现代控制模型建立及分析y=-20010x由于该系统完全能控，故可实现状态反馈配置极点，加入状态反馈矩阵K=(%k1k2k3),系统的闭环特征多项式为f)=detI-(AbK)=4(-k3)3(-24-k2)2(-ki)(-ko)比较f(1)和f(*J的各项对应系数，可解得ko=-14522.76,ki=-2855,k2=-479.788,k

21、3=-37,K=-14522.76-2855-479.788-37反变换到x状态1000、0100K=KT'=(14522.76-2855-479.788-37)*000-0.501000-0.5,=-14522.76-2855-239.894-18.56.3状态观测器6.3.1 全维状态观测器本文中倒立摆系统是完全能观的，可以构造状态观测器系统的能观II型为b000、-20、x=1000x十0uy=(0001)x010241001011。J引入反馈阵G=(g1g2g3g4T)得到观测器特征多项式为00gif( ) = det I - (A-GC) = det'0g2-1124

22、-g30-1-g4254_32_='-g4(24-g3)'g2g1比较f(?J)和f(九)的各项对应系数，可解得G = 14522.76 2855T431.788-37反变换到x状态,'0-24-240G=T02G=0100-200-2Y14522.76、028550-431.7880人-37-68450、-5164.2298121.549,0-202400 x)+10厂-68450、-5164.2298<21.549；全维观测器方程为X>=(A-Gc)X>buGy'6845015160-4.2298021.5490000910000-2024

23、00x)+10;0、1u0,-68450)-5164.2298(y-9<21.549；倒立摆系统的全维状态观测器如图6.1所示6.3.2降维观测器01T=02T-1100001000010A=T,AT0001100001000丫000A010000-20240Y010A000011'000，000,1-202401000、000，b=Tb=00011000010010八-2J10-2C=cT=10010<000011、000=00引入G=gig2g3得到观测器特征多项式为f()二detI-(Ai-GA21)=det%+g1g2【g324配置观测器极点为32,g(-242g2

24、)；-24g1-2g3-15,-15,-15,期望的观测器特征多项式为f()=(+15)3=34526753375比较f(为和f"("各相应项系数，得g1=45,g2=349.5,g3=-2227.5,即观测器为TG=45349.5-2227.5观测器方程为=(A1GA12)W(A11-GA12)G(A12-GA22)y(R-GB2)u=wGyw?1-45-349.52227.5-202427201W+-17950y0；108630)10J2图6.1倒立摆系统的全维状态观测器45?=W+349.5y2227.5,整个状态量x的估计值为W145yW2349.5yW-2227.5yy原系统的状态估计为?=T?=000010011MWi+45y0W2+349.5y0W3-2227.5V0人Vy帚+45yW+349.5y瓯-2227.57系统降维观测器如图6.2所示图6.2倒立摆系统的降维状态观测器0-2 0 240010，-68450、-516+y4.22