主权项 |
一种无人机编队飞行转弯防碰控制方法,其特征在于:所述方法通过以下步骤实现:步骤1,计算无人机的机动性能限制,即相对最大、最小速度;设定一个超调量σ,得到下式,<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfrac><mrow><msub><mi>v</mi><mi>min</mi></msub><mo>-</mo><msub><mo>*</mo><msub><mi>v</mi><mi>min</mi></msub></msub></mrow><mrow><msub><mi>V</mi><mn>0</mn></msub><mo>-</mo><msub><mi>V</mi><mi>min</mi></msub></mrow></mfrac><mo>=</mo><mi>σ</mi><mo>,</mo><mfrac><mrow><msub><mo>*</mo><msub><mi>v</mi><mi>max</mi></msub></msub><mo>-</mo><msub><mi>v</mi><mi>max</mi></msub></mrow><mrow><msub><mi>v</mi><mi>max</mi></msub><mo>-</mo><msub><mi>V</mi><mn>0</mn></msub></mrow></mfrac><mo>=</mo><mi>σ</mi><mo>;</mo></mrow>]]></math><img file="FDA0000593286880000011.GIF" wi="740" he="168" /></maths>式中,<img file="FDA0000593286880000012.GIF" wi="240" he="66" />是实际最小、最大速度,v<sub>min</sub>、v<sub>max</sub>是相对最小、最大速度,V<sub>0</sub>是进入转弯之前编队的飞行速度;步骤2,结合编队队形,计算出在转弯时转弯半径最大、最小的僚机,根据其相对最大、最小速度限制,调整长机的转弯半径;步骤3,根据调整后的长机转弯半径,经过编队构型位置关系的变化生成各僚机的转弯半径,得到最终编队转弯航路。 |