1、12设计实例例3-18 海底隧道钻机控制系统例3-21 哈勃太空望远镜指向控制例3-22 火星漫游车转向控制3例3-18 海底隧道钻机控制系统 连接法国和英国的英吉利海峡海底隧道于1987年12月开工建设,1990年11月,从两个国家分头开钻的隧道首次对接成功。隧道长37.82公里,位于海底面以下61m。隧道于1992年完工,共耗资14亿美元,每天能通过50辆列车,从伦敦到巴黎的火车行车时间缩短为3小时。例例3-18 海底隧道钻机控制系统海底隧道钻机控制系统4 钻机在推进过程中,为了保证必要的隧道对接精度,施工中使用了一个激光导引系统,以保持钻机的直线方向。钻机控制系统如图3-42所示。图中,
2、C(s)为钻机向前的实际角度,R(s)为预期角度,N(s)为负载对机器的影响。该系统设计目的是选择增益K,使系统对输入角度的响应满足工程要求,并且使扰动引起的稳态误差较小。图3-42 钻机控制系统K+11sE(s)+-+-N(s)G(s)钻机)1s(s1C(s)角度R(s)预期角度要求选择K,使输入的响应满足要求,并使扰动引起的稳态误差较小5解:应用梅森增益公式,可得在R(s)和N(s)作用下系统的输出为)(121)(1211)(22sNKsssRKsssKsC图3-42 钻机控制系统K+11sE(s)+-+-N(s)G(s)钻机)1s(s1C(s)角度R(s)预期角度要求选择K,使输入的响应
3、满足要求,并使扰动引起的稳态误差较小6该系统显然是稳定的。为了减少扰动的影响,希望增益K0。若取K=100,令r(t)=1(t)且n(t)=0,可得系统对单位阶跃输入的响应,如图3-43(a)所示;图3-43aC(t)时间(s)s(NKs12s1)s(RKs12ss11K)s(C22要求选择K,使输入的响应满足要求,并使扰动引起的稳态误差较小7令n(t)=1(t)且r(t)=0,可得系统对单位阶跃扰动的响应,如图3-43(b)所示。由图可见,负载产生的扰动影响很小,但系统阶跃响应的超调量偏大。)s(NKs12s1)s(RKs12ss11K)s(C22要求选择K,使输入的响应满足要求,并使扰动引
4、起的稳态误差较小图3-43bC(t)时间(s)-8 若取K=20,可得系统对单位阶跃输入与单位阶跃扰动的响应曲线,如图3-44所示。此时系统响应的超调量较小,扰动影响不大,其动态性能可以满足工程要求。图3-44 K=20时的单位阶跃下响应(实线)及单位阶跃扰动响应(虚线)C(t)时间(s)s(NKs12s1)s(RKs12ss11K)s(C22要求选择K,使输入的响应满足要求,并使扰动引起的稳态误差较小9 由于该钻机控制系统为型系统,因此在单位阶跃输入作用下的稳态误差 essr()=0可得系统在单位阶跃扰动作用下的稳态误差K1)s(sElim)(en0sssn于是,当K分别取为100或20时,
5、系统的稳态误差分别为-0.01和-0.05。)s(NKs12s1)s(C0)s(E2nn当r(t)=0,n(t)=1(t)时,系统的误差信号要求选择K,使输入的响应满足要求,并使扰动引起的稳态误差较小10 钻机控制系统在两种增益情况下的响应性能如表3-6所示。表3-6 钻机控制系统在两种增益情况下的响应性能-0.0500.91s3.86%20-0.0100.66s22%100单位阶跃扰动下稳态误差单位阶跃输入下稳态误差单位阶跃输入下调节时间(=2%)单位阶跃输入下超调量增益K由表3-6可见,应取K=20。要求选择K,使输入的响应满足要求,并使扰动引起的稳态误差较小11海底隧道钻机控制系统设计小
6、结海底隧道钻机控制系统设计小结:1.工程背景及设计要求;2.应用知识元要点:结构图与信号流图;控制与扰动作用下的闭环传递函数;(分母相同)特征根与稳定性;扰动作用下系统的稳态输出;(确定选择增益范围)控制作用与扰动作用下MATLAB仿真;123.扩展与引伸扩展与引伸(2)应用MATLAB方法搜索K=20 时,微分时间 Td (原为11,现设为变量)对系统稳态及动态性 能的影响;(3)当K及Td可选择时,理论探讨最佳参数集(K,Td),并给出MATLAB仿真结果。(1)PD控制方案的应用场合(输入端无高频噪声,否则堵塞控制通道);13例3-21 哈勃太空望远镜指向控制图3-53太空望远镜航天飞机
7、星光跟踪与数据中继卫星系统地面站例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制14 图3-53所示哈勃太空望远镜于1990年4月14日发射至离地球611公里的太空轨道,它的发射与应用将空间技术发展推向了一个新的高度。望远镜的2.4m镜头拥有所有镜头中最光滑的表面,其指向系统能在644公里以外将视野聚集在一枚硬币上。望远镜的偏差在1993年12月的一次太空任务中得到了大规模的校正。例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制15哈勃太空望远镜指向系统模型如图3-54(a)所示,经简化后的结构图如图3-54(b)所示。R(s)+-E(s)KaN(s)+G(s)Ks(s11
8、C(s)例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制R(s)指令+-放大器Ka扰动N(s)+-望远镜动力学1/s2K1sC(s)指向16设计目标是选择放大器增益Ka和具有增益调节的测速反馈系数K1,使指向系统满足如下性能:(1)在阶跃指令r(t)作用下,系统输出的超调量小于或等于10%;(2)在斜坡输入作用下,稳态误差达到最小;(3)减小单位阶跃扰动的影响。R(s)+-E(s)KaN(s)+G(s)Ks(s11C(s)例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制17解:由图3-54(b)知,系统开环传递函数)1Ks(sK)Ks(sK)s(G11a0式中,K=Ka/K
9、1为开环增益。例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制R(s)+-E(s)KaN(s)+G(s)Ks(s11C(s)18系统在输入与扰动同时作用下的输出)s(N)s(G1)s(G)s(R)s(G1)s(G)s(C000误差为)s(N)s(G1)S(G)s(R)s(G11)s(E00R(s)+-E(s)KaN(s)+G(s)Ks(s11C(s)例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制19 首先选择Ka与K1以满足系统对阶跃输入超调量的要求:令)w2s(sw)Ks(sK)s(Gn2n1a0可得a1anK2K,Kw例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜
10、指向控制R(s)+-E(s)KaN(s)+G(s)Ks(s11C(s)20因为%e100%21/解得22)(ln11代入=0.1,求出=0.59,取=0.6。因而,在满足%10%指标要求下,应选aa1K2.1K2K例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制21其次从满足斜坡输入作用下的稳态误差要求考虑Ka与K1的选择:令r(t)=Bt,由表3-5知a1ssrKBKKBe其Ka与K1选择应满足%10%要求,即应有,K2.1Ka1故有assrKB2.1e例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制R(s)+-E(s)KaN(s)+G(s)Ks(s11C(s)22上式表
11、明,Ka的选取应尽可能地大。最后,从减小单位阶跃扰动的影响考虑Ka与K1的选取。因为扰动作用下的稳态误差)s(sC)s(sEen0sn0sssnlimlimaa120s00sK1s1KsKs1s)s(N)s(G1)s(Gslimlim可见,增大Ka可以同时减小essn及essr。例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制23 在实际系统中,Ka的选取必须受到限制,以使系统工作在线性区。当取Ka=100时,有K1=12,所设计的系统如图3-55(a)所示;100)12s(s1R(s)+-E(s)+C(s)图3-55(a)所设计的系统N(s)例例3-21 哈勃太空望远镜指向控制哈勃
12、太空望远镜指向控制24系统对单位阶跃输入和单位阶跃扰动的响应如图3-55(b)所示。可以看出,扰动的影响很小。此时 essr=0.12B,essn=-0.01得到了一个很好的系统t(s)对r(t)的响应对干扰的响应C(t)例例3-21 哈勃太空望远镜指向控制哈勃太空望远镜指向控制254.根据系统在斜坡输入作用下,稳态误差最小的要求,导根据系统在斜坡输入作用下,稳态误差最小的要求,导 出放大器增益出放大器增益Ka的选取原则;的选取原则;5.根据减小单位阶跃扰动影响的要求(抗太阳风扰动),根据减小单位阶跃扰动影响的要求(抗太阳风扰动),确定放大器增益确定放大器增益Ka选取的约束范围;选取的约束范围
13、;6.Ka选取:线性区选取:线性区,参数值参数值Ka,K 1 适当,可实现;适当,可实现;系统动态性能好(系统动态性能好(MATLAB检验)检验)哈勃太空望远镜指向控制设计小结:哈勃太空望远镜指向控制设计小结:1.工程背景及设计要求;工程背景及设计要求;2.根据根据 要求确定系统需要的阻尼比要求确定系统需要的阻尼比 ;3.推导系统数学模型时,应根据开环推导系统数学模型时,应根据开环 标准形式,确定标准形式,确定 与待定参数与待定参数 K1与与Ka关系;关系;获得获得K1与与Ka应满足的关系式,应满足的关系式,减少未知量数;减少未知量数;%)(sG267.扩展与引伸扩展与引伸(1)有关参数优化:
14、如果要求)有关参数优化:如果要求 ,从而取,从而取 ,有有 当取当取 ,得,得 ,可否实现?如果可以,此时由,可否实现?如果可以,此时由 于于 未变,因而原设计达到的抗扰性能不变。试给未变,因而原设计达到的抗扰性能不变。试给出两种设计方案的单位阶跃相应(出两种设计方案的单位阶跃相应(MATLAB),并列表),并列表比较动态性能的结果。比较动态性能的结果。0%112aKK100aK 120K 100aK(2)有关性能优化:如果在控制结构中,再引入串联)有关性能优化:如果在控制结构中,再引入串联PI控制器,可否进一步优化系统性能(在控制器,可否进一步优化系统性能(在 ,基础上设计),并给出基础上设
15、计),并给出MATLAB仿真结果。仿真结果。100aK 120K 27例3-22 火星漫游车转向控制例例3-22 火星漫游车转向控制火星漫游车转向控制282930 1997年7月4日,以太阳能作动力的“逗留者号”漫游车在火星上着陆,其结构如图3-56所示。漫游车全重10.4kg,可由地球上发出的路径控制信号r(t)实施遥控。漫游车的两组车轮以不同的速度运行,以便实现整个装置的转向。例例3-22 火星漫游车转向控制火星漫游车转向控制31设计目标是选择参数K1与a,确保系统稳定,并使系统对斜坡输入的稳态误差小于或等于输入指令幅度的24%。漫游车转向控制系统及其结构图如图3-57所示。例例3-22
16、火星漫游车转向控制火星漫游车转向控制动力传动系统和控制器漫游车右左车轮力矩操纵调速阀门两组车轮的速度差C(s)漫游方向控制器Gc(s)1s()as(动力传动系统与漫游车G(s)5s)(2s(sK1+-R(s)预期的转动方向C(s)图3-57火星漫游车(a)双轮组漫游车的转向控制系统(b)结构图32解:由图3-57(b)可知,闭环特征方程为 1+Gc(s)G(s)=0于是有 s4+8s3+17s2+(10+K1)s+aK1=00)5s)(2s)(1s(s)as(K11即例例3-22 火星漫游车转向控制火星漫游车转向控制控制器Gc(s)1s()as(动力传动系统与漫游车G(s)5s)(2s(sK1
17、+-R(s)预期的转动方向C(s)33aK1s0s1 aK1s210+K18s3aK1171s48K12611211K126KK)a64116(1260 为了确定K1和a的稳定区域,建立如下劳思表:例例3-22 火星漫游车转向控制火星漫游车转向控制s4+8s3+17s2+(10+K1)s+aK1=034aK1s0s1 aK1s210+K18s3aK1171s48K12611211K126KK)a64116(1260 由劳思稳定判据知,使火星漫游车闭环稳定的充分必要条件为:0KK)a64116(12600aK126K21111例例3-22 火星漫游车转向控制火星漫游车转向控制35当K10时,漫游
18、车系统的稳定区域如图3-58所示。例例3-22 火星漫游车转向控制火星漫游车转向控制0KK)a64116(12600aK126K21111稳定区域选定的K1和aK1图3-58火星漫游车稳定区域36 由于设计指标要求系统在斜坡输入时的稳态误差不大于输入指令幅度的24%,故需要对K1与a的取值关系加以约束。KAess令r(t)=At,其中A为指令幅度,系统的稳态误差例例3-22 火星漫游车转向控制火星漫游车转向控制控制器Gc(s)1s()as(动力传动系统与漫游车G(s)5s)(2s(sK1+-R(s)预期的转动方向C(s)37控制器Gc(s)1s()as(动力传动系统与漫游车G(s)5s)(2s
19、(sK1+-R(s)预期的转动方向C(s)于是1ssaKA10e式中静态速度误差系数10aK)s(G)s(sGlimK1c0sKAess例例3-22 火星漫游车转向控制火星漫游车转向控制38 若取aK1=42,则ess等于A的23.8%,正好满足指标要求。例例3-22 火星漫游车转向控制火星漫游车转向控制1ssaKA10e因此,在图3-58的稳定区域中,在K1126的限制条件下,任取满足aK1=42的a与K1值。例如:K1=70,a=0.6;或者K1=50,a=0.84等参数组合。稳定区域选定的K1和aK1图3-58火星漫游车稳定区域39火星漫游车转向控制设计小结:火星漫游车转向控制设计小结:
20、从1997年“逗留者号”到2004年“勇气号”的发展;从概括了解到验证火星上是否有“水”,或曾有“水”激发人类征服宇宙的决心与信心;主要是稳态要求:确保稳定性,有一定斜坡输入下稳态误差要求(通过双通道速度控制之差实现转向,不能翻车)1.工程背景与设计要求:402.设计思想(1)稳定性设计 由于是四阶系统,故先确定闭环特征方程;控制器为超前-滞后网络,串联校正,具有可调零点,待定控制参数为系统零点a及漫游车动力传动系统增益K1;由于有两个控制参数,可用劳斯判据确定K1与a的稳定区域。具体位置应按满足斜坡作用下的稳态误差要求确定。(2)满足稳态误差要求的参数对(K1,a)设计 斜坡输入作用下的稳态误差 Kv 关系;Kv与 K1与 a关系;由 (r(t)=At ),确定(K1,a)参数对。)(sseAess%24)(41(1)全方位性能要求:一个实际工程系统,不仅有稳态要求,还应有动态要求与频带要求,试用MATLAB求出(或绘出)漫游车系统在(K1,a)(70,0.6)或(50,0.84)下的闭环零极点,单位斜坡响应及闭环频率响应及带宽。3.扩展与引伸扩展与引伸42K1a126参数选择域参数选择域(2)参数鲁棒域确定:利用理论推导或MATLAB仿真方法,可否在漫游车容许参数稳定区域内,确定使斜坡作用下系统动态性能及频宽较“好”的子区域?