CN114138003A - 一种小型固定翼无人机双机协同区域侦察方法 - Google Patents

一种小型固定翼无人机双机协同区域侦察方法 Download PDF

Info

Publication number
CN114138003A
CN114138003A CN202111212666.XA CN202111212666A CN114138003A CN 114138003 A CN114138003 A CN 114138003A CN 202111212666 A CN202111212666 A CN 202111212666A CN 114138003 A CN114138003 A CN 114138003A
Authority
CN
China
Prior art keywords
reconnaissance
area
scout
plan
point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202111212666.XA
Other languages
English (en)
Other versions
CN114138003B (zh
Inventor
高瑞周
张虎虎
张永胜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Luoyang Institute of Electro Optical Equipment AVIC
Original Assignee
Luoyang Institute of Electro Optical Equipment AVIC
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Luoyang Institute of Electro Optical Equipment AVIC filed Critical Luoyang Institute of Electro Optical Equipment AVIC
Priority to CN202111212666.XA priority Critical patent/CN114138003B/zh
Publication of CN114138003A publication Critical patent/CN114138003A/zh
Application granted granted Critical
Publication of CN114138003B publication Critical patent/CN114138003B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/10—Internal combustion engine [ICE] based vehicles
    • Y02T10/40—Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明提供了一种小型固定翼无人机双机协同区域侦察方法，基于时间同步的侦察区域划分策略，为保证侦察规划的快速性、可靠性，由双机编队中的主机执行统一规划，生成双机编队的完整航路，并完成任务点的分配；每架飞机独立自动执行各自的侦察航路，并实时反馈执行状态。本发明区域侦察规划实时性好、可靠性高，侦察计划可自动执行，具有较强的工程实现价值和较高的智能化水平，计算效率高、实时性好。

Description

一种小型固定翼无人机双机协同区域侦察方法
技术领域
本发明涉及无人机任务控制技术领域，尤其是一种无人机协同区域侦察方法。
背景技术
小型固定翼无人机因其巡航速度快、使用成本低，被广泛应用于空中侦察、监视等任务。对于较大面积区域，两架小型固定翼无人机无人机组成编队执行区域侦察，能够大幅度提高侦察效率。传统上，在编队起飞前，进行侦察规划，将侦察计划加载到每架飞机，起飞后执行。然而，对于编队飞行过程中临时指派的侦察区域，无法根据飞机当前态势在线实时生成侦察计划，只能依靠操作员手动调整计划，加重了操作负担，且计划非最优，侦察效率低。有人考虑将人工智能算法引入到在线多机协同区域侦察设计中，但运算复杂、实时性差，耗时几秒甚至几十秒，无法满足工程化要求。由于小型固定翼无人机的计算资源受限，目前尚无适合在小型固定翼无人机上运行，且满足实时要求的工程化双机协同区域侦察方法。
发明内容
为了克服现有技术的不足，本发明提供一种小型固定翼无人机双机协同区域侦察方法。本发明针对最为常见的凸多边形侦察区域，提出了基于时间同步的侦察区域划分策略；为保证侦察规划的快速性、可靠性，由双机编队中的主机执行统一规划，生成双机编队的完整航路，并完成任务点的分配；每架飞机独立自动执行各自的侦察航路，并实时反馈执行状态。相较于传统的无人机双机编队区域侦察问题，本发明能够在实时动态环境下使用，计算速度快，自动化程度高，能显著提高无人机执行区域侦察任务的自主性。
本发明基于时间同步原则，考虑飞机侦察效能，划分侦察区域，然后集中式实时生成双机侦察计划，并分发给每架飞机执行、监控计划执行进度，以实现区域侦察任务的在线规划与执行的自动化。
本发明解决其技术问题所采用的技术方案采用如下步骤：
步骤1：基于双机编队时间协同要求，考虑每架飞机的侦察效能，将侦察区域分割为两部分；具体步骤如下：
小型固定翼无人机双机编队包括长机M和僚机W，在空中飞行时，无人机操作员对一凸多边形形状的侦察区域P实施编队协同侦察；该凸多边形区域顶点有n个，其中n≥3，凸多边形区域经纬度坐标按逆时针排列分别为(λ1,φ1),(λ2,φ2),…,(λn,φn)，凸多边形区域的面积为AP，无人机操作员将侦察区域P数据传送到长机M，设长机M当前经度为λM，纬度为φM，高度为HM，速度为VM，可用最小转弯半径为RM；僚机W当前经度为λW，纬度为φW，高度为HW，速度为VW，可用最小转弯半径为RW；长机M的侦察效能，即单位时间内能够侦察的区域面积为AM，僚机W的侦察效能，即单位时间内能够侦察的区域面积为AW；根据GJB 6304-2008《2000中国大地测量系统》6.7.2中的高斯投影方法，将长机位置、僚机位置、凸多边形区域顶点位置转换到高斯投影平面直角坐标系中，长机位置、僚机位置、凸多边形区域顶点位置对应的坐标分别为(xM,yM)、(xW,yW)、(xi,yi)，其中1≤i≤n；
编队协同执行任务需要在时间上协调一致，因此双机编队执行协同区域侦察时要做到两架飞机花费时间相同，根据每架飞机的侦察效能，将侦察区域P分割为面积分别为A1、A2的两部分，且满足：
Figure BDA0003304663810000021
长机携带的侦察传感器沿侦察方向视场角为αM，垂直于侦察方向视场角为βM，则长机侦察效能表示为：
Figure BDA0003304663810000022
僚机携带的侦察传感器沿侦察方向视场角为αW，垂直于侦察方向视场角为βW，则僚机侦察效能表示为：
Figure BDA0003304663810000023
由公式(1)可得面积分割比例为：
Figure BDA0003304663810000024
在侦察区域所有顶点中选择与长机位置最近的顶点S(xvs,yvs)作为侦察区域分割起点，其中1≤vs≤n为侦察区域分割起点的序号；
从序号为j＝(vs+2)的任务区域顶点开始，其中若j大于n，则对n取余；小于1，则取n，若满足公式(5)：
Figure BDA0003304663810000031
其中Avs_j为由序号为vs、vs+1、…、j的侦察区域顶点围成的多边形的面积，Aj_vs为由序号为j、j+1、…、vs的侦察区域顶点围成的多边形的面积；按公式(5)继续按逆时针顺序检查下一个任务区域顶点，直到找到序号为k的侦察区域的一个顶点，使得：
Figure BDA0003304663810000032
其中Avs_k为由序号为vs、vs+1、…、k的侦察区域顶点围成的多边形的面积，Ak_vs为由序号为k、k+1、…、vs的侦察区域顶点围成的多边形的面积，Avs_k-1为由序号为vs、vs+1、…、k-1的侦察区域顶点围成的多边形的面积，Ak-1_vs为由序号为k-1、k、…、vs的侦察区域顶点围成的多边形的面积；
由公式(6)可知，在序号为k、k-1的两个任务区域顶点组成的边上，必然存在一点H，称之为分割点，Avs_H即是由序号为vs、vs+1、…、k-1的侦察区域顶点和点H围成的多边形pvs_H的面积，AH_vs是由点H和序号为k、k+1、…、vs的侦察区域顶点围成的多边形pH_vs的面积；采用二分搜索法寻找点H，得到点H的坐标；
步骤2：完成侦察区域分割后，由长机计算双机的侦察计划，具体步骤为：
长机待侦察区域为多边形pvs_H，僚机待侦察区域为多边形pH_vs，要求的侦察旁向重叠率为δ；
以长机侦察计划计算为例，以扫雪式航线实现对区域覆盖，扫雪式往返方向平行于直线l，l由顶点vs与点H连线确定；
扫雪式航段之间的距离为：
Δd1＝2HMtan(βM/2)(1-δ) (11)
设dvs_H为多边形pvs_H所有顶点中到直线l的最大距离，则扫雪式航段个数为：
Figure BDA0003304663810000041
根据平面几何，计算出每个扫雪式航段所在直线l1...lu与多边形pvs_H各条边分别有两个交点，设交点分别为
Figure BDA0003304663810000042
考虑到飞机转弯对侦察效果的影响，将交点向外延伸距离ρ作为侦察计划L1的航路点，ρ取Δd1到2Δd1之间，设延伸后的航路点为
Figure BDA0003304663810000043
Figure BDA0003304663810000044
将航路点
Figure BDA0003304663810000045
Figure BDA0003304663810000046
按飞行顺序排列，即形成侦察计划L1；
同理，计算僚机侦察计划L2；
侦察计划L1、L2计算完成后，根据GJB 6304-2008《2000中国大地测量系统》6.7.2中的高斯投影方法，将航路点转换为经纬度形式供飞行控制系统按照经纬度进行飞行；
步骤3：每架飞机自动执行各自的侦察计划，并实时计算侦察计划执行进度；按以下步骤计算：
长机将侦察计划L2通过无线数据链路发送给僚机，双机编队自动根据侦察计划执行区域侦察任务，在任务执行过程中，每架飞机实时计算计划执行进度，并反馈给操作员；
以长机为例，侦察计划L1的总长度为：
Figure BDA0003304663810000047
其中ωv,v+1为第v个航点和第v+1航点之间的距离；
Figure BDA0003304663810000048
在每个航电周期，按以下步骤计算计划执行进度：
a)从飞机的飞行控制系统获取到点T(xL1_t,yL1_t)，其中t为到点在侦察计划L1中的航点序号，计算当前飞机位置(xMc,yMc)与到点T的距离：
Figure BDA0003304663810000051
b)计算剩余侦察计划的长度：
Figure BDA0003304663810000052
c)计划执行进度按照下式计算
Figure BDA0003304663810000053
当η1≥100％时，侦察计划L1执行完成。
同理，计算僚机侦察计划L2的执行进度η2，当η2≥100％时，侦察计划L2执行完成；
侦察计划L1执行完成且侦察计划L2执行完成，此次双机协同区域侦察任务完成。
采用二分搜索法寻找点H的步骤为：
设序号为k的任务区域顶点坐标为(xk,yk)，序号为k-1的任务区域顶点坐标为(xk-1,yk-1)，点H(xH,yH)迭代初始值
Figure BDA0003304663810000054
坐标设置为：
Figure BDA0003304663810000055
设二分搜索区间迭代初始左端点C0坐标为
Figure BDA0003304663810000056
迭代初始右端点E0设置为
Figure BDA0003304663810000057
按下式设置：
Figure BDA0003304663810000058
设
Figure BDA0003304663810000059
为分割点第q次迭代中的值，
Figure BDA00033046638100000510
为二分搜索区间左端点第q次迭代的值，
Figure BDA00033046638100000511
为二分搜索区间右端点第q次迭代的值，
Figure BDA00033046638100000512
为分割点第q+1次迭代中的值，
Figure BDA0003304663810000061
为二分搜索区间左端点第q+1次迭代的值，
Figure BDA0003304663810000062
为二分搜索区间右端点第q+1次迭代的值；
Figure BDA0003304663810000063
即是由序号为vs、vs+1、…、vs-1的侦察区域顶点和点Hq围成的多边形的面积，
Figure BDA0003304663810000064
即是由点Hq和序号为k、k+1、…、vs的侦察区域顶点围成的多边形的面积；
迭代步骤如下：
a)当
Figure BDA0003304663810000065
时，迭代结束，分割点H即为Hq，否则进入步骤(b)继续向下迭代；
b)如果
Figure BDA0003304663810000066
令
Figure BDA0003304663810000067
如果
Figure BDA0003304663810000068
令
Figure BDA0003304663810000069
所述侦察旁向重叠率为δ取值范围为0≤δ＜1。
本发明的有益效果在于为双机编队在线区域侦察任务的规划与执行提供了完整的技术方案，综合考虑时间协同、侦察效率、计算能力、防撞等因素，区域侦察规划实时性好、可靠性高，侦察计划可自动执行，具有较强的工程实现价值和较高的智能化水平。使用某小型固定翼无人机对该发明提出的方法进行了两个架次的试飞验证。试飞结果表明，该方法计算效率高、实时性好，小型固定翼无人机能够在100ms内完成侦察区域分割和侦察计划计算，耗时比现有方法减少了90％以上；两架小型固定翼无人机按照侦察计划执行区域侦察任务，并同时完成。
附图说明
图1为本发明双机协同区域侦察流程图。
图2为本发明侦察区域分割示意图。
图3为本发明侦察计划计算示意图。
图4为实施例1侦察区域分割以及侦察计划计算示意图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
按以下步骤计算。
(一)侦察区域分割
小型固定翼无人机双机编队包括长机M和僚机W，在空中飞行时，无人机操作员对一凸多边形形状的侦察区域P实施编队协同侦察；该凸多边形区域顶点有n个，其中n≥3，凸多边形区域经纬度坐标按逆时针排列分别为(λ1,φ1),(λ2,φ2),…,(λn,φn)，凸多边形区域的面积为AP，无人机操作员将侦察区域P数据传送到长机M，设长机M当前经度为λM，纬度为φM，高度为HM，速度为VM，可用最小转弯半径为RM；僚机W当前经度为λW，纬度为φW，高度为HW，速度为VW，可用最小转弯半径为RW；长机M的侦察效能，即单位时间内能够侦察的区域面积为AM，僚机W的侦察效能，即单位时间内能够侦察的区域面积为AW；根据GJB 6304-2008《2000中国大地测量系统》6.7.2中的高斯投影方法，将长机位置、僚机位置、凸多边形区域顶点位置转换到高斯投影平面直角坐标系中，长机位置、僚机位置、凸多边形区域顶点位置对应的坐标分别为(xM,yM)、(xW,yW)、(xi,yi)，其中1≤i≤n；
编队协同执行任务需要在时间上协调一致，因此双机编队执行协同区域侦察时要做到两架飞机花费时间相同，根据每架飞机的侦察效能，将侦察区域P分割为面积分别为A1、A2的两部分，且满足
Figure BDA0003304663810000081
以使用最为广泛的垂直侦察为例计算每架飞机的侦察效能，长机携带的侦察传感器沿侦察方向视场角为αM，垂直于侦察方向视场角为βM，则长机侦察效能表示为：
Figure BDA0003304663810000082
僚机携带的侦察传感器沿侦察方向视场角为αW，垂直于侦察方向视场角为βW，则僚机侦察效能表示为：
Figure BDA0003304663810000083
由公式(1)可得面积分割比例为：
Figure BDA0003304663810000084
为尽快能执行区域侦察，在侦察区域所有顶点中选择与长机位置最近的顶点S(xvs,yvs)作为侦察区域分割起点，其中1≤vs≤n为侦察区域分割起点的序号；
从序号为j＝(vs+2)的任务区域顶点开始，其中若j大于n，则对n取余；小于1，则取n，若满足公式(5)：
Figure BDA0003304663810000085
其中Avs_j为由序号为vs、vs+1、…、j的侦察区域顶点围成的多边形的面积，Aj_vs为由序号为j、j+1、…、vs的侦察区域顶点围成的多边形的面积；按公式(5)继续按逆时针顺序检查下一个任务区域顶点，直到找到序号为k的侦察区域的一个顶点，使得：
Figure BDA0003304663810000086
其中Avs_k为由序号为vs、vs+1、…、k的侦察区域顶点围成的多边形的面积，Ak_vs为由序号为k、k+1、…、vs的侦察区域顶点围成的多边形的面积，Avs_k-1为由序号为vs、vs+1、…、k-1的侦察区域顶点围成的多边形的面积，Ak-1_vs为由序号为k-1、k、…、vs的侦察区域顶点围成的多边形的面积；
由公式(6)可知，在序号为k、k-1的两个任务区域顶点组成的边上，必然存在一点H，称之为分割点，如图2所示，其中vs、vs+1、k-1和k为侦察区域的顶点序号，取值范围为1-n，Avs_H即是由序号为vs、vs+1、…、k-1的侦察区域顶点和点H围成的多边形pvs_H的面积，AH_vs是由点H和序号为k、k+1、…、vs的侦察区域顶点围成的多边形pH_vs的面积；
采用二分搜索法寻找点H的步骤为：
设序号为k的任务区域顶点坐标为(xk,yk)，序号为k-1的任务区域顶点坐标为(xk-1,yk-1)，点H(xH,yH)迭代初始值
Figure BDA0003304663810000091
坐标设置为：
Figure BDA0003304663810000092
设二分搜索区间迭代初始左端点C0坐标为
Figure BDA0003304663810000093
迭代初始右端点E0设置为
Figure BDA0003304663810000094
按下式设置：
Figure BDA0003304663810000095
设
Figure BDA0003304663810000096
为分割点第q次迭代中的值，
Figure BDA0003304663810000097
为二分搜索区间左端点第q次迭代的值，
Figure BDA0003304663810000098
为二分搜索区间右端点第q次迭代的值，
Figure BDA0003304663810000099
为分割点第q+1次迭代中的值，
Figure BDA00033046638100000910
为二分搜索区间左端点第q+1次迭代的值，
Figure BDA00033046638100000911
为二分搜索区间右端点第q+1次迭代的值；
Figure BDA00033046638100000912
即是由序号为vs、vs+1、…、vs-1的侦察区域顶点和点Hq围成的多边形的面积，
Figure BDA0003304663810000101
即是由点Hq和序号为k、k+1、…、vs的侦察区域顶点围成的多边形的面积；
迭代步骤如下：
a)当
Figure BDA0003304663810000102
时，迭代结束，分割点H即为Hq，否则进入步骤(b)继续向下迭代；
b)如果
Figure BDA0003304663810000103
令
Figure BDA0003304663810000104
如果
Figure BDA0003304663810000105
令
Figure BDA0003304663810000106
(二)侦察计划计算
完成侦察区域分割后，由长机计算双机的侦察计划，具体步骤为：
长机待侦察区域为多边形pvs_H，僚机待侦察区域为多边形pH_vs，设要求的侦察旁向重叠率为δ，0≤δ＜1；
以长机侦察计划计算为例，以扫雪式航线实现对区域覆盖，扫雪式往返方向平行于直线l，l由顶点vs与点H连线确定；
扫雪式航段之间的距离为：
Δd1＝2HMtan(βM/2)(1-δ) (11)
设dvs_H为多边形pvs_H所有顶点中到直线l的最大距离，则扫雪式航段个数为：
Figure BDA0003304663810000111
根据平面几何，计算出每个扫雪式航段所在直线l1...lu与多边形pvs_H各条边分别有两个交点，设交点分别为
Figure BDA0003304663810000112
考虑到飞机转弯对侦察效果的影响，将交点向外延伸距离ρ作为侦察计划L1的航路点，ρ取Δd1到2Δd1之间，如图2所示，设延伸后的航路点为
Figure BDA0003304663810000113
Figure BDA0003304663810000114
将航路点
Figure BDA0003304663810000115
Figure BDA0003304663810000116
按飞行顺序排列，即形成侦察计划L1；
同理，计算僚机侦察计划L2。
侦察计划L1、L2计算完成后，根据GJB 6304-2008《2000中国大地测量系统》6.7.2中的高斯投影方法，将航路点转换为经纬度形式供飞行控制系统按照经纬度进行飞行；
(三)侦察计划执行
长机将侦察计划L2通过无线数据链路发送给僚机，双机编队自动根据侦察计划执行区域侦察任务，在任务执行过程中，每架飞机实时计算计划执行进度，并反馈给操作员；
以长机为例，侦察计划L1的总长度为：
Figure BDA0003304663810000117
其中ωv,v+1为第v个航点和第v+1航点之间的距离；
Figure BDA0003304663810000118
在每个航电周期，按以下步骤计算计划执行进度：
a)从飞机的飞行控制系统获取到点T(xL1_t,yL1_t)，其中t为到点在侦察计划L1中的航点序号，计算当前飞机位置(xMc,yMc)与到点T的距离：
Figure BDA0003304663810000121
b)计算剩余侦察计划的长度：
Figure BDA0003304663810000122
c)计划执行进度按照下式计算
Figure BDA0003304663810000123
当η1≥100％时，侦察计划L1执行完成。
同理，计算僚机侦察计划L2的执行进度η2，当η2≥100％时，侦察计划L2执行完成。
侦察计划L1执行完成且侦察计划L2执行完成，此次双机协同区域侦察任务完成。
实施例1：
该凸多边形侦察区域顶点有5个，其经纬度坐标按逆时针排列分别为顶点1(113.2498334°，34.9309586°)、顶点2(113.2575528°，34.9393197°)、顶点3(113.2518904°，34.9496531°)、顶点4(113.2290595°，34.9455045°)、顶点5(113.2315517°，34.9274423°)。长机M当前经度为113.25°，纬度为34.93°，高度为180米，速度为35米/秒；僚机W当前经度为113.249°，纬度为34.929°，高度为160米，速度为32米/秒。长机和僚机携带相同的传感器，垂直于侦察方向视场角51°，沿侦察方向视场角30°，所要求的航向重叠率为0.3。
根据公式(2)、(3)、(4)，可得面积分割比例λ＝1.3843，进而求得分割点坐标经纬度为(113.2308013°，34.9458211°)，如图4所示。
长机侦察计划L1航点如表1所示，如图4所示。
表1长机侦察计划L1航点
Figure BDA0003304663810000124
Figure BDA0003304663810000131
长机侦察计划L2航点如表2所示，如图4所示。
表2长机侦察计划L2航点
航点序号 经度(度) 纬度(度) 高度(米) 速度(m/s)
1 113.2486861 34.9300751 160 32
2 113.2283942 34.9459209 160 32
3 113.2289447 34.9419327 160 32
4 113.2450297 34.9293720 160 32
5 113.2413733 34.9286689 160 32
6 113.2294950 34.9379445 160 32
7 113.2300453 34.9339563 160 32
8 113.2377170 34.9279656 160 32
9 113.2340608 34.9272622 160 32
10 113.2305956 34.9299681 160 32
在执行任务的某一时刻，长机经纬度坐标为(113.25°，34.945°)，到点号为8，则侦察计划L1执行进度为75.56％。
在执行任务的某一时刻，僚机经纬度坐标为(113.235°，34.93673°)，到点号为4，则侦察计划L2执行进度为41.94％。

Claims (3)

1.一种小型固定翼无人机双机协同区域侦察方法，其特征在于包括下述步骤：
步骤1：基于双机编队时间协同要求，考虑每架飞机的侦察效能，将侦察区域分割为两部分；具体步骤如下：
小型固定翼无人机双机编队包括长机M和僚机W，在空中飞行时，无人机操作员对一凸多边形形状的侦察区域P实施编队协同侦察；该凸多边形区域顶点有n个，其中n≥3，凸多边形区域经纬度坐标按逆时针排列分别为(λ1,φ1),(λ2,φ2),…,(λn,φn)，凸多边形区域的面积为AP，无人机操作员将侦察区域P数据传送到长机M，设长机M当前经度为λM，纬度为φM，高度为HM，速度为VM，可用最小转弯半径为RM；僚机W当前经度为λW，纬度为φW，高度为HW，速度为VW，可用最小转弯半径为RW；长机M的侦察效能，即单位时间内能够侦察的区域面积为AM，僚机W的侦察效能，即单位时间内能够侦察的区域面积为AW；根据GJB 6304-2008《2000中国大地测量系统》6.7.2中的高斯投影方法，将长机位置、僚机位置、凸多边形区域顶点位置转换到高斯投影平面直角坐标系中，长机位置、僚机位置、凸多边形区域顶点位置对应的坐标分别为(xM,yM)、(xW,yW)、(xi,yi)，其中1≤i≤n；
编队协同执行任务需要在时间上协调一致，因此双机编队执行协同区域侦察时要做到两架飞机花费时间相同，根据每架飞机的侦察效能，将侦察区域P分割为面积分别为A1、A2的两部分，且满足：
Figure FDA0003304663800000011
长机携带的侦察传感器沿侦察方向视场角为αM，垂直于侦察方向视场角为βM，则长机侦察效能表示为：
Figure FDA0003304663800000012
僚机携带的侦察传感器沿侦察方向视场角为αW，垂直于侦察方向视场角为βW，则僚机侦察效能表示为：
Figure FDA0003304663800000013
由公式(1)可得面积分割比例为：
Figure FDA0003304663800000021
在侦察区域所有顶点中选择与长机位置最近的顶点S(xvs,yvs)作为侦察区域分割起点，其中1≤vs≤n为侦察区域分割起点的序号；
从序号为j＝(vs+2)的任务区域顶点开始，其中若j大于n，则对n取余；小于1，则取n，若满足公式(5)：
Figure FDA0003304663800000022
其中Avs_j为由序号为vs、vs+1、…、j的侦察区域顶点围成的多边形的面积，Aj_vs为由序号为j、j+1、…、vs的侦察区域顶点围成的多边形的面积；按公式(5)继续按逆时针顺序检查下一个任务区域顶点，直到找到序号为k的侦察区域的一个顶点，使得：
Figure FDA0003304663800000023
其中Avs_k为由序号为vs、vs+1、…、k的侦察区域顶点围成的多边形的面积，Ak_vs为由序号为k、k+1、…、vs的侦察区域顶点围成的多边形的面积，Avs_k-1为由序号为vs、vs+1、…、k-1的侦察区域顶点围成的多边形的面积，Ak-1_vs为由序号为k-1、k、…、vs的侦察区域顶点围成的多边形的面积；
由公式(6)可知，在序号为k、k-1的两个任务区域顶点组成的边上，必然存在一点H，称之为分割点，Avs_H即是由序号为vs、vs+1、…、k-1的侦察区域顶点和点H围成的多边形pvs_H的面积，AH_vs是由点H和序号为k、k+1、…、vs的侦察区域顶点围成的多边形pH_vs的面积；采用二分搜索法寻找点H，得到点H的坐标；
步骤2：完成侦察区域分割后，由长机计算双机的侦察计划，具体步骤为：
长机待侦察区域为多边形pvs_H，僚机待侦察区域为多边形pH_vs，要求的侦察旁向重叠率为δ；
以长机侦察计划计算为例，以扫雪式航线实现对区域覆盖，扫雪式往返方向平行于直线l，l由顶点vs与点H连线确定；
扫雪式航段之间的距离为：
Δd1＝2HMtan(βM/2)(1-δ) (11)
设dvs_H为多边形pvs_H所有顶点中到直线l的最大距离，则扫雪式航段个数为：
Figure FDA0003304663800000031
根据平面几何，计算出每个扫雪式航段所在直线l1...lu与多边形pvs_H各条边分别有两个交点，设交点分别为
Figure FDA0003304663800000032
考虑到飞机转弯对侦察效果的影响，将交点向外延伸距离ρ作为侦察计划L1的航路点，ρ取Δd1到2Δd1之间，设延伸后的航路点为
Figure FDA0003304663800000033
Figure FDA0003304663800000034
将航路点
Figure FDA0003304663800000035
Figure FDA0003304663800000036
按飞行顺序排列，即形成侦察计划L1；
同理，计算僚机侦察计划L2；
侦察计划L1、L2计算完成后，根据GJB 6304-2008《2000中国大地测量系统》6.7.2中的高斯投影方法，将航路点转换为经纬度形式供飞行控制系统按照经纬度进行飞行；
步骤3：每架飞机自动执行各自的侦察计划，并实时计算侦察计划执行进度；按以下步骤计算：
长机将侦察计划L2通过无线数据链路发送给僚机，双机编队自动根据侦察计划执行区域侦察任务，在任务执行过程中，每架飞机实时计算计划执行进度，并反馈给操作员；
以长机为例，侦察计划L1的总长度为：
Figure FDA0003304663800000037
其中ωv,v+1为第v个航点和第v+1航点之间的距离；
Figure FDA0003304663800000041
在每个航电周期，按以下步骤计算计划执行进度：
a)从飞机的飞行控制系统获取到点T(xL1_t,yL1_t)，其中t为到点在侦察计划L1中的航点序号，计算当前飞机位置(xMc,yMc)与到点T的距离：
Figure FDA0003304663800000042
b)计算剩余侦察计划的长度：
Figure FDA0003304663800000043
c)计划执行进度按照下式计算
Figure FDA0003304663800000044
当η1≥100％时，侦察计划L1执行完成；
同理，计算僚机侦察计划L2的执行进度η2，当η2≥100％时，侦察计划L2执行完成；
侦察计划L1执行完成且侦察计划L2执行完成，此次双机协同区域侦察任务完成。
2.根据权利要求1所述的小型固定翼无人机双机协同区域侦察方法，其特征在于：
采用二分搜索法寻找点H的步骤为：
设序号为k的任务区域顶点坐标为(xk,yk)，序号为k-1的任务区域顶点坐标为(xk-1,yk-1)，点H(xH,yH)迭代初始值
Figure FDA0003304663800000045
坐标设置为：
Figure FDA0003304663800000046
设二分搜索区间迭代初始左端点C0坐标为
Figure FDA0003304663800000047
迭代初始右端点E0设置为
Figure FDA0003304663800000048
按下式设置：
Figure FDA0003304663800000051
设
Figure FDA0003304663800000052
为分割点第q次迭代中的值，
Figure FDA0003304663800000053
为二分搜索区间左端点第q次迭代的值，
Figure FDA0003304663800000054
为二分搜索区间右端点第q次迭代的值，
Figure FDA0003304663800000055
为分割点第q+1次迭代中的值，
Figure FDA0003304663800000056
为二分搜索区间左端点第q+1次迭代的值，
Figure FDA0003304663800000057
为二分搜索区间右端点第q+1次迭代的值；
Figure FDA0003304663800000058
即是由序号为vs、vs+1、…、vs-1的侦察区域顶点和点Hq围成的多边形的面积，
Figure FDA0003304663800000059
即是由点Hq和序号为k、k+1、…、vs的侦察区域顶点围成的多边形的面积；
迭代步骤如下：
a)当
Figure FDA00033046638000000510
时，迭代结束，分割点H即为Hq，否则进入步骤(b)继续向下迭代；
b)如果
Figure FDA00033046638000000511
令
Figure FDA00033046638000000512
如果
Figure FDA00033046638000000513
令
Figure FDA0003304663800000061
3.根据权利要求1所述的小型固定翼无人机双机协同区域侦察方法，其特征在于：
所述侦察旁向重叠率为δ取值范围为0≤δ＜1。
CN202111212666.XA 2021-10-14 2021-10-14 一种小型固定翼无人机双机协同区域侦察方法 Active CN114138003B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111212666.XA CN114138003B (zh) 2021-10-14 2021-10-14 一种小型固定翼无人机双机协同区域侦察方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111212666.XA CN114138003B (zh) 2021-10-14 2021-10-14 一种小型固定翼无人机双机协同区域侦察方法

Publications (2)

Publication Number Publication Date
CN114138003A true CN114138003A (zh) 2022-03-04
CN114138003B CN114138003B (zh) 2024-04-02

Family

ID=80394380

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111212666.XA Active CN114138003B (zh) 2021-10-14 2021-10-14 一种小型固定翼无人机双机协同区域侦察方法

Country Status (1)

Country Link
CN (1) CN114138003B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115639834A (zh) * 2022-09-05 2023-01-24 中国航空工业集团公司洛阳电光设备研究所 一种基于图像质量的无人机侦察规划设计方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102009042691B3 (de) * 2009-09-23 2011-06-16 Diehl Bgt Defence Gmbh & Co. Kg Verfahren und System zur Aufklärung eines Zielgebiets
KR20180085562A (ko) * 2017-01-19 2018-07-27 금오공과대학교 산학협력단 생체 모방 알고리즘을 이용한 다수 드론의 수색 및 정찰 방법
CN113093801A (zh) * 2021-04-02 2021-07-09 南京航空航天大学 一种多无人机协同编队的航路文件制作方法
CN113359833A (zh) * 2021-06-22 2021-09-07 西安爱生技术集团有限公司 一种无人机编队协同侦察的任务规划方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102009042691B3 (de) * 2009-09-23 2011-06-16 Diehl Bgt Defence Gmbh & Co. Kg Verfahren und System zur Aufklärung eines Zielgebiets
KR20180085562A (ko) * 2017-01-19 2018-07-27 금오공과대학교 산학협력단 생체 모방 알고리즘을 이용한 다수 드론의 수색 및 정찰 방법
CN113093801A (zh) * 2021-04-02 2021-07-09 南京航空航天大学 一种多无人机协同编队的航路文件制作方法
CN113359833A (zh) * 2021-06-22 2021-09-07 西安爱生技术集团有限公司 一种无人机编队协同侦察的任务规划方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
柳长安, 王和平, 李为吉: "基于遗传算法的无人机协同侦察航路规划", 飞机设计, no. 01, 30 March 2003 (2003-03-30), pages 47 - 52 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115639834A (zh) * 2022-09-05 2023-01-24 中国航空工业集团公司洛阳电光设备研究所 一种基于图像质量的无人机侦察规划设计方法
CN115639834B (zh) * 2022-09-05 2024-04-26 中国航空工业集团公司洛阳电光设备研究所 一种基于图像质量的无人机侦察规划设计方法

Also Published As

Publication number Publication date
CN114138003B (zh) 2024-04-02

Similar Documents

Publication Publication Date Title
Hao et al. Formation flight of fixed-wing UAV swarms: A group-based hierarchical approach
JP7190329B2 (ja) 航空機の飛行計画において微細風況を考慮するシステム
CN106842963B (zh) 多无人机探测任务分配与航迹规划联合优化方法及装置
US10017271B2 (en) Methods of three dimensional (3D) airflow sensing and analysis
Vasquez-Gomez et al. Coverage path planning for surveying disjoint areas
US20170269612A1 (en) Flight control methods for operating close formation flight
US20170293307A1 (en) Apparatus for close formation flight
CN108897338B (zh) 基于pio的圆轨道航天器编队重构型防碰撞路径规划方法
CN112731967A (zh) 一种基于聚类和遗传算法的多无人机协同任务规划方法
CN111221349B (zh) 多无人机目标定位的航路规划方法
US9864380B1 (en) Formation flight system extremum-seeking-control using blended performance parameters
CN113093801B (zh) 一种多无人机协同编队的航路文件制作方法
CN105953800A (zh) 一种无人飞行器航迹规划栅格空间划分方法
CN108845588A (zh) 一种基于非线性制导的四旋翼飞行器轨迹跟踪控制方法
Ali et al. Feature selection-based decision model for UAV path planning on rough terrains
CN114138003A (zh) 一种小型固定翼无人机双机协同区域侦察方法
Zhang et al. Research on obstacle avoidance algorithm of multi-UAV consistent formation based on improved dynamic window approach
Datsko et al. Energy-aware Multi-UAV Coverage Mission Planning with Optimal Speed of Flight
CN114186859A (zh) 复杂未知环境多机协同多目标任务分配方法
Berdonosov et al. Speed approach for UAV collision avoidance
CN117193377A (zh) 确保收敛的无人机飞行时间最优实时轨迹优化方法
Zardashti et al. Constrained optimal terrain following/threat avoidance trajectory planning using network flow
CN111538351B (zh) 最优航路点计算方法、系统及计算航路点能量值的模型
Karapetyan et al. Ag-cvg: Coverage planning with a mobile recharging ugv and an energy-constrained uav
CN114510082A (zh) 一种无人机间无通信支持的旋翼无人机编队折线航路规划算法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant