发明名称 一种直接力气动力复合控制方法与前向拦截制导方法
摘要 本发明公开了一种直接力气动力复合控制方法与前向拦截制导方法,提出一种在考虑连续气动力和离散直接力特点的基础上,通过冲量等效法进行离散化的直接力设计方法,避免了复杂的控制分配问题;根据二维前向拦截导引运动模型和拦截导弹动力学模型,利用时间尺度分离,将拦截导弹和目标的质点运动学与加速度慢变子系统构成的动态系统,看成慢变子系统,将俯仰角速度动态子系统看成快变子系统,通过对俯仰角速度指令的跟踪控制设计得到了考虑直接力/气动力复合控制系统动态的前向拦截导引律。本发明避免了复杂的控制分配问题,前向拦截导引律的设计很方便地考虑了复合控制的动态和特点,便于利用空气动力系数的标称值进行插值计算,便于实际应用。
申请公布号 CN104019701A 申请公布日期 2014.09.03
申请号 CN201410230911.3 申请日期 2014.05.28
申请人 中国人民解放军海军航空工程学院 发明人 张友安;吴华丽;胡云安;赵国荣;粱勇
分类号 F41H11/02(2006.01)I;F42B15/01(2006.01)I 主分类号 F41H11/02(2006.01)I
代理机构 北京科亿知识产权代理事务所(普通合伙) 11350 代理人 汤东凤
主权项 一种直接力气动力复合控制方法与前向拦截制导方法,其特征在于,该直接力气动力复合控制方法与前向拦截制导方法包括:直接力/气动力复合控制,通过冲量等效法得到实施的直接力控制信号:在气动舵控制的基础上,直接力是连续的并进行控制设计,然后,通过冲量等效法进行离散化处理,得到离散直接力控制;<img file="FDA0000512265590000014.GIF" wi="54" he="68" />为加速度指令,K<sub>p</sub>为比例系数,K<sub>ω</sub>为ω<sub>z</sub>反馈系数,气动舵控制规律取为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>&delta;</mi><mi>z</mi></msub><mo>=</mo><msub><mi>K</mi><mi>p</mi></msub><mrow><mo>(</mo><msubsup><mi>a</mi><mi>I</mi><mi>c</mi></msubsup><mo>-</mo><msub><mi>a</mi><mi>I</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>K</mi><mi>&omega;</mi></msub><msub><mi>&omega;</mi><mi>z</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000011.GIF" wi="1277" he="85" /></maths>拦截导弹控制系统采用过载控制,法向加速度a<sub>I</sub>和俯仰角速度ω<sub>z</sub>易于测量,而攻角α难于测量,利用:a<sub>I</sub>=V<sub>I</sub>a<sub>4</sub>α (9)将式(6)、式(7)进一步表示为:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mover><mi>a</mi><mo>&CenterDot;</mo></mover><mi>I</mi></msub><mo>=</mo><mrow><mo>(</mo><mo>-</mo><msub><mi>a</mi><mn>4</mn></msub><mo>+</mo><msub><mi>a</mi><mn>4</mn></msub><msub><mi>a</mi><mn>5</mn></msub><msub><mi>V</mi><mi>I</mi></msub><msub><mi>K</mi><mi>p</mi></msub><mo>)</mo></mrow><msub><mi>a</mi><mi>I</mi></msub><mo>+</mo><msub><mi>V</mi><mi>I</mi></msub><msub><mi>a</mi><mn>4</mn></msub><mrow><mo>(</mo><mn>1</mn><mo>-</mo><msub><mi>a</mi><mn>5</mn></msub><msub><mi>K</mi><mi>&omega;</mi></msub><mo>)</mo></mrow><msub><mi>&omega;</mi><mi>z</mi></msub><mo>-</mo><msub><mi>a</mi><mn>4</mn></msub><msub><mi>a</mi><mn>5</mn></msub><msub><mi>V</mi><mi>I</mi></msub><msub><mi>K</mi><mi>p</mi></msub><msubsup><mi>a</mi><mi>I</mi><mi>c</mi></msubsup><mo>-</mo><mfrac><msub><mi>a</mi><mn>4</mn></msub><mi>M</mi></mfrac><mi>F</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000012.GIF" wi="1637" he="117" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>=</mo><mrow><mo>(</mo><mo>-</mo><mfrac><msub><mi>a</mi><mn>2</mn></msub><mrow><msub><mi>V</mi><mi>I</mi></msub><msub><mi>a</mi><mn>4</mn></msub></mrow></mfrac><mo>+</mo><msub><mi>a</mi><mn>3</mn></msub><msub><mi>K</mi><mi>p</mi></msub><mo>)</mo></mrow><msub><mi>a</mi><mi>I</mi></msub><mo>-</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>3</mn></msub><msub><mi>K</mi><mi>&omega;</mi></msub><mo>+</mo><msub><mi>a</mi><mi>I</mi></msub><mo>)</mo></mrow><msub><mi>&omega;</mi><mi>z</mi></msub><mo>-</mo><msub><mi>a</mi><mn>3</mn></msub><msub><mi>K</mi><mi>p</mi></msub><msubsup><mi>a</mi><mi>I</mi><mi>c</mi></msubsup><mo>+</mo><mfrac><mi>L</mi><mi>J</mi></mfrac><mi>F</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000013.GIF" wi="1517" he="146" /></maths>式(6)中令K<sub>jet</sub>=0,式(7)中令M<sub>jet</sub>=0;式(9)只考虑了气动力产生的过载;在设计气动舵控制系统时,即令F=0,针对不同的特征点,采用经典控制的设计方法即确定相应的K<sub>p</sub>、K<sub>ω</sub>;在临近空间,气动舵控制系统过载响应较缓慢,因此引入直接力进行复合控制,在气动舵控制基础上设计直接力控制的方法;首先,直接力是连续力F′,与舵控制系统类似,控制规律取为:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msup><mi>F</mi><mo>&prime;</mo></msup><mo>=</mo><msub><mi>K</mi><mi>PJ</mi></msub><mrow><mo>(</mo><msubsup><mi>a</mi><mi>I</mi><mi>c</mi></msubsup><mo>-</mo><msub><mi>a</mi><mi>I</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>K</mi><mi>DJ</mi></msub><msub><mi>&omega;</mi><mi>z</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000021.GIF" wi="1348" he="78" /></maths>其中,K<sub>PJ</sub>和K<sub>DJ</sub>是与K<sub>p</sub>、K<sub>ω</sub>相对应的比例系数和反馈系数;将F=F′代入式(10)、式(11),得:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mfenced open='' close=''><mtable><mtr><mtd><msub><mover><mi>a</mi><mo>&CenterDot;</mo></mover><mi>I</mi></msub><mo>=</mo><mrow><mo>(</mo><mo>-</mo><msub><mi>a</mi><mn>4</mn></msub><mo>+</mo><msub><mi>a</mi><mn>4</mn></msub><msub><mi>a</mi><mn>5</mn></msub><msub><mi>V</mi><mi>I</mi></msub><msub><mi>K</mi><mi>p</mi></msub><mo>+</mo><mfrac><mrow><msub><mi>a</mi><mn>4</mn></msub><msub><mi>K</mi><mi>PJ</mi></msub></mrow><mi>M</mi></mfrac><mo>)</mo></mrow><msub><mi>a</mi><mi>I</mi></msub><mo>+</mo><mo>[</mo><msub><mi>V</mi><mi>I</mi></msub><msub><mi>a</mi><mn>4</mn></msub><mrow><mo>(</mo><mn>1</mn><mo>-</mo><msub><mi>a</mi><mn>5</mn></msub><msub><mi>K</mi><mi>&omega;</mi></msub><mo>)</mo></mrow><mo>-</mo><mfrac><mrow><msub><mi>a</mi><mn>4</mn></msub><msub><mi>K</mi><mi>DJ</mi></msub></mrow><mi>M</mi></mfrac><mo>]</mo><msub><mi>&omega;</mi><mi>z</mi></msub><mo>-</mo></mtd></mtr><mtr><mtd><mrow><mo>(</mo><msub><mi>a</mi><mn>4</mn></msub><msub><mi>a</mi><mn>5</mn></msub><msub><mi>V</mi><mi>I</mi></msub><msub><mi>K</mi><mi>p</mi></msub><mo>+</mo><mfrac><mrow><msub><mi>a</mi><mn>4</mn></msub><msub><mi>K</mi><mi>PJ</mi></msub></mrow><mi>M</mi></mfrac><mo>)</mo></mrow><msubsup><mi>a</mi><mi>I</mi><mi>c</mi></msubsup></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>13</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000022.GIF" wi="1657" he="300" /></maths><maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mfenced open='' close=''><mtable><mtr><mtd><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>=</mo><mrow><mo>(</mo><mo>-</mo><mfrac><msub><mi>a</mi><mn>2</mn></msub><mrow><msub><mi>V</mi><mi>I</mi></msub><msub><mi>a</mi><mn>4</mn></msub></mrow></mfrac><mo>+</mo><msub><mi>a</mi><mn>3</mn></msub><msub><mi>K</mi><mi>p</mi></msub><mo>-</mo><mfrac><mrow><mi>L</mi><msub><mi>K</mi><mi>PJ</mi></msub></mrow><mi>J</mi></mfrac><mo>)</mo></mrow><msub><mi>a</mi><mi>I</mi></msub><mo>-</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>3</mn></msub><msub><mi>K</mi><mi>&omega;</mi></msub><mo>+</mo><msub><mi>a</mi><mi>I</mi></msub><mo>+</mo><mfrac><mrow><mi>L</mi><msub><mi>K</mi><mi>DJ</mi></msub></mrow><mi>J</mi></mfrac><mo>)</mo></mrow><msub><mi>&omega;</mi><mi>z</mi></msub><mo>+</mo></mtd></mtr><mtr><mtd><mrow><mo>(</mo><mfrac><mrow><mi>L</mi><msub><mi>K</mi><mi>PJ</mi></msub></mrow><mi>J</mi></mfrac><mo>-</mo><msub><mi>a</mi><mn>3</mn></msub><msub><mi>K</mi><mi>p</mi></msub><mo>)</mo></mrow><msubsup><mi>a</mi><mi>I</mi><mi>c</mi></msubsup></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>14</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000023.GIF" wi="1526" he="301" /></maths>采用经典控制设计方法类似地确定出K<sub>PJ</sub>和K<sub>DJ</sub>;式(12)表示的直接力是连续信号,而实际的直接力是离散脉冲信号,将连续直接力信号F′进行离散化等效处理,得到实施的直接力控制信号F;控制采样步长与发动机的工作周期同步,都为T;首先考虑曲线F′是单调的情况,用F<sub>T</sub>表示单个脉冲发动机的推力,则第一个周期所需侧喷脉冲发动机的个数n(0)由下式确定:n(0)=E[F′(0<sup>+</sup>)/F<sub>T</sub>] (15)其中,E[A]表示取不超过A的整数,若n(0)=0,表示无需使用侧喷发动机;于是,第一个周期的等效直接力F为F=F<sub>T</sub>·n(0);由于周期T很小,s<sub>1</sub>、s<sub>2</sub>、...s<sub>k</sub>、...可以用矩形面积来近似代替,即:s<sub>1</sub>=F′(0<sup>+</sup>)·Ts<sub>2</sub>=F′(T)·T···s<sub>k</sub>=F′[(k‑1)T]·T···第一个周期的面积等效处理后剩余的面积s<sub>1</sub>‑F<sub>T</sub>·T·n(0)与第二个周期的面积累加,由下式确定第二个周期所需脉冲发动机的个数n(1);n(1)=E[(s<sub>1</sub>+s<sub>2</sub>‑F<sub>T</sub>·T·n(0))/(F<sub>T</sub>·T)] (16)于是,第二个周期的等效直接力F为F=F<sub>T</sub>·n(1);以后各个周期采用类似的方法进行处理;其次考虑曲线F′有振荡的情况,冲量等效的方法与曲线F′是单调的情况一样,时间轴上方的面积是正的面积,时间轴下方的面积是负的面积,利用式(15)、式(16)求取n(0)、n(1)时会用到取整函数E[A],如果A<0,则E[A]相应地变为‑E[‑A],表示反方向侧喷脉冲发动机;与曲线F′是单调的情况一样,还有可能是在时间轴的下方单调上升的情况;同样,与曲线F′有振荡的情况类似,也有可能是先负后正有振荡的情况,利用式(15)、式(16)求取n(0)、n(1)时,如果A<0,E[A]相应地变为‑E[‑A];综上,第k个周期发动机侧喷的个数n(k‑1)可以统一表示为:<img file="FDA0000512265590000031.GIF" wi="1686" he="158" />其中,S为从0时刻开始到第k个周期曲线F′与时间轴之间的面积,N′为0时刻开始到第k‑1个周期之间发动机侧喷总个数;用q表示控制方式切换的阈值,当指令<img file="FDA0000512265590000032.GIF" wi="258" he="63" />时,按冲量等效法进行侧喷,采用直接力与气动力复合控制;当<img file="FDA0000512265590000033.GIF" wi="251" he="62" />时,不需要侧喷,完全利用气动舵进行控制;导引律设计,考虑直接力/气动力复合控制系统动态的前向拦截导引律;目标的速度及有关机动信息已知,为了简化导引律的设计,将拦截导弹和目标的质点运动学与加速度动力学构成的动态系统,看成慢变子系统,将俯仰角速度动态子系统看成快变子系统,通过对俯仰角速度指令的跟踪控制设计得到考虑直接力/气动力复合控制系统动态的前向追击拦截导引律;先设计慢变子系统:令e=δ‑Nθ (18)定义变量:<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mi>u</mi><mn>1</mn></msub><mo>=</mo><mi>&tau;</mi><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>+</mo><mi>e</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>19</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000041.GIF" wi="1222" he="82" /></maths>其中,τ为比例系数,反映了当u<sub>1</sub>=0时e→0的快慢程度;由式(18)知:<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mover><mi>&delta;</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mi>N</mi><mover><mi>&theta;</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>20</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000042.GIF" wi="1161" he="83" /></maths>由式(19)知<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><msub><mover><mi>u</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><mi>&tau;</mi><mover><mi>e</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>+</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>21</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000043.GIF" wi="1179" he="83" /></maths>其中:<maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><mover><mi>e</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>=</mo><mover><mi>&delta;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>-</mo><mi>N</mi><mover><mi>&theta;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>22</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000044.GIF" wi="1192" he="80" /></maths>由式(2)可得:<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><mover><mi>&theta;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>=</mo><mfrac><msub><mover><mi>a</mi><mo>&CenterDot;</mo></mover><mi>T</mi></msub><msub><mi>V</mi><mi>T</mi></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mover><mi>V</mi><mo>&CenterDot;</mo></mover><mi>&lambda;</mi></msub><mi>r</mi><mo>-</mo><msub><mi>V</mi><mi>&lambda;</mi></msub><msub><mi>V</mi><mi>r</mi></msub></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>23</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000045.GIF" wi="1203" he="151" /></maths>由式(3)可得:<maths num="0012" id="cmaths0012"><math><![CDATA[<mrow><mover><mi>&delta;</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>=</mo><mfrac><msub><mover><mi>a</mi><mo>&CenterDot;</mo></mover><mi>I</mi></msub><msub><mi>V</mi><mi>I</mi></msub></mfrac><mo>-</mo><mfrac><mrow><msub><mover><mi>V</mi><mo>&CenterDot;</mo></mover><mi>&lambda;</mi></msub><mi>r</mi><mo>-</mo><msub><mi>V</mi><mi>&lambda;</mi></msub><msub><mi>V</mi><mi>r</mi></msub></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>24</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000046.GIF" wi="1189" he="153" /></maths>利用式(2)、式(3)、式(13)、式(20)、式(22)—式(24),式(21)表示为:<maths num="0013" id="cmaths0013"><math><![CDATA[<mrow><msub><mover><mi>u</mi><mo>&CenterDot;</mo></mover><mi>I</mi></msub><mo>=</mo><msub><mi>g</mi><mi>a</mi></msub><msub><mi>&omega;</mi><mi>z</mi></msub><mo>+</mo><msub><mi>f</mi><mi>a</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>25</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000047.GIF" wi="1154" he="81" /></maths>其中:g<sub>a</sub>=τa<sub>4</sub><maths num="0014" id="cmaths0014"><math><![CDATA[<mrow><msub><mi>f</mi><mi>a</mi></msub><mo>=</mo><mrow><mo>(</mo><mn>1</mn><mo>-</mo><mi>&tau;</mi><msub><mi>a</mi><mn>4</mn></msub><mo>)</mo></mrow><mfrac><msub><mi>a</mi><mi>I</mi></msub><msub><mi>V</mi><mi>I</mi></msub></mfrac><mo>+</mo><mfrac><mrow><mi>&tau;</mi><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow><msup><mi>r</mi><mn>2</mn></msup></mfrac><mrow><mo>(</mo><msub><mover><mi>V</mi><mo>&CenterDot;</mo></mover><mi>&lambda;</mi></msub><mi>r</mi><mo>-</mo><msub><mi>V</mi><mi>&lambda;</mi></msub><mi>V</mi><mo>+</mo><mfrac><mrow><msub><mi>V</mi><mi>&lambda;</mi></msub><mi>r</mi></mrow><mi>&tau;</mi></mfrac><mo>)</mo></mrow><mo>-</mo><mfrac><mi>N</mi><msub><mi>V</mi><mi>T</mi></msub></mfrac><mrow><mo>(</mo><mi>&tau;</mi><msub><mover><mi>a</mi><mo>&CenterDot;</mo></mover><mi>T</mi></msub><mo>-</mo><msub><mi>a</mi><mi>T</mi></msub><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000051.GIF" wi="1063" he="130" /></maths>在式(13)代入式(24)时,近似认为<img file="FDA0000512265590000052.GIF" wi="417" he="79" />令<maths num="0015" id="cmaths0015"><math><![CDATA[<mrow><msub><mover><mi>u</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><mo>-</mo><msub><mi>k</mi><mi>a</mi></msub><msub><mi>u</mi><mn>1</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>26</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000053.GIF" wi="1177" he="79" /></maths>其中,k<sub>a</sub>>0,反映了拦截导弹和目标的质点运动学与加速度慢变子系统构成的动态系统的期望的带宽;令式(25)与式(26)相等,即:<maths num="0016" id="cmaths0016"><math><![CDATA[<mrow><msub><mi>g</mi><mi>a</mi></msub><msubsup><mi>&omega;</mi><mi>z</mi><mi>c</mi></msubsup><mo>+</mo><msub><mi>f</mi><mi>a</mi></msub><mo>=</mo><mo>-</mo><msub><mi>k</mi><mi>a</mi></msub><msub><mi>u</mi><mn>1</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>27</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000054.GIF" wi="1251" he="86" /></maths>可得:<maths num="0017" id="cmaths0017"><math><![CDATA[<mrow><msubsup><mi>&omega;</mi><mi>z</mi><mi>c</mi></msubsup><mo>=</mo><mfrac><mrow><mo>-</mo><msub><mi>k</mi><mi>a</mi></msub><msub><mi>u</mi><mn>1</mn></msub><mo>-</mo><msub><mi>f</mi><mi>a</mi></msub></mrow><msub><mi>g</mi><mi>a</mi></msub></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>28</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000055.GIF" wi="1230" he="149" /></maths>用惯性环节对<img file="FDA0000512265590000056.GIF" wi="62" he="73" />滤波可得<img file="FDA0000512265590000057.GIF" wi="116" he="78" />及<img file="FDA0000512265590000058.GIF" wi="142" he="82" />以备快变子系统设计中的式(30)和式(31)使用:<maths num="0018" id="cmaths0018"><math><![CDATA[<mrow><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mrow><mi>z</mi><mo>,</mo><mi>des</mi></mrow><mi>c</mi></msubsup><mo>=</mo><mfrac><mn>1</mn><msub><mi>T</mi><mi>m</mi></msub></mfrac><mrow><mo>(</mo><msubsup><mi>&omega;</mi><mi>z</mi><mi>c</mi></msubsup><mo>-</mo><msubsup><mi>&omega;</mi><mrow><mi>z</mi><mo>,</mo><mi>des</mi></mrow><mi>c</mi></msubsup><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>29</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000059.GIF" wi="1251" he="143" /></maths>这里T<sub>m</sub>为小时间常数;再设计快变子系统;定义变量:<maths num="0019" id="cmaths0019"><math><![CDATA[<mrow><msub><mi>u</mi><mn>2</mn></msub><mo>=</mo><msub><mi>&omega;</mi><mi>z</mi></msub><mo>-</mo><msubsup><mi>&omega;</mi><mrow><mi>z</mi><mo>,</mo><mi>des</mi></mrow><mi>c</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>30</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00005122655900000510.GIF" wi="1216" he="84" /></maths>则:<maths num="0020" id="cmaths0020"><math><![CDATA[<mrow><msub><mover><mi>u</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>-</mo><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mrow><mi>z</mi><mo>,</mo><mi>des</mi></mrow><mi>c</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>31</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00005122655900000511.GIF" wi="1214" he="82" /></maths>式(14)代入式(31)得:<maths num="0021" id="cmaths0021"><math><![CDATA[<mrow><msub><mover><mi>u</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><msub><mi>g</mi><mi>b</mi></msub><msubsup><mi>a</mi><mi>I</mi><mi>c</mi></msubsup><mo>+</mo><msub><mi>f</mi><mi>b</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>32</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000061.GIF" wi="1190" he="79" /></maths>其中:g<sub>b</sub>=K<sub>PJ</sub>‑a<sub>3</sub>K<sub>p</sub><maths num="0022" id="cmaths0022"><math><![CDATA[<mrow><msub><mi>f</mi><mi>b</mi></msub><mo>=</mo><mrow><mo>(</mo><msub><mi>a</mi><mn>3</mn></msub><msub><mi>K</mi><mi>p</mi></msub><mo>-</mo><mfrac><msub><mi>a</mi><mn>2</mn></msub><mrow><msub><mi>V</mi><mi>I</mi></msub><msub><mi>a</mi><mn>4</mn></msub></mrow></mfrac><mo>-</mo><msub><mi>K</mi><mi>PJ</mi></msub><mo>)</mo></mrow><msub><mi>a</mi><mi>I</mi></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>K</mi><mi>DJ</mi></msub><mo>-</mo><msub><mi>a</mi><mn>3</mn></msub><msub><mi>K</mi><mi>&omega;</mi></msub><mo>-</mo><msub><mi>a</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mi>&omega;</mi><mi>z</mi></msub><mo>-</mo><msubsup><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mrow><mi>z</mi><mo>,</mo><mi>des</mi></mrow><mi>c</mi></msubsup></mrow>]]></math><img file="FDA0000512265590000062.GIF" wi="1218" he="141" /></maths>令<maths num="0023" id="cmaths0023"><math><![CDATA[<mrow><msub><mover><mi>u</mi><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><mo>-</mo><msub><mi>k</mi><mi>b</mi></msub><msub><mi>u</mi><mn>2</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>33</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000063.GIF" wi="1222" he="80" /></maths>其中,k<sub>b</sub>>0,反映了俯仰角速度快变子系统的期望的带宽;令式(32)与式(33)相等,考虑直接力/气动力复合控制系统动态的导引律:<maths num="0024" id="cmaths0024"><math><![CDATA[<mrow><msubsup><mi>a</mi><mi>I</mi><mi>c</mi></msubsup><mo>=</mo><mfrac><mrow><mo>-</mo><msub><mi>k</mi><mi>b</mi></msub><msub><mi>u</mi><mn>2</mn></msub><mo>-</mo><msub><mi>f</mi><mi>b</mi></msub></mrow><msub><mi>g</mi><mi>b</mi></msub></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>34</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000512265590000064.GIF" wi="1224" he="150" /></maths>通过选取参数k<sub>a</sub>和k<sub>b</sub>,保证ω<sub>z</sub>与a<sub>I</sub>快慢可分离,取k<sub>b</sub>=(5~10)k<sub>a</sub>,这样,u<sub>2</sub>很快衰减到0,即ω<sub>z</sub>很快就能跟踪上<img file="FDA0000512265590000065.GIF" wi="140" he="82" />随后u<sub>1</sub>衰减到0,进而e也衰减到0,保证δ与θ按比例变化。
地址 264001 山东省烟台市芝罘区二马路188号
您可能感兴趣的专利