《MATLAB语言与控制系统仿真》课程设计六条腿步行器系统的校正与优化.doc
《《MATLAB语言与控制系统仿真》课程设计六条腿步行器系统的校正与优化.doc》由会员分享,可在线阅读,更多相关《《MATLAB语言与控制系统仿真》课程设计六条腿步行器系统的校正与优化.doc(30页珍藏版)》请在三一办公上搜索。
1、 2008 级MATLAB语言与控制系统仿真课程大作业姓 名 * 学 号 * 所在院系 电气与电子工程 班 级 * 日 期 2011年1月12日 同组人员 作业评分 评阅人 六条腿步行器系统的校正与优化一、简介如图1所示,本报告的研究对象是一个六条腿自动行走的机器系统。由于该系统的特定用途,它需要准确而快速的响应,对带宽的要求严格,在控制系统中具有典型的代表性。因而本报告选择该系统进行分析,分别用三种方法来进行校正和优化:时域法进行串联校正;频率法进行超前校正;状态空间法进行极点配置。以达到举一反三,活学活用的效果。图1,六条腿步行器系统的实物图该系统的控制对象是六条腿的位移,通过输入信号来控
2、制系统的位移,其传递函数为,因为系统要求准确迅速和抗干扰能力强,故有如下性能指标要求:1、1型系统,阶跃响应的稳态误差为零;2、通频带带宽要大于1Hz;3、阶跃响应的超调量要小于15% ;4、响应要快,调整时间在1秒以内。首先用MATLAB描述步行器系统模型,并观察该系统的阶跃响应和频谱图。%描述系统模型,传递函数形式num0=1;den0=1 2 10 0; num,den=cloop(num0,den0);t=0:0.001:50;step(num,den,t) %求闭环模型阶跃响应图2,原系统闭环阶跃响应由响应图可知系统阻尼比大,响应很慢,调节时间38.5s。%求闭环系统Bode图sys
3、=tf(num,den)w=logspace(-1,2,400);bode(sys,w)margin(sys)图2,原系统闭环幅频相频曲线由图可以看出,系统的带宽不足。其通频带带宽可由如下程序算出:w=logspace(-1,2,400);mag,phase,w=bode(num,den,w);y,L=max(mag);wblist=find(mag0.707);wb=w(wblist(1)得结果 wb =0.1035,远小于6.28。为此,我们主要的目标是改善阻尼比和带宽。二、正文1、时域法串联校正a、设计方法指标1要求系统是一阶系统即可,指标2要求系统的自然频率比较大,由书中所给公式有,且
4、系统的阻尼比要小于0.707,这样能得到比较理想的带宽,指标3要求超调量PO15%,则要求阻尼比。最后,指标4要求系统有尽可能小的时间,为此在满足带宽的条件下,我们可以寻找到合适的阻尼比系数,程序如下:%寻找合适的阻尼比,阴尼比以damp表示damp=0.5:0.001:0.707;wB=6.28;Wn=wB./(-1.1961*damp+1.8508);Ts=4./(damp.*Wn);plot(damp,Ts)nb=find(damp=0.7);wn=Wn(nb)得结果wn =6.1962,带宽满足要求,由输出的Ts随阻尼比变化图可知,选择,能够得到比较快的响应速度。(注:教材中所选阻尼比
5、是0.52,是因为分析有误,错误之处为“in general , selecting larger results in a larger settling time”1)图3,系统调节时间Ts随阻尼比变化的关系本小节采用教材所用方案,意在对其优化,我们所加的串联校正器为。之所以采用此种PID控制器的变形,是因为,它有四个示知数,串联入系统中后,系统是四阶的,配置所需极点时正好能列出四个方程,于是可以得出合理的解,否则参数比方程多或者参数比方程少,都会给求解带来困难,而且常常是无解。在MATLAB中,可用以下形式表示控制器: numc=k*1 a b;denc=0 1 c;同教材,所需配置的闭
6、环极点特征方程式为;选取10,编程可得校正器的具体参数值:%求当阻尼比为0.7时的系统阶跃响应damp=0.7;wB=6.28;wn=wB/(-1.1961*damp+1.8508);alph=10;%求解出四元方程解c=2*damp*wn*(1+alph)-2k=wn2*(1+alph*damp2*(4+alph)-10-2*ca=(2*alph*damp*wn3*(1+damp2*alph)-10*c)/kb=alph2*damp2*wn4/k得到结果为:c = 93.4210 k =2.4753e+003 a =7.5609 b =29.1786 接着我们得到校正后闭环系统的阶跃响应图。
7、%建系统闭环模型numc=k*1 a b;denc=0 1 c;num0=1;den0=1 2 10 0;num,den=series(numc,denc,num0,den0);n,d=cloop(num,den);t=0:0.002:1.5;step(n,d,t)得到结果响应图:图4,阻尼比等于0.7时的闭环系统阶跃响应验证频率特性是否满足条件,求带宽:%求其带宽w=logspace(-1,2,400);mag,phase,w=bode(n,d,w);%得到其幅频图semilogx(w,mag),gridylabel(Mag),xlabel(Frequency)y,L=max(mag);wb
8、list=find(mag0.707);wb=w(wblist(1)Mp=ywr=w(L)得到结果为wb =40.6464 Mp =1.2165 wr =10 带宽为40多,满足要求。其幅频图如下:图5, 阻尼比等于0.7时的闭环系统幅频图b、结果分析与探讨与教材所选阻尼比相比较可得,系统响应的超调量相差不大,但当阻尼比等于0.7时,系统的响应速度要快很多。图6,教材中阻尼比等于0.52时的闭环系统阶跃响应但我们可以发现一个问题,超调量与我们的理论值不相符,比我们的理论大一些。:“一个不能忽略的零点对系统的影响是使超调量加大,响应速度加快,这是由于零点具有微分的作用;一个不能忽略的极点对系统的
9、影响是使超调量减小,调节时间增加,这是由于极点的滤波作用(或称为阻尼作用)。2”由此,我们可知,是串联的校正器引入了零点的原因,使超调量大于理论值。可以用仿真来验证这一结论的正确性,另一比较对象是只包含该系统极点,不含零点的闭环系统。%求不引入零点的闭环系统的响应,用作比较damp=0.7;wB=6.28;wn=wB/(-1.1961*damp+1.8508);alph=10;%配置的极点模型dspole=conv(1 2*damp*wn wn2,conv(1 alph*damp*wn,1 alph*damp*wn);kdc=dcgain(1,dspole); %求直流增益,让稳态误差为零t=
10、0:0.002:1.5;step(1/kdc,dspole,t)图7,不含零点的闭环系统响应图 由图7所示,不含零点时其超调量为4.49%,符合理论值,且反应速度变慢,可知前述结论是正确的。c、优化设计以前述理论为基础,我们可以对改变系统的极点来优化校正方案,具体表现为:闭环极点特征方程式中,通过改变的大小,可以改变闭环系统的极点位置,由于所添加的极点有阻尼作用,可以通过控制添加极点的位置,来达到改善超调量及响应时间的目的。令分别等于2,4,8,10,15,20,25,30,35,40,45,50,求出超调量PO、调节时间Ts及带宽wb和谐振峰值Mp,列成表以供分析比较用。程序如下:%子函数部
11、分%解四元方程得到校正器参数再得到系统闭环模型function n,d=model(alph); %定义子函数global damp wn %全局变量阻尼比和自然频率%求校正器参数c=2*damp*wn*(1+alph)-2;k=wn2*(1+alph*damp2*(4+alph)-10-2*c;a=(2*alph*damp*wn3*(1+damp2*alph)-10*c)/k;b=alph2*damp2*wn4/k;%求系统闭环模型numc=k*1 a b;denc=0 1 c;num0=1;den0=1 2 10 0;num,den=series(numc,denc,num0,den0);
12、n,d=cloop(num,den);%主函数部分%当变化时求系统的超调量PO、调节时间Ts及带宽wb和谐振峰值Mpglobal damp wn %定义全局变量阻尼比和自然频率,并赋值,供子函数调用damp=0.52;wB=6.28;wn=wB/(-1.1961*damp+1.8508);alph=2 4 8 10 15 20 25 30 35 40 45 50; %的取值for i=1:1:12 %循环求值t=0:0.0001:4;n,d=model(alph(i); %调用子函数得到系统闭环模型y=step(n,d,t); %求系统闭环模型的阶跃响应数据PO(i)=100*(max(y)-
13、1); %求超调量%求调节时间TsL=find(abs(y-1)0.02); Ts(i)=t(L(length(L); w=logspace(-1,2,400);%求系统闭环模型的幅频特性mag,phase,w=bode(n,d,w);y,L=max(mag);wblist=find(mag0.707); %求带宽wb(i)=w(wblist(1);Mp(i)=y; %求谐振峰值wr(i)=w(L); %求谐振频率endPO,Ts,wb,Mp,wrfigure(1) %图1得到PO、TsAX1,H11,H12=plotyy(alph,PO,alph,Ts);gridset(get(AX1(1)
14、,Ylabel),String,PO)set(get(AX1(2),Ylabel),String,Ts)set(H11,Marker,*,LineStyl,none)set(H12,Marker,d,LineStyl,none)figure(2) %图2得到Mp、wbAX2,H21,H22=plotyy(alph,wb,alph,Mp);gridset(get(AX2(1),Ylabel),String,wb)set(get(AX2(2),Ylabel),String,Mp)set(H21,Marker,*,LineStyl,none)set(H22,Marker,d,LineStyl,non
15、e)以下为输出图:图8,PO与Ts随变化时的取值图9,wb与Mp随变化时的取值由图分析可得,当增大时,调节时间减小,超调减小,且带宽增加,性能会有改善,所以选一些的值,会有比较优良的性能。同时我们也可看出,当大于40以后,对超调量与调节时间的影响已经并不大了,增大作用不大,且太大时,校正器增益比较大,不易实现。所以,选择,能得到比较理想的性能。取,适当修改前面的程序即可得到其性能参数,在此不再赘述。其阶跃响应图为:图10, 时的闭环系统阶跃响应超调量为10%,调节时间为0.41秒。其校正器参数为c =109.6146,k =3.1868e+003,a =5.2387,b =23.1521。幅频
16、特性参数为:Mp =1.1391,wr =6.8326,wb =41.3563。可见性能很优越。如果实际系统还需改进的话,可以进一步减小的取值范围进行精确计算查找。2、频域法串联校正由前面的PID控制器串联校正法,我们可以观察到控制器的开环增益非常大,往往要加到近千倍的增益,这在实际系统中是很不容易实现的。例如:我们增加第5条性能指标要求校正环节的开环增益不能超过250此时,我们不能仅仅依靠增加开环系统的增益来达到增加带宽的目的,本小节将运用超前校正来解决这一问题。因为超前校正能够使系统的相位超前,故引入超前校正系统能够在增加系统开环带宽的同时也增加系统的相位裕度(相位裕度与阻尼比直接相关,相
17、位裕度加大,表示阻尼比系数也加大,意味着超调减小),能够满足系统的要求。a、设计方法超前校正环节的通用表达式为,本系统的开环带宽比较小,所以要先增加开环增益k以增大带宽,然后再进行相位超前校正。编程序先找到原系统在6.28处的增益,然后以此为依据进行补偿,过程如下%增加系统开环增益,使带宽增加sys0=tf(1,1 2 10 0);w=logspace(-1,2,400);mag0,phase0,w=bode(sys0,w);wB=6.28;mk=spline(w,mag0,wB); %插值得到穿越频率为6.28处的幅值k=1/mk %确定校正环节的增益值sysk=tf(k*sys0);mag
18、k,phasek=bode(sysk,w);bode(sysk,w) %得到幅相频特性图,找到相角裕度margin(sysk)图11, 增加开环增益后的Bode图程序得结果k =200.9966,校正环节的开环增益在要求的范围内。且由输出Bode图可以观察到系统的相位裕度为-66.9度,不稳定。由于超调量要求比较高,我们为达到比较高的阻尼比,需将目标相位裕度取为70度,由此可见,一个超前校正装置无法满足要求,三个串联的方案才可行。其校正环节应为。编程进行校正:%超前校正过程dsPm=70; %目标相位裕度Pmk=-67; %增加开环增益后的开环系统相位裕度Pmcha=dsPm-Pmk+10Pm
19、a=Pmcha*pi/180/3; %每个超前环节应该校正的相位裕度量alph=(1+sin(Pma)/(1-sin(Pma); MdB=20*log10(magk);am=-30*log10(alph);wgc=spline(MdB,w,am); %插值,寻找到实际的穿越频率点T=1/(wgc*sqrt(alph); num2,den2=series(alph*T 1,T 1,alph*T 1,T 1);num3,den3=series(num2,den2,alph*T 1,T 1); %三超前环节组成的校正器模型参数num,den=series(k,1 2 10 0,num3,den3);
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- MATLAB语言与控制系统仿真 MATLAB 语言 控制系统 仿真 课程设计 六条腿 步行 系统 校正 优化
链接地址:https://www.31ppt.com/p-3933032.html