上海交大《现代控制理论》第五章.doc
《上海交大《现代控制理论》第五章.doc》由会员分享,可在线阅读,更多相关《上海交大《现代控制理论》第五章.doc(52页珍藏版)》请在沃文网上搜索。
1、 考虑如下线性定常系统式中 利用状态反馈控制,希望该系统的闭环极点为s = -2j4和s = -10。试确定状态反馈增益矩阵K。首先需检验该系统的能控性矩阵。由于能控性矩阵为:所以得出detQ = -1,因此,rankQ = 3。因而该系统是状态完全能控的,可任意配置极点。下面,我们来求解这个问题,并用本章介绍的3种方法中的每一种求解。 方法1:第一种方法是利用式(5.13)。该系统的特征方程为:因此期望的特征方程为因此参照式(5.13),可得 方法2:设期望的状态反馈增益矩阵为并使和期望的特征多项式相等,可得 因此从中可得或 方法3:第三种方法是利用爱克曼公式。参见式(5.18),可得 由于
2、且可得显然,这3种方法所得到的反馈增益矩阵K是相同的。使用状态反馈方法,正如所期望的那样,可将闭环极点配置在s = -2j4和s = -10处。应当注意,如果系统的阶次n等于或大于4,则推荐使用方法1和3,因为所有的矩阵计算都可由计算机实现。如果使用方法2,由于计算机不能处理含有未知参数的特征方程,因此必须进行手工计算。5.2.6 注释对于一个给定的系统,矩阵K不是唯一的,而是依赖于选择期望闭环极点的位置(这决定了响应速度与阻尼),这一点很重要。注意,所期望的闭环极点或所期望状态方程的选择是在误差向量的快速性和干扰、测量噪声的灵敏性之间的一种折衷。也就是说,如果加快误差响应速度,则干扰和测量噪
3、声的影响通常也随之增大。如果系统是2阶的,那么系统的动态特性(响应特性)正好与系统期望的闭环极点和零点的位置联系起来。对于更高阶的系统,期望的闭环极点位置不能和系统的动态特性(响应特性)联系起来。因此,在决定给定系统的状态反馈增益矩阵K时,最好通过计算机仿真来检验系统在几种不同矩阵(基于几种不同的期望特征方程)下的响应特性,并且选出使系统总体性能最好的矩阵K。5.3 利用极点配置法设计调节器型系统考虑如图5.2所示的倒立摆系统。图中,倒立摆安装在一个小车上。这里仅考虑倒立摆在平面内运动的二维问题。 图5.2 倒立摆系统希望在有干扰时,保持摆垂直。当以合适的控制力施加于小车时,可将该倾斜的摆返回
4、到垂直位置,且在每一控制过程结束时,小车都将返回到参考位置= 0。设计一个控制系统,使得当给定任意初始条件(由干扰引起)时,用合理的阻尼(如对主导闭环极点有=0.5),可快速地(如调整时间约为2秒)使摆返回至垂直位置,并使小车返回至参考位置( = 0)。假设M、m和l的值为M = 2千克, m = 0.1千克, l = 0.5米进一步设摆的质量集中在杆的顶端,且杆是无质量的。对于给定的角度和(/或)角速度的初始条件,设计一个使倒立摆保持在垂直位置的控制系统。此外,还要求控制系统在每一控制过程结束时,小车返回到参考位置。该系统对初始条件的干扰有效地做出响应(所期望的角d总为零,并且期望的小车的位
5、置总在参考位置上。因此,该系统是一个调节器系统)。这里,我们采用极点配置的状态反馈控制方法来设计控制器。如前所述,对任意极点配置的充要条件为系统状态完全能控。设计的第一步是推导倒立摆系统的数学模型。5.3.1 数学建模我们首先推导了如下图5.a所示的倒立摆系统的数学模型。结论:当角度不大时,描述系统动态特性的方程可以写为整理后可得(5.21)(5.22)从式(5.21)可得系统的传递函数为代入给定的数值,且注意到g = 9.81米/秒2,可得 显然,该倒立摆系统在负实轴上有一个极点(s = -4.539),另一个极点在正实轴上(s = 4.539),因此,该系统是开环不稳定的。定义状态变量为注
6、意,表示摆杆围绕点P的旋转角,x表示小车的位置,将和x作为系统的输出,即 又由于和x均是易于量测的量。由状态变量的定义和式(5.21)和(5.22),可得 以向量-矩阵方程的形式表示,可得(5.23)(5.24)式(5.23)和(5.24)给出了该倒立摆系统的状态空间表达式(注意,该系统的状态空间表达式不是唯一的,存在无穷多个这样的表达式)。代入给定的M、m和l的值,可得于是,式(5.23)和(5.24)可重写为式中 采用下列线性状态反馈控制方案 为此首先检验该系统是否状态完全能控。由于的秩为4,所以系统是状态完全能控的。 系统的特征方程为因此 其次,选择期望的闭环极点位置。由于要求系统具有相
7、当短的调整时间(约2秒)和合适的阻尼(在标准的二阶系统中等价于= 0.5),所以我们选择期望的闭环极点为(i =1,2,3,4),其中 在这种情况下,1,和2是一对具有= 0.5和n = 4的主导闭环极点。剩余的两个极点3和4位于远离主导闭环极点对的左边。因此,3和4响应的影响很小。所以,可满足快速性和阻尼的要求。期望的特征方程为因此现采用式(5.13)来确定状态反馈增益矩阵K,即式中由下式得到 因此故状态反馈增益矩阵K为反馈控制输入为 注意,这是一个调节器系统。期望的角d总为零,且期望的小车的位置xd也总为零。因此,参考输入为零。图5.3为用于倒立摆系统的状态反馈控制结构图(因为该系统中的参
8、考输入总为零,所以在图中没有画出)。图5.3 具有线性状态反馈控制的倒立摆系统5.4.2 利用MATLAB确定状态反馈增益矩阵KMATLAB Program 5.3是一种能求出所需状态反馈增益矩阵K的MATLAB程序。MATLAB Program 5.3%-Design of an inverted pendulum control system-%*This program determines the state-feedback gain%matrix K = k1,k2 k3 k4 by use of Ackermanns%formula*%*Enter matrices A,B,C,
9、and D*A=0100; 20.601000; 0 000; -0.4905000;B=0;-1;0;0.5;C=1 0 0 0; 0 0 1 0;D=0;0;%*Define the controllability matrix M and check its rank*Q=B A*B A2*B A3*B;rank(Q)ans= 4%*Since the rank of Q is 4, the system is completely%state controllable. Hence,arbitrary pole placement is %possible*%*Enter the de
10、sired characteristic polynomial,which $can be obtained defining the following matrix J and %entering statement poly(J)*J=-2+2*sqrt(3)*i000;0 -2-2*sprt(3)*i00;00-100;000-10JJ=poly(J)JJ=1.0e+003*0.00100.02400.19600.72001.6000%*Enter characteristic polynomial Phi*Phi=polyvalm(poly(J),A);%*State feedbac
11、k gain matrix K can be determined%from*K=0001*(inv(Q)*PhiK=-298.1504-60.6972-163.09889-73.39455.4.3 所得系统对初始条件的响应当状态反馈增益矩阵确定后,系统的性能就可由计算机仿真来检验。为了求得对任意初始条件的响应,可按下列步骤进行:系统的基本方程为状态方程和线性反馈控制律 将上述控制输入代入状态方程,可得 将有关数据代入上式,即(5.25) 下面我们用MATLAB来求所设计的系统对初始条件的响应。 系统的状态方程为式(5.25)。假设初始条件为(5.26) 将式(5.25)重写为式中 将初始条件
12、向量定义为,即则系统对初始条件的响应可通过求解下列方程得到(见随后的补充部分),即式中补充:考虑如下定义的系统,当初始条件给定时,我们求其响应。首先,我们对两边进行拉普拉斯变换得进一步的,得再取拉普拉斯反变换,得于是我们得到了一个包含初始条件的微分方程。现在定义于是两边积分得其中,。而因此,通过求解即可得到,初始条件为的响应。MATLAB Program 5.4 将求出由式(5.25)定义的系统对由式(5.26)指定的初始条件的响应。注意,在给出的MATLAB程序中,使用下了列符号:MATLAB Program 5.4%-Response to intial condition-%*This
13、program obtains the response of the system%xdot=(Ahat)x to the given initial condition x(0)*%*Enter matricesA,B,and K to produce matrix AA%=Ahat*A= 0100;20.601000;0001;-4.4905000;B=0;-1;0;0.5;K=-298.1504 -60.6972 -163.0989 -73.3945;AA=A-B*K;%*Enter the initial condition matrix BB=Bhat*BB=0.1;0;0;0;x
14、,z,t=step(AA,BB,AA,BB);x1=1000*x;x2=0100*x;x3=0010*x;x4=0001*x;%*Plot response curves x1 versus t,x2 versus t,x3 versus t,%and x4 versus t on one diagram*subplot(2,2,1);plot(t,x1,);gridtitle(x1(Theta) versus t)xlabel(t Sec)ylabel(x1 = Theta)subplot(2,2,2);plot(t,x2);gridtitle(x2(Theta dot) versus t)
15、xlabel(t Sec)ylabel(x2 = Theta dot)subplot(2,2,3);plot(t,x3);gridtitle(x3 (Displacement of Cart) versus t)xlabel(t Sec)ylabel(x3 = Displacement of Cart)subplot(2,2,4);plot(t,x4);gridtitle(x4(Velocity of Cart) versus t)xlabel(t Sec)ylabel(x4 = Velocity of Cart) 图5.4画出了用MATLAB Program 5.4求得的响应曲线。这些曲线表
- 1.请仔细阅读文档,确保文档完整性,对于不预览、不比对内容而直接下载带来的问题本站不予受理。
- 2.下载的文档,不会出现我们的网址水印。
- 3、该文档所得收入(下载+内容+预览)归上传者、原创作者;如果您是本文档原作者,请点此认领!既往收益都归您。
下载文档到电脑,查找使用更方便
10 积分
下载 | 加入VIP,下载更划算! |
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 现代控制理论 上海交大 现代 控制 理论 第五
