第十二章用MATLAB解最优控制问题及应用实例PPT学习课件.ppt_第1页
第十二章用MATLAB解最优控制问题及应用实例PPT学习课件.ppt_第2页
第十二章用MATLAB解最优控制问题及应用实例PPT学习课件.ppt_第3页
第十二章用MATLAB解最优控制问题及应用实例PPT学习课件.ppt_第4页
第十二章用MATLAB解最优控制问题及应用实例PPT学习课件.ppt_第5页
已阅读5页,还剩123页未读, 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

1、第十二章 用MATLAB解最优控制问题及应用实例,1,第十二章 用MATLAB解最优控制问题及应用实例,12.1 MATLAB工具简介 12.2 用MATLAB解线性二次型最优控制问题 12.3 用MATLAB解最优控制问题应用实例 12.4 小结,2,MATLAB是集数值运算、符号运算及图形处理等强大功能于一体的科学计算语言。作为强大的科学计算平台,它几乎能满足所有的计算需求。MATLAB具有编程方便、操作简单、可视化界面、优良的仿真图形环境、丰富的多学科工具箱等优点,尤其是在自动控制领域中MATLAB显示出更为强大的功能。,3,最优控制是在一定的约束条件下,从已给定的初始状态出发,确定最优

2、控制作用的函数式,使目标函数为极小或极大。在设计最优控制器的过程中,运用MATLAB最优控制设计工具,会大大减小设计的复杂性。 在前面的几章中,我们已经介绍了一些最优控制方法,在本章中我们将介绍一个最优控制问题的应用实例,讨论如何使用最优控制方法来设计自寻的制导导弹的最优导引律,并采用MATLAB工具实现最优导引律,通过仿真来验证最优导引律的有效性。,4,12.1 MATLAB工具简介,1, 系统模型的建立 系统的状态方程为:,5,在MATLAB中只需要将各个系数按照常规矩阵的方式输入到工作空间即可 ss(A,B,C,D),6,传递函数的零极点模型为:,在MATLAB中可以采用如下语句将零极点

3、模型输入到工作空间:,zpk(Z,P,KGain),7,传递函数模型在更一般的情况下,可以表示为复数变量s的有理函数形式:,8,在MATLAB中可以采用如下语句将以上的传递函数模型输入到工作空间: G=tf(num,den);,9,2, 系统模型的转换 把其他形式转换成状态方程模型 G1=ss(G) 把其他形式转换成零极点模型 G1=zpk(G) 把其他形式转换成一般传递函数模型 G1=tf(G),10,3, 系统稳定性判据 求出系统所有的极点,并观察系统是否有实部大于0的极点。 系统由传递函数 (num,den) 描述 roots(den) 系统由状态方程 (A,B,C,D) 描述 eig(

4、A),11,4, 系统的可控性与可观测性分析 在MATLAB的控制系统工具箱中提供了ctrbf()函 数。该函数可以求出系统的可控阶梯变换,该函数 的调用格式为: Ac,Bc,Cc,Dc,Tc,Kc=ctrbf(A,B,C) 在MATLAB的控制系统工具箱中提供了obsvf()函 数。该函数可以求出系统的可观测阶梯变换,该函 数的调用格式为: Ao,Bo,Co,Do,To,Ko=obsvf(A,B,C),12,5, 系统的时域分析 对于系统的阶跃响应,控制系统工具箱中给出了 一个函数step()来直接求取系统的阶跃响应,该函数 的可以有如下格式来调用: y=step(G,t) 对于系统的脉冲响

5、应,控制系统工具箱中给出了 一个函数impulse()来直接求取系统的脉冲响应,该 函数的可以有如下格式来调用: y=impulse (G,t),13,6, 系统的复域与频域分析 对于根轨迹的绘制,控制系统工具箱中给出了一 个函数rlocus()函数来绘制系统的根轨迹,该函数的 可以由如下格式来调用: R=rlocus(G,k),14,对于Nyquist曲线的绘制,控制系统工具箱中给出了一个函数nyquist()函数,该环数可以用来直接求解Nyquist阵列,绘制出Nyquist曲线,该函数的可以由如下格式来调用: rx,ry=nyquist(G,w) 对于Bode图,MATLAB控制工具箱中

6、提供了bode()函数来求取、绘制系统的Bode图,该函数可以由下面的格式来调用 mag,pha=bode(G,w),15,12.2 用MATLAB解线性二次型最优控制问题,一般情况的线性二次问题可表示如下: 设线性时变系统的方程为 其中, 为 维状态向量, 为 维控制向量, 为维输出向量。,16,寻找最优控制,使下面的性能指标最小,其中, 是 对称半正定常数阵, 是 对称半正定阵, 是 对称正定阵。,17,我们用最小值原理求解上述问题,可以把上述问题归结为求解如下黎卡提(Riccati)矩阵微分方程:,18,19,这个方程称为代数黎卡提方程。代数黎卡提方程的求解非常简单,并且其求解只涉及到矩

7、阵运算,所以非常适合使用MATLAB来求解。,20,方法一:,求解代数黎卡提方程的算法有很多,下面我们介绍一种简单的迭代算法来解该方程,令 ,则可以写出下面的迭代公式,21,22,23,%*MATLAB程序*% I=eye(size(A); iA=inv(I-A); E=iA*(I+A); G=2*iA2*B; H=R+B*iA*Q*iA*B; W=Q*iA*B; P0=zeros(size(A); i=0;,24,while(1),i=i+1; P=E*P0*E-(E*P0*G+W)*inv(G*P0*G+H)*(E*P0*G+W)+Q; if(norm(P-P0)eps),break; e

8、lse,P0=P; end end P=2*iA*P*iA; 我们把这个文件命名为mylq.m,方便我们以后调用来 求解代数黎卡提方程。,25,方法二: 在MATLAB的控制系统工具箱中提供了求解代数黎卡提方程的函数lqr(),其调用的格式为: K,P,E=lqr(A,B,Q,R) 式中输入矩阵为A,B,Q,R,其中(A,B)为给定的对象状态方程模型,(Q,R)分别为加权矩阵Q和R;返回矩阵K为状态反馈矩阵,P为代数黎卡提方程的解,E为闭环系统的零极点。,26,这里的求解是建立在MATLAB的控制系统工具箱中给出的一个基于Schur变换的黎卡提方程求解函数are()基础上的,该函数的调用格式为

9、: X=are(M,T,V),27,其中, 矩阵满足下列代数黎卡提方程,are是Algebraic Riccati Equation的缩写。 对比前面给出的黎卡提方程,可以容易得出,28,方法三: 我们也可以采用care()函数对连续时间代数黎卡提 方程求解,其调用方法如下: P,E,K,RR=care(A,B,Q,R,zeros(size(B),eye(size(A) 式中输入矩阵为A,B,Q,R,其中(A,B)为给定的对象状态方程模型,(Q,R)分别为加权矩阵Q和R;返回矩阵P为代数黎卡提方程的解,E为闭环系统的零极点,K为状态反馈矩阵,RR是相应的留数矩阵Res的Frobenius范数(

10、其值为:sqrt(sum(diag(Res*Res),或者用Norm(Res, fro)计算)。,29,采用care函数的优点在于可以设置P的终值条件,例如我们可以在下面的程序中设置P的终值条件为0.2;0.2。 P,E,K,RR=care(A,B,Q,R,0.2;0.2,eye(size(A) 采用lqr()函数不能设置代数黎卡提方程的边界条件。,30,例12-1,线性系统为: , 其目标函数是:,确定最优控制。,31,解: 方法一: A=0 1;-5,-3; B=0;1; Q=500 200;200 100; R=1.6667; mylq K=inv(R)*B*P P E,32,运行结果:

11、 K = 13.0276 6.7496 P = 67.9406 21.7131 21.7131 11.2495 E = -0.1111 0.2222 -1.1111 -0.7778,33,方法二: A=0 1;-5,-3; B=0;1; Q=500 200;200 100; R=1.6667; K,P,E=lqr(A,B,Q,R),34,运行结果: K = 13.0276 6.7496 P = 67.9406 21.7131 21.7131 11.2495 E =-7.2698 -2.4798,35,方法三: A=0 1;-5,-3; B=0;1; Q=500 200;200 100; R=1

12、.6667; P,E,K,RR=care(A,B,Q,R,zeros(size(B),eye(size(A),36,运行结果: P = 67.9406 21.7131 21.7131 11.2495 E = -7.2698 -2.4798 K =13.0276 6.7496 RR = 2.8458e-015,37,以上的三种方法的运行结果相同。我们可以得到,最优控制变量与状态变量之间的关系: 在以上程序的基础上,可以得到在最优控制的作用下的最优控制曲线与最优状态曲线,其程序如下:,38,%*MATLAB程序*% figure(pos,50,50,200,150,color,w); axes(p

13、os,0.15,0.14,0.72,0.72) ap=A-B*K; bp=B; C=1,0; D=0;,39,ap,bp,cp,dp=augstate(ap,bp,C,D); cp=cp;-K; dp=dp;0; G=ss(ap,bp,cp,dp); y,t,x=step(G); plotyy(t,y(:,2:3),t,y(:,4) ax,h1,h2=plotyy(t,y(:,2:3),t,y(:,4); axis(ax(1),0 2.5 0 0.1),axis(ax(2),0 2.5 -1 0),40,运行结果: 图12-1 最优控制曲线与最优状态曲线,41,该程序采用augstate函数将

14、状态变量作为输出变量,用于显示;输出项作为最优控制的输出。因此,阶跃响应输出y中,y(1)是系统输出,y(2)和y(3)是状态变量输出,y(4)是系统控制变量输出。用plotyy函数进行双坐标显示,并设置相应的坐标范围。,42,以上三种方法中,第一种方法易于理解黎卡提方程的解法,其解法简单但是并不可靠。第二种方法比起另两种方法使用方便,不易出错,所以我们推荐使用这种方法。但是采用lqr()函数不能设置代数黎卡提方程的边界条件,所以,如果题目设置了P的终值条件,我们只能使用第三种方法来求解,例如设置P的终值条件为0.2;0.2。,43,程序如下: %*MATLAB程序*% A=0 1;-5,-3

15、; B=0;1; Q=500 200;200 100; R=1.6667; P,E,K,RR=care(A,B,Q,R,0.2;0.2,eye(size(A),44,运行结果: P =67.7233 21.5685 21.5685 11.0961 E =-7.3052 -2.4723 K =13.0608 6.7775 RR =1.2847e-014 最优控制变量与状态变量之间的关系:,45,例12-2,无人飞行器的最优高度控制,飞行器的控制方程如下,46,是飞行器的高度; 是油门输入;设计控制律使得如下指标最小,初始状态 。绘制系统状态与控制输入,对如下给定的 矩阵进行仿真分析.,47,a)

16、. b). c). d).,48,解:线性二次型最优控制指标如下: 其中Q和R分别是对状态变量和控制量的加权矩阵, 线性二次型最优控制器设计如下: 1)、Q=diag(1,0,0),R=2时,由MATLAB求得最优状态反馈矩阵为 k1=0.7071 2.0772 2.0510, u(t)=k1*x(t); 所画状态响应曲线及控制输入响应曲线如下图12-2所示:,49,50,图12-2 状态响应曲线及控制输入响应曲线,51,2)、Q=diag(1,0,0),R=2000时,由MATLAB求得最优状态反馈矩阵为 k2=0.0224 0.2517 0.4166, u(t)= k2*x(t); 所画状

17、态响应曲线及控制输入响应曲线如下图12-3所示:,52,53,图12-3 状态响应曲线及控制输入响应曲线,54,3)、Q=diag(10,0,0),R=2时,由MATLAB求得最优状态反馈矩阵为 k3=2.2361 4.3892 3.3077,u(t)= k3*x(t); 所画状态响应曲线及控制输入响应曲线如下图12-4所示:,55,56,图12-4 状态响应曲线及控制输入响应曲线,57,4)、Q=diag(1,100,0),R=2时,由MATLAB求 得最优状态反馈矩阵为 k4=0.7071 7.6112 4.6076, u(t)= k4*x(t); 所画状态响应曲线及控制输入响应曲线如下图

18、12-5所示:,58,59,图12-5 状态响应曲线及控制输入响应曲线,60,由1),2),3),4)可分析如下:,图12-3与图12-2相比,当Q不变,R增大时,各相应曲线达到稳态所需时间增长,即响应变慢;但波动幅值变小,反馈矩阵变小;,图12-4与图12-2和图12-3相比,当Q对角线上第1个元素增大时,各相应曲线达到稳态所需时间变短,即响应快;但波动幅值变大,反馈矩阵增大;,61,由图12-5可知,当Q对角线上第2个元素增大时,状态x1,x2曲线达到稳态所需时间较长,即响应较慢,平缓的趋于零;状态x3,控制输入u达到稳态所需时间短,即响应快;状态x2,x3波动幅值较小,比图12-2和图1

19、2-4小,比图12-3稍大,控制输入u波动幅值比图12-2和图12-4小,比图12-3大;反馈矩阵最大。,62,综上所述可得结论:Q=diag(1,0,0),R=2时,系统各方面响应较好。 矩阵Q变大时,反馈矩阵变大; 当Q的对角线上第1个元素变大时,各曲线波动幅值变大,达到稳态所需时间变短;,63,当Q的对角线上第2个元素变大时,各曲线波动幅值变小;达到稳态所需时间,状态x1,x2增长,状态x3,控制输入u变短; 当R变大时,反馈矩阵变小;各曲线波动幅值变小;达到稳态所需时间变长。 所以根据实际的系统允许,我们应该适当选择Q和R。,64,%*MATLAB程序*% a=0 1 0;0 0 1;

20、0 0 -1/2;b=0;0;1/2;c=1 0 0;0 1 0;0 0 1;d=0;0;0; figure(1) q=1 0 0;0 0 0;0 0 0; r=2; k,p,e=lqr(a,b,q,r) x0=10;0;0; a1=a-b*k; y,x=initial(a1,b,c,d,x0,20);,65,n=length(x(:,3); T=0:20/n:20-20/n; plot(T,x(:,1),black,T,x(:,2),red,T,x(:,3),green); xlabel(time-s);ylabel(response); title(图(1.a) Q=diag(1,0,0)

21、,R=2时状态响应曲线) grid,hold on for j=1:n u(j,:)=-k*(x(j,:); end,66,figure(2) plot(T,u);xlabel(time-s);ylabel(response); title(图(1.b) Q=diag(1,0,0),R=2时控制输入u的响应曲线) grid,hold on %*,67,figure(3) qa=1 0 0;0 0 0;0 0 0; ra=2000; ka,pa,ea=lqr(a,b,qa,ra) x0=10;0;0; aa1=a-b*ka; ya,xa=initial(aa1,b,c,d,x0,60); na=

22、length(xa(:,3);,68,Ta=0:60/na:60-60/na; plot(Ta,xa(:,1),black,Ta,xa(:,2),red,Ta,xa(:,3),green); xlabel(time-s);ylabel(response); title(图(2.a) Q=diag(1,0,0),R=2000时状态响应曲线) grid,hold on for j=1:na ua(j,:)=-ka*(xa(j,:); end,69,figure(4) plot(Ta,ua);xlabel(time-s);ylabel(response); title(图(2.b) Q=diag(1

23、,0,0),R=2000时控制输入u的响应曲线) grid,hold on %*,70,figure(5) qb=10 0 0;0 0 0;0 0 0; rb=2; kb,pb,eb=lqr(a,b,qb,rb) x0=10;0;0; ab1=a-b*kb; yb,xb=initial(ab1,b,c,d,x0,20); nb=length(xb(:,3);,71,Tb=0:20/nb:20-20/nb; plot(Tb,xb(:,1),black,Tb,xb(:,2),red,Tb,xb(:,3),green); xlabel(time-s);ylabel(response); title(

24、图(3.a) Q=diag(10,0,0),R=2时状态响应曲线) grid,hold on for j=1:nb ub(j,:)=-kb*(xb(j,:); end,72,figure(6) plot(Tb,ub);xlabel(time-s);ylabel(response); title(图(3.b) Q=diag(10,0,0),R=2时控制输入u的响应曲线) grid,hold on %*,73,figure(7) qc=1 0 0;0 100 0;0 0 0; rc=2; kc,pc,ec=lqr(a,b,qc,rc) x0=10;0;0; ac1=a-b*kc; yc,xc=in

25、itial(ac1,b,c,d,x0,50); nc=length(xc(:,3);,74,Tc=0:50/nc:50-50/nc; plot(Tc,xc(:,1),black,Tc,xc(:,2),red,Tc,xc(:,3),green); xlabel(time-s);ylabel(response); title(图(4.a) Q=diag(1,100,0),R=2时状态响应曲线) grid,hold on for j=1:nc uc(j,:)=-kc*(xc(j,:); end,75,figure(8) plot(Tc,uc);xlabel(time-s);ylabel(respon

26、se); title(图(4.b) Q=diag(1,100,0),R=2时控制输入u的响应曲线) grid,hold on,76,12.3 用MATLAB解最优控制问题应用实例,12.3.1 导弹运动状态方程的建立 12.3.2 最优导引律的求解与仿真验证,77,在现有的自寻的导弹中,大都采用比例导引法。假设导弹和目标在同一平面内运动,按比例导引制导律,假设导弹的速度向量的旋转角速度 垂直于瞬时的弹目视线,并且正比于导弹与目标之间的视线角速率 ,假设目标的法向加速度为零,那么可得: (12-1),78,79,比例导引法是经典的导引方法。下面我们从最优控制理论的观点来研究自寻的导弹的最优导引规

27、律问题。,80,12.3.1 导弹运动状态方程的建立,导弹与目标的运动关系是非线性的,如果把导弹与目标的运动方程相对于理想弹道线性化,可得导弹运动的线性状态方程.,81,82,图12-6 导弹和目标运动几何关系图,83,假定 和 比较小,因此, 则,(12-4),84,以 表示 , 表示 (即 ),则 (12-5) (12-6),式中 表示目标的横向加速度, 表示导弹横向加速度,分别以 和 表示,那么 (12-7),85,86,这样可得导弹运动状态方程为: (12-10) (12-11),87,88,89,90,91,92,由于系统是线性的,指标函数是二次型的,因此,求最优控制规律就可以认为是

28、一个求解线性二次型的过程。 对于线性二次型问题,可采用变分法、极小值原理、动态规划或其他方法求得最优控制,93,94,12.3.2 最优导引律的求解与仿真验证,当不考虑弹体惯性时,而且假定目标不机动,即,导弹运动状态方程为 (12-24),95,96,97,98,99,100,101,102,下面将对最优导引律进行MATLAB仿真,并给出源代码和仿真结果。,图12-7 最优导引方框图,103,图12-8 最优导引攻击几何平面,104,105,106,107,108,109,110,111,以上列出了两维的最优导引制导的必要方程,但是使用最优导引制导的导弹并不是直接向着目标发射的,而是向着一个能

29、够导引导弹命中目标的方向发射,考虑了视线角之后可以得到导弹的指向角L。从图12-8中我们可以看出,如果导弹进入了碰撞三角区(如果目标和导弹同时保持匀速直线运动,导弹必定会命中目标),这时利用正弦公式可以得到指向角的表达式:,(12-53),112,但是实际上导弹不可能能确切地在碰撞三角区发射,所以不能精确地得到拦截点。因为我们不知道目标将会如何机动,所以拦截点位置只能大概地估计。事实上,这也是需要导航系统的原因!初始时刻导弹偏离碰撞三角的角度称之为指向角误差(Head-Error)。考虑了导弹初始时刻的指向角和指向角误差之后,导弹的初始速度分量可以表示为:,(12-54) (12-55),11

30、3,使用MATLAB编程,具体代码如下: %*MATLAB程序*% %最优制导律仿真,初始化系统的参数 clear all; %清除所有内存变量 global SignVc; pi=3.14159265; Vm=1000;Vt=500;%导弹和目标的速度 HeadError=0; %指向角误差,114,ThetaT=pi; %目标的速度方向 Rmx=0;Rmy=0; %导弹的位置 Rtx=5000;Rty=10000;%目标的位置 At=0; %目标法向加速度 Vtx=Vt*sin(ThetaT);%目标的速度分量 Vty=Vt*cos(ThetaT); Rtmx=Rtx-Rmx; %弹目相对

31、距离 Rtmy=Rty-Rmy; AmMax=15*9.8; %导弹的最大机动能力为15G Rtm=sqrt(Rtmx2+Rtmy2);,115,SightAngle=atan(Rtmx/Rtmy); %视线角 LeadAngle=asin(Vt*sin(SightAngle-ThetaT)/Vm); %指向角 Vmx=Vm*sin(SightAngle-LeadAngle+HeadError); %导弹的速度分量 Vmy=Vm*cos(SightAngle-LeadAngle+HeadError); Vtmx=Vtx-Vmx; Vtmy=Vty-Vmy; %弹目的相对运动速度,116,Vc=

32、-(Rtmx*Vtmx+Rtmy*Vtmy)/Rtm; SignVc=sign(Vc); %Vc的符号 Time=0;TimeStep=0.1; %时间和时间步长 file=fopen(output.txt,w);%将数据写入文件 %循环 while(1) %Vc改变符号仿真结束 if(sign(Vc) = SignVc) break; else,117,if(Rtm100) TimeStep=0.005; end SignVc=sign(Vc); %Vc的符号 %视线角速率 dSightAngle=(Rtmy*Vtmx-Rtmx*Vtmy)/(Rtm2); dTheta=3*Vc*dSightAngle/Vm; Theta=atan(Vmx/Vmy); %导弹加速度,118,Am=Vm*dTheta; %限制机动能力 if(AmAmMax) Am=AmMax; end

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论