发明名称 纵向飞行模型簇复合频率控制器设计方法
摘要 本发明提供了一种纵向飞行模型簇复合频率控制器设计方法,该方法在给定不同高度、马赫数条件下通过扫频飞行试验直接确定获得全包线内的幅频和相频特性构成的模型簇;根据飞行包线内的幅频特性直接确定开环截止频率区间;根据飞行包线内的相频特性直接确定与截止频率区间所对应的相位裕度区间;通过加入多级串联滞后—超前补偿环节控制器并在飞行器全包线内的相位裕度指标和系统辨识中的模型辨识方法确定补偿环节个数和参数值;在飞行器全飞行包线内的幅值裕度指标<img file="2014100703350100004DEST_PATH_IMAGE002.GIF" wi="18" he="22" />分贝数给定情况下进行控制器效果验证;从相位裕度和幅值裕度的概念出发设计出符合全飞行包线的超调量小、平稳的低空飞行控制器。
申请公布号 CN103809457A 申请公布日期 2014.05.21
申请号 CN201410070335.0 申请日期 2014.02.28
申请人 西安费斯达自动化工程有限公司 发明人 史忠科
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 代理人
主权项 1.一种纵向飞行模型簇复合频率控制器设计方法,其特点是包括以下步骤:1)给定不同高度、马赫数下通过扫频飞行试验直接由允许飞行的全包线内的幅频和相频特性构成飞行器全包线内的升降舵与飞行高度之模型簇,对应的飞行器升降舵与飞行高度之间开环传递函数簇描述为:<maths num="0001"><![CDATA[<math><mrow><mi>G</mi><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msup><mi>e</mi><mrow><mo>-</mo><mi>&sigma;</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>)</mo></mrow><mi>s</mi></mrow></msup><mi>K</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>)</mo></mrow><mi>A</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>,</mo><mi>s</mi><mo>)</mo></mrow></mrow><mrow><mi>B</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>,</mo><mi>s</mi><mo>)</mo></mrow></mrow></mfrac></mrow></math>]]></maths>其中A(h,M,s)=s<sup>m</sup>+a<sub>m-1</sub>(h,M)s<sup>m-1</sup>+a<sub>m-2</sub>(h,M)s<sup>m-2</sup>+…+a<sub>1</sub>(h,M)s+a<sub>0</sub>(h,M)、B(h,M,s)=s<sup>n</sup>+b<sub>n-1</sub>(h,M)s<sup>n-1</sup>+b<sub>n-2</sub>(h,M)s<sup>n-2</sup>+…+b<sub>1</sub>(h,M)s+b<sub>0</sub>(h,M)为多项式,s为传递函数中常用的拉普拉斯变化后的变量,h,M分别为飞行高度和马赫数,σ(h,M)是俯仰回路的延迟时间,K(h,M)为随h,M变化的增益,a<sub>l</sub>(h,M),l=0,1,2,…,m-1为多项式A(h,M,s)中随h,M变化的系数簇,b<sub>i</sub>(h,M),i=0,1,2,…,n-1为多项式B(h,M,s)中随h,M变化的系数簇;2)根据飞行包线内的幅频特性直接确定开环截止频率区间确定方法为:从|G(jω)|=1即<img file="FDA0000470855000000012.GIF" wi="766" he="171" />中,得到开环截止频率ω<sub>c</sub>解的最大值ω<sub>cmax</sub>和最小值ω<sub>cmin</sub>,开环截止频率ω<sub>c</sub>区间为ω<sub>cmin</sub>≤ω<sub>c</sub>≤ω<sub>cmax</sub>;式中,jω为频率特性中的变量,j为虚部表示,ω为角频率;3)根据飞行包线内的相频特性,计算包线内最大相位裕度γ<sub>max</sub>(ω<sub>c</sub>)=max{180°-σ(h,M)ω<sub>c</sub>+arg[A(h,M,jω<sub>c</sub>)]-arg[B(h,M,ω<sub>c</sub>)]},ω<sub>cmin</sub>≤ω<sub>c</sub>≤ω<sub>cmax</sub>和包线内最小相位裕度γ<sub>min</sub>(ω<sub>c</sub>)=min{180°-σ(h,M)ω<sub>c</sub>+arg[A(h,M,jω<sub>c</sub>)]-arg[B(h,M,ω<sub>c</sub>)]},ω<sub>cmin</sub>≤ω<sub>c</sub>≤ω<sub>cmax</sub>直接确定与截止频率区间所对应的相位裕度区间为:γ<sub>min</sub>(ω<sub>c</sub>)≤γ(ω<sub>c</sub>)≤γ<sub>max</sub>(ω<sub>c</sub>),ω<sub>cmin</sub>≤ω<sub>c</sub>≤ω<sub>cmax</sub>;4)候选多级串联滞后—超前补偿环节的传递函数为:<maths num="0002"><![CDATA[<math><mrow><msub><mi>G</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>k</mi><mi>c</mi></msub><munderover><mi>&Pi;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><mfrac><mrow><msub><mi>T</mi><mrow><mi>D</mi><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow><mrow><mi>a</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><msub><mi>T</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow></mfrac><mo>&CenterDot;</mo><mfrac><mrow><msub><mi>T</mi><mrow><mi>D</mi><mn>2</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>/</mo><mi>a</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>+</mo><mn>1</mn></mrow><mrow><msub><mi>T</mi><mrow><mi>L</mi><mn>2</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow></mfrac></mrow></math>]]></maths>式中,k<sub>c</sub>为待确定的常数增益,N为整数,表示待确定的滞后—超前补偿环节的级数,T<sub>D1</sub>(i)、T<sub>L1</sub>(i)、T<sub>D2</sub>(i)、T<sub>L2</sub>(i),i=1,2,…,N为待确定的时间常数,a(i)&gt;1,i=1,2,…,N为待确定的参数;加入多级串联滞后—超前补偿环节后,从|G(jω)G<sub>c</sub>(jω)|=1即<maths num="0003"><![CDATA[<math><mrow><mo>|</mo><msub><mrow><mo>[</mo><msub><mi>k</mi><mi>c</mi></msub><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><mfrac><mrow><msub><mi>T</mi><mrow><mi>D</mi><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow><mrow><mi>a</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><msub><mi>T</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow></mfrac><mo>&CenterDot;</mo><mfrac><mrow><msub><mi>T</mi><mrow><mi>D</mi><mn>2</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>/</mo><mi>a</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>+</mo><mn>1</mn></mrow><mrow><msub><mi>T</mi><mrow><mi>L</mi><mn>2</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow></mfrac><mfrac><mrow><msup><mi>e</mi><mrow><mo>-</mo><mi>&sigma;</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>)</mo></mrow><mi>S</mi></mrow></msup><mi>K</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>)</mo></mrow><mi>A</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>,</mo><mi>s</mi><mo>)</mo></mrow></mrow><mrow><mi>B</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>,</mo><mi>s</mi><mo>)</mo></mrow></mrow></mfrac><mo>]</mo></mrow><mrow><mi>s</mi><mo>=</mo><mi>j&omega;</mi></mrow></msub><mo>|</mo><mo>=</mo><mn>1</mn></mrow></math>]]></maths>中,得到开环截止频率ω<sub>fc</sub>解的最大值ω<sub>fcmax</sub>和最小值ω<sub>fcmin</sub>,开环截止频率ω<sub>fc</sub>区间为ω<sub>fcmin</sub>≤ω<sub>fc</sub>≤ω<sub>fcmax</sub>,在飞行器全包线内的相位裕度指标γ<sup>*</sup>给定情况下,加入多级串联滞后—超前补偿环节后系统的相位裕度γ<sub>f</sub>(ω<sub>fc</sub>)应该满足:γ<sub>f</sub>(ω<sub>fc</sub>)=180°+arg[G(jω<sub>fc</sub>)]+arg[G<sub>c</sub>(jω<sub>fc</sub>)]&gt;γ<sup>*</sup>,ω<sub>fcmin</sub>≤ω<sub>fc</sub>≤ω<sub>fcmax</sub>即满足:180°-σ(h,M)ω<sub>fc</sub>+arg[A(h,M,jω<sub>fc</sub>)]-arg[B(h,M,ω<sub>fc</sub>)]+arg[G<sub>c</sub>(jω<sub>fc</sub>)]&gt;γ<sup>*</sup>ω<sub>fcmin</sub>≤ω<sub>fc</sub>≤ω<sub>fcmax</sub>在上述指标和极大似然准则或其它准则共同约束下,可以根据系统模型结构辨识中的极大似然方法或辨识方法确定滞后—超前补偿环节的级数N、常数增益k<sub>c</sub>、时间常数T<sub>D1</sub>(i)、T<sub>L1</sub>(i)、T<sub>D2</sub>(i)、T<sub>L2</sub>(i),i=1,2,…,N,待确定的参数a(i)&gt;1,i=1,2,…,N;5)在飞行器全包线内的幅值裕度指标L*分贝数给定情况下,从20log<sub>10</sub>G(jω)G<sub>c</sub>(jω)=-L<sup>*</sup>即<maths num="0004"><![CDATA[<math><mrow><mn>20</mn><msub><mi>log</mi><mn>10</mn></msub><mrow><mo>|</mo><msub><mrow><mo>[</mo><msub><mi>k</mi><mi>c</mi></msub><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>N</mi></munderover><mfrac><mrow><msub><mi>T</mi><mrow><mi>D</mi><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow><mrow><mi>a</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><msub><mi>T</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow></mfrac><mo>&CenterDot;</mo><mfrac><mrow><msub><mi>T</mi><mrow><mi>D</mi><mn>2</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>/</mo><mi>a</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>+</mo><mn>1</mn></mrow><mrow><msub><mi>T</mi><mrow><mi>L</mi><mn>2</mn></mrow></msub><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mi>s</mi><mo>+</mo><mn>1</mn></mrow></mfrac><mfrac><mrow><msup><mi>e</mi><mrow><mo>-</mo><mi>&sigma;</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>)</mo></mrow><mi>S</mi></mrow></msup><mi>K</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>)</mo></mrow><mi>A</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>,</mo><mi>s</mi><mo>)</mo></mrow></mrow><mrow><mi>B</mi><mrow><mo>(</mo><mi>h</mi><mo>,</mo><mi>M</mi><mo>,</mo><mi>s</mi><mo>)</mo></mrow></mrow></mfrac><mo>]</mo></mrow><mrow><mi>s</mi><mo>=</mo><mi>j&omega;</mi></mrow></msub><mo>|</mo><mo>=</mo><mo>-</mo><msup><mi>L</mi><mo>*</mo></msup></mrow></mrow></math>]]></maths>中,得到频率ω<sub>Lc</sub>解的最大值ω<sub>Lcmax</sub>和最小值ω<sub>Lcmin</sub>,ω<sub>Lc</sub>区间为ω<sub>Lcmin</sub>≤ω<sub>Lc</sub>≤ω<sub>Lcmax</sub>,判断:γ<sub>L</sub>(ω<sub>Lc</sub>)=180°+arg[G(jω<sub>Lc</sub>)]+arg[G<sub>c</sub>(jω<sub>Lc</sub>)]&gt;0,ω<sub>Lcmin</sub>≤ω<sub>Lc</sub>≤ω<sub>Lcmax</sub>即满足:180°-σ(h,M)ω<sub>Lc</sub>+arg[A(h,M,jω<sub>Lc</sub>)]-arg[B(h,M,ω<sub>Lc</sub>)]+arg[G<sub>c</sub>(jω<sub>Lc</sub>)]&gt;0ω<sub>Lcmin</sub>≤ω<sub>Lc</sub>≤ω<sub>Lcmax</sub>若满足,则飞行控制器设计完成,若不满足,再增加补偿环节级数或减小常数增益k<sub>c</sub>。
地址 710075 陕西省西安市高新区科技路金桥国际广场12101号