还剩12页未读,继续阅读
本资源只提供10页预览,全部文档请下载后查看!喜欢就下载吧,查找使用更方便
文本内容:
倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统,是学习和研究现代控制理论最合适的实验装置倒立摆的控制是控制理论应用的一个典型范例,一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的本文主要研究的是二级倒立摆的极点配置方法,首先用Lagrange方程建立了二级倒立摆的数学模型,然后对二级倒立摆系统的稳定性进行了分析和研究,并给出了系统能控能观性的判别基于现代控制理论中的极点配置理论,根据超调量和调整时间来配置极点,求出反馈矩阵并利用Simulink对其进行仿真,得到二级倒立摆的变化曲线,实现了对闭环系统的稳定控制关键词二级倒立摆;极点配置;Simulink目录.绪论2数学模型的建立和分析.1数学建模的方法.2二级倒立摆的结构和工作原理.3拉格朗日运动方程.4推导建立数学模型3二级倒立摆系统性能分析.1稳定性分析2能控性能观性分析4状态反馈极点配置1二级倒立摆的最优极点配置
1.2二级倒立摆最优极点配置
2.二级倒立摆matlab仿真1Simulink开环系统Simulink仿真结果Simulink搭建极点配置后的闭环系统4极点配置Sinrnlink仿真结果第一组极点配置仿真结果第二组极点配置仿真结果.结论.参考文献附录一对于一般控制系统,闭环主导极点的选取应使
0.4WeW
0.8但二级倒立摆是一个特殊的高阶系统,稳定性是主要矛盾,因此可适当增加£即适当降低响应速度,来弥补系统稳定性要求相应在选择性能指标时,应适当减小系统的超调量对于二阶倒立摆系统,主要针对如下两个主要的性能指标进行设计超调量a
0.005调节时间ts
2.5s__j5=eJi-F
4.144-ZnVl-£2ts=
4.2这里,误差范围取为2%将上述性能指标代入式
4.1和式
4.2得到二级倒立摆系统的2个性能指标满足£之
0.
8262.17取e=
0.826an=
2.17将得到的阻尼比与自然角频率代入下式slfs2=-ans±jcony/l-e
24.3得到二级倒立摆系统的2个主导极点为Si=-
1.87+l.llys2=-
1.87-
1.11;
4.4对于其他四个非主导极点,不妨设为四重极点,且距主导极点10倍以上,即满足下式|一||=|屈||=|-||=||s6||10*
2.17=
21.
74.5所以,另外四个非主导极点取为s3=s4=s5=s6=-22至IJ此,二级倒立摆的6个极点都已确定P=[-
1.87+l.11j-
1.87-
1.llj-22-22-22-22]
4.6在matlab中输入KnackerABP可求得K二
1.0e+03*
0.
52810.4618-
2.
63790.5136-
0.0797-
0.4476至此,完成了二级倒立摆控制器的设计接下来在matlab中仿真得到图2极点配置后单位阶跃响应
14.2二级倒立摆最优极点配置2在上述基础上,继续调整超调量和调整时间,使二级倒立摆达到稳定第二次取:超调量a
0.05调节时间片
42.5s这里,误差范围仍取为2%代入式
4.1和式
4.2得到二级倒立摆系统的2个性能指标满足£Z
0.69an251取£=
0.693n=
2.51将得到的阻尼比与自然角频率式
4.3得到第二组主导极点Si=-
1.73+
1.81;s2—-
1.73—
1.81;
4.4对于其他四个非主导极点,不妨设为四重极点,且距主导极点10倍以上,即满足下式|同|=||s/|=||s5||=||s6||12*
2.5=
304.5所以,另外四个非主导极点取为S3=S4=S5=S6=-30因此,第二组极点P2=[T.73+
1.81j-
1.73-
1.81j-30-30-30-30]在matlab中输入K2=ackerABP2可求得K2=
1.0e+03*
2.
42050.5209-
7.
49771.6587-
0.2846-
1.2008接下来绘制极点配置后系统的单位阶跃响应图图3极点配置后单位阶跃响应
25.二级倒立摆matlab仿真
5.1Simulink搭建开环系统图4开环系统仿真图开环系统Simulink仿真结果图5开环系统matlab仿真结果图由上图可知,在Simulink中搭建的开环系统是发散的,与理论计算的结果吻合Simulink搭建极点配置后的闭环系统图6极点配置优化后的系统结构图极点配置Simulink仿真结果第一组极点配置仿真结果图7极点配置优化后的结果图图8小车位移曲线图9一级倒立摆角度曲线图10二级倒立摆角度曲线从以上的图片可以看出,系统在给定输入的情况下,1秒左右恢复到平衡点的位置附近,系统较好的快速性、稳定性和精确性都非常理想,且无超调量,符合要求
5.
4.2第二组极点配置仿真结果图11极点配置优化后的结果图图12小车位移曲线图13一级倒立摆角度曲线图14二级倒立摆角度曲线与第一组极点相比,超调量略有增加,但调整时间有所下降,且都达到稳定状态符合要求.结论倒立摆系统就其本身而言,是一个多变量、快速、严重非线性和绝对不稳定系统,必需采用有效的控制法使之稳定,对倒立摆系统的研究在理论上和方法论上均有着深远的意义本文借助拉格朗日方程,建立了二级倒立摆的数学模型,并通过线性化,得到了二级倒立摆系统的状态空间模型应用现代控制理论,分析了倒立摆的稳定性、能控性、能观性随后采用二次型最优控制理论研究了倒立摆控制问题,并旦运用状态反馈极点配置的方法得到较好的控制效果最后进行了Matlab仿真通过优化前后优化后的响应Illi线可以看出经过极点配置算法优化后的系统响应的速度加快,超调量明显减少,稳定时间和上升时间有所减少,系统的动态性能和静态性能要比没有优化的控制效果好了很多.参考文献
[1]刘豹唐万生现代控制理论(第三版)机械工业出版社
[2]夏德铃翁贻方自动控制理论(第4版)机械工业出版社
[3]李国勇程永强计算机仿真技术与CAD—基于matlab的控制系统(第三版)电子工业出版社
[4]基于LQR的二级倒立摆控制系统研究[本科毕业论文]
[5]汤唯基于直线二级倒立摆控制系统的研究[硕士学位论文]
[6]基于极点配置的倒立摆控制器设计[硕士学位论文]附录一%阶跃响应下系统的稳定性A=[000100;000010;000001;000000;
077.0642-
21.1927000;0-
38.
532137.8186000];B=[0;0;0;l;
5.7012;-
0.0728];C=[100000;010000;001000];D=[0;0;0];stepABCD%绘制阶跃响应%能控能观性判断A=[000100;000010;000001;000000;
077.0642-
21.1927000;0-
38.
532137.8186000];B=[0;0;0;l;
5.7012;-
0.0728];C=[l00000;010000;001000];D=[0;0;0];Uc=ctrbABrankUcVo=obsvACrankVo极点配置1A=[
000100000010000001000000077.0642-
21.1927000;0-
38.
532137.8186000];B=[0;0;0;l;
5.7012;-
0.0728];C=[l00000;010000;001000];P=[-
1.87+l.Hi-
1.87-
1.Hi-22-22-22-22];%K=ackerABP;%就反馈矩阵Al=A1=A-B*K;stepAlBCD%极点配置2A=[000100;000010;000001;
077.0642-
21.1927000;0-
38.
532137.8186000];B=[0;0;0;l;
5.7012;-
0.0728];C=[l00000;010000;001000];D=0;P2=[-
1.73+
1.81i-
1.73-
1.81i-30-30-30-30];%K2=ackerABP2%求反馈矩阵A2=A-B*K2;stepA2BCD.绪论倒立摆最初诞生于麻省理工学院,仅有一级摆杆,另一端钱接于可以在直线导轨上自由滑动的小车上后来在此基础上,人们又进行拓展,设计出了直线二级倒立摆、环型倒立摆、平面倒立摆、柔性连接倒立摆、多级倒立摆等实验设备在控制理论的发展过程中,为验证某一理论在实际应用中的可行性需要按其理论设计的控制器去控制一个典型对象来验证倒立摆系统作为一个实验装置,形象直观,结构简单,成本低廉;作为一个控制对象,他又相当复杂,同时就其本身而言,是一个高阶次、不稳定、多变量、非线性、强耦合系统,只有采取行之有效的控制方法才能使之稳定,因此倒立摆装置被公认为是自动控制理论中的典型实验设备综合文献资料,倒立摆控制的方法主要有PID控制,状态反馈,利用云模型,神经网络控制,遗传算法,自适应控制,模糊控制,变论域自适应模糊控制理论,智能控制等多种算法来实现倒立摆的控制本文主要构建二级倒立摆的数学模型的建立与分析,对倒立摆系统进行控制方法的研究本文就以下儿个问题进行了论述.二级倒立摆的数学模型的建立与分析在建模部分,首先采用拉格朗日方程推导数学模型,井对系统的可控性可观性进行分析,并分析倒立摆系统控制的难易程度.二级倒立摆的控制原理及方法的研究本文主要采用状态反馈极点配置的方法对二级倒立摆进行研究.采用Matlab语言进行数字仿真,分析仿真结果2数学模型的建立和分析数学建模的方法所谓系统的数学模型就是利用数学结构来反映系统内部之间、内部与外部某些因素之间的精确的定量的表示它是分析、设计、预报和控制一个系统的基础,所以要对一个系统进行研究,首先要建立它的数学模型建立倒立摆系统的模型时,一般采用牛顿运动规律,结果要解算大量的微分方程组,而且考虑到质点组受到的约束条件,建模问题将更加复杂,为此本文采用分析力学方法中的Lagrange方程推导倒立摆的系统模型Lagrange方程有如下特点.它是以广义坐标表达的任意完整系统的运动方程式,方程式的数目和系统的自由度是一致的.理想约束反力不出现在方程组中,因此在建立运动方程式时,只需分析已知的主动力,而不必分析未知的约束反力.Lagrange方程是以能量观点建立起来的运动方程,为了列出系统的运动方程,只需要从两个方面去分析,一个是表征系统运动的动力学量一系统的动能另一个是表征主动力作用的动力学量一广义力因此用Lagrange方程来求解系统的动力学方程可以大大简化建模过程二级倒立摆的结构和工作原理如图
2.1系统包括计算机、运动控制卡、伺服机构、倒立摆本体(小车上摆,下摆,皮带轮等)和光电码盘几大部分,组成了一个闭环系统光电码盘1将小车的位移、速度信号反馈给伺服驱动器和运动控制卡,下面一节摆杆(和小车相连)的角度、角速度信号由光电码盘2反馈回控制卡和伺服驱动器,上面一节摆杆的角度和角速度信号则由光电码盘3反馈计算机从运动控制卡中读取实时数据,确定控制决策(小车向哪个方向移动、移动速度、加速度等),并由运动控制卡来实现该控制决策产生相应的控制量使电机转动,带动小车运动,保持两节摆杆的平衡图
2.1系统结构和工作原理图拉格朗日运动方程拉格朗日提出了用能量的方法推导物理系统的数学模型,首先我们引入广义坐标,拉格朗日方程广义坐标系统的广义坐标是描述系统运动必需的一组独立坐标,广义坐标数等同于系统自由度数如果系统的运动用〃维广义坐标外怒…Q来表示,我们可以把这〃维广义坐标看成是〃维空间的〃位坐标系中的坐标对于任一系统可由〃维空间中的一点来表征系统在〃维空间中运动形成的若干系统点连成一条曲线,此曲线表示系统点的轨迹拉格朗日方程L(q,4)=T(qH)-V(q,4)(
2.1)式中,L——拉格朗日算子,(I一一系统的广义坐标,T——系统的动能,V一一系统的势能拉格朗日方程由广义坐标外和L表示为dLL=fi比??%Jl式中,i=l23…〃,/——系统沿该广义坐标方向上的外力,在本系统中,设系统的三个广义坐标分别是X%%推导建立数学模型在推导数学模型之前,我们需要几点必要的假设.上摆、下摆及小车均是刚体;.皮带轮与传动带之间无相对滑动;传动皮带无伸长现象;.小车运动时所受的摩擦力正比于小车的速度;.小车的驱动力与直流放大器的输入成正比,且无滞后,忽略电机电枢绕组中的电感;.下摆转动时所受到的摩擦力矩正比于下摆的转动速度;.上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度;二级倒立摆的运动分析示意图如图
2.2图
2.2二级倒立摆运动分析示意图倒立摆系统参数如下小车系统的等效质量沪L32Kg摆杆1质量叫=
0.04Kg摆杆1转动中心到杆质心距离/尸
0.09m摆杆2质量^=
0.132Kg摆杆2转动中心到杆质心距离72=
0.27m质量块质量㈣=
0.208Kg作用在系统上的外力F摆杆1与垂直向上方向的夹角4摆杆2与垂直向上方向的夹角%首先,计算系统的动能T=4+++⑵3a小车动能Tm=\Mx
22.4摆杆1动能
2.5式中,一摆杆1质心平东动能一摆杆1绕质心转动动能式中,72一摆杆1质心平东动能丁⑶一摆杆1绕质心转动动能=-m2x-211acos
4.l202cos3+,622/asin4+1202sin/J
222.10Tn2=|J2^2=|||W2Z2W=^W2Z2^222\5Jo
2.12=—_2m^x0{cosa+因此,可以得到系统总动能+—m-^x1-2m3lxx0xcos4+2〃“石系统的势能为=4g4cosq+2%g\cos耳+m2g4cos0]+/2cosft至此得到拉格朗日算子L-2//g/1cos^-m2g2llcos1+/2cos由于因为在广义坐标q凡上均无外力作用,有以下等式成立:6L=0ddLdLdt{dO2d02=0展开
2.
17、
2.18式分别得到
2.
19、
2.20式+町+2w2+/i3^sin^+xcos0]=0-3gsin02-61sinq-ft+4/2ft+611acos^2-^-3xcos02=O将
2.
19、
2.20式对4以求解代数方程,得到以下两式⑵]一4〃[一⑵4T2砥+9/%cos24-4-..g+
3.+gM2g+4〃;/,;cosa-名表示成以下形式0\=文\同;心a篇无取平衡位置时各变量的初值为零,a=匹qa,%qa,幻二oo00000=0将
2.23式在平衡位置进行泰勒级数展开,并线性化,令K“嚼”
2.
132.
142.
152.
162.
172.
182.19⑵
202.
212.
222.
232.
242.25⑵26K\二3-2g机।-4刎-4即阳2—4叫一3/w2-12加3MA=o2-4^-3吗-12机3,1A=0=°八-n=0/I-Udf\I_3-2加]7n
2.4/%dx4=02-4m]-3叫一12w3/得到线性化之后的公式将a二人以3%/,同,工)在平衡位置进行泰勒级数展开,并线性化,_2g町+2〃4+1%4=0-164〃4,2--§m】+3机2+阳M得到4g町+3〃4+吗4=0-1634/i2/2--W+3Q十/乂4=安|皿=K旦25弭._0=0/i-V部=42/n+2m2+〃4—町+3/%+m34=04叫%一为〃4+3,%+niy/
22.
282.29⑵
302.
312.
322.33令⑵
342.35⑵
362.
372.38⑵
392.40即:4=避+丛+/
2.42凡=K22O]+K@+K21x
2.43现在得到了两个线性微分方程,由于我们采用加速度作为输入,因此还需加上一个方程u=X
2.44x求出各个K值得到状态方程各个参数矩阵:3二级倒立摆系统性能分析
3.1稳定性分析二级倒立摆的特征方程为Matlab中,用函数eigC4来计算系统矩阵的特征值,经过计算,系统的特征值为A=[
9.
59724.7725-
9.5972-
4.772500]
3.2开环系统有两个开环极点位于S平面右半平面上,所以系统是不稳定的同时,根据前面的状态空间表达式,在matlab中,用stepABCD函数对系统的阶跃响应进行分析图1开环系统单位阶跃响应从上图可以看出,在阶跃响应的作用下,系统是发散的
3.2能控性能观性分析对于线形状态方程X=AX+8UY=CX其能控性矩阵为求”的秩rankT0=6所以系统是完全能控的其能观性矩阵为Co=[CfCACA\CA\CA^CA5]T求品的秩rankC0=6所以系统是完全能观的代码见附录由上述计算结果可知,二级倒立摆系统是开环不稳定系统,但它的状态是完全能控且完全能观测的因此,可以对其实现闭环最优控制4状态反馈极点配置
4.1二级倒立摆的最优极点配置1在式
3.3中,A为6*6阵;B为6*1阵;C为3*6阵是一个单输入系统,且完全能控、能观测因此,可按照最优控制系统的极点配置方法进行设计取状态变量如下**x=X3~孙才5=入6=则状态空间方程如下10000x2000当000尤000先0KnK|30k22423将以下参数代入=仇二2=X=a
2.45100-■0■010t
20001000.%4-01U
2.46000£Kii00036_.427-.1/=
1.32%=
0.04%=
0.132/3=
0.208”
9.81{=
0.09=
0.27。