发明名称 无人机编队飞行转弯防碰控制方法
摘要 本发明所述的一种无人机编队飞行转弯防碰控制方法,针对同构的长机僚机型菱形编队,采用基于航路限制的方法,根据无人机的机动性能限制,对长机转弯航路进行修正,僚机根据与长机的相对位置更改各自航路,生成实际可飞的编队转弯航路。采用本发明的防碰方法编队跟踪误差减小,避免了编队结构的破坏,在航路规划上解决了编队转弯时的防碰问题。
申请公布号 CN104503457A 申请公布日期 2015.04.08
申请号 CN201410580151.9 申请日期 2014.10.24
申请人 南京航空航天大学 发明人 郜晨;龚华军;甄子洋;郑峰婴
分类号 G05D1/10(2006.01)I 主分类号 G05D1/10(2006.01)I
代理机构 江苏圣典律师事务所 32237 代理人 贺翔
主权项 一种无人机编队飞行转弯防碰控制方法,其特征在于:所述方法通过以下步骤实现:步骤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>&sigma;</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>&sigma;</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,根据调整后的长机转弯半径,经过编队构型位置关系的变化生成各僚机的转弯半径,得到最终编队转弯航路。
地址 210016 江苏省南京市秦淮区御道街29号
您可能感兴趣的专利