一种侦检无人机飞行控制方法及系统与流程

摘要: 本发明属于无人机飞控,具体涉及一种侦检无人机飞行控制方法及系统。背景技术:1、随着无人机技术的快速发展,侦检无人机在环境监测、灾情探测、电力巡检、农业侦查等领域...
一种侦检无人机飞行控制方法及系统与流程

本发明属于无人机飞控,具体涉及一种侦检无人机飞行控制方法及系统。

背景技术:

1、随着无人机技术的快速发展,侦检无人机在环境监测、灾情探测、电力巡检、农业侦查等领域得到了广泛应用。侦检无人机通常搭载多种传感器(如视觉相机、激光雷达、定位模块等),需要在复杂多变的环境中对目标任务场景进行数据采集与侦测分析,精准、可靠的飞行高度控制有利于提高侦检无人机的任务执行效率和侦检质量。

2、然而,现有的侦检无人机飞行高度控制方法还存在以下不足:1.多依赖单一高度数据源,在复杂环境下易受环境因素干扰(如气压变化、地形起伏、信号遮挡等),导致高度测量精度不足,影响侦测数据的准确性和飞行安全性。2.缺乏对侦测数据质量的实时评估与反馈机制,无法根据实际侦测效果动态调整飞行高度,例如,当无人机飞行高度过高时,视觉侦测分辨率不足,难以识别细小目标;当飞行高度过低时,视野范围受限,侦测效率下降。3.缺少基于多源数据融合的闭环自适应调节机制,难以在动态变化的环境中实现侦测效果最优的飞行高度自主调节。

技术实现思路

1、本发明的目的是提供一种侦检无人机飞行控制方法及系统,用以解决现有技术中存在的上述问题。

2、为了实现上述目的,本发明采用以下技术方案:

3、第一方面,提供一种侦检无人机飞行控制方法,包括:

4、采集侦检无人机在当前时刻的飞行高度数据和图像侦测数据,所述飞行高度数据包括气压高度数据、卫星定位高度数据和对地测距高度数据,所述图像侦测数据包括可见光图像数据和相机镜头参数;

5、利用气压高度数据、卫星定位高度数据和对地测距高度数据进行多源高度数据融合计算,得到侦检无人机在当前时刻的融合高度测量值;

6、基于当前时刻的可见光图像数据确定当前时刻的图像侦测清晰度,并调取侦检无人机在上一时刻的融合高度测量值和图像侦测清晰度,利用当前时刻的融合高度测量值和图像侦测清晰度以及上一时刻的融合高度测量值和图像侦测清晰度计算当前时刻的图像清晰度衰减率;

7、基于当前时刻的融合高度测量值和相机镜头参数确定侦检无人机在当前时刻的图像侦测覆盖面积;

8、利用当前时刻的融合高度测量值、图像侦测清晰度和图像清晰度衰减率构建关于高度变量的相对图像清晰度指标,利用当前时刻的图像侦测覆盖面积、融合高度测量值以及相机镜头参数构建关于高度变量的相对覆盖率指标,并利用相对图像清晰度指标和相对覆盖率指标构建关于高度变量的高度寻优函数;

9、对高度寻优函数进行高度变量求解,得到当前时刻的目标优化高度,并根据当前时刻的目标优化高度和融合高度测量值确定当前时刻的高度偏差;

10、根据当前时刻的高度偏差生成高度控制指令,并输出高度控制指令至侦检无人机的电子调速器。

11、在一个可能的设计中,所述利用气压高度数据、卫星定位高度数据和对地测距高度数据进行多源高度数据融合计算,得到侦检无人机在当前时刻的融合高度测量值,包括:

12、将气压高度数据、卫星定位高度数据和对地测距高度数据代入多源高度数据融合计算式中进行计算,得到侦检无人机在当前时刻的融合高度测量值,所述多源高度数据融合计算式为:

13、

14、其中,hc表示融合高度测量值,hb表示气压高度数据,hg表示卫星定位高度数据,hr表示对地测距高度数据,ωb、ωg和ωr分别为设定的气压高度数据项权重系数、卫星定位高度数据项系数和对地测距高度数据项系数。

15、在一个可能的设计中,所述基于当前时刻的可见光图像数据确定当前时刻的图像侦测清晰度,包括:

16、确定当前时刻的可见光图像数据中各像素点的灰度值,并基于各像素点的灰度值利用sobel算子计算各像素点的梯度幅值;

17、利用各像素点的梯度幅值计算当前时刻的图像侦测清晰度:

18、

19、其中,qimg(k)表征当前时刻k的图像侦测清晰度,i和j分别表征可见光图像数据中像素点的行值和列值,m和n分别表征可见光图像数据中的像素行数和像素列数,ik(i,j)表征当前时刻k的可见光图像数据中像素点(i,j)的灰度值,▽ik(i,j)表征当前时刻k的可见光图像数据中像素点(i,j)的梯度幅值。

20、在一个可能的设计中,所述利用当前时刻的融合高度测量值和图像侦测清晰度以及上一时刻的融合高度测量值和图像侦测清晰度计算当前时刻的图像清晰度衰减率,包括:

21、将当前时刻的融合高度测量值和图像侦测清晰度以及上一时刻的融合高度测量值和图像侦测清晰度代入图像清晰度衰减率算式中进行计算,得到当前时刻的图像清晰度衰减率,所述图像清晰度衰减率算式为:

22、

23、其中,βimg(k)表征当前时刻k的图像清晰度衰减率,hc(k)表征当前时刻k的融合高度测量值,hc(k-1)表征上一时刻k-1的融合高度测量值,qimg(k)表征当前时刻k的图像侦测清晰度,qimg(k-1)表征上一时刻k-1的图像侦测清晰度。

24、在一个可能的设计中,所述基于当前时刻的融合高度测量值和相机镜头参数确定侦检无人机在当前时刻的图像侦测覆盖面积,包括:

25、将当前时刻的融合高度测量值和相机镜头参数代入图像侦测覆盖面积算式中进行计算,得到侦检无人机在当前时刻的图像侦测覆盖面积,所述图像侦测覆盖面积算式为:

26、

27、其中,a(k)表征侦检无人机在当前时刻k的图像侦测覆盖面积,αk和βk分别为当前时刻k的相机镜头参数中的水平视场角和垂直视场角。

28、在一个可能的设计中,所述相对图像清晰度指标为:

29、

30、其中,hx表征高度变量,q(hx)表征关于高度变量hx的相对图像清晰度指标,ε为设定的防除零常数;

31、所述相对覆盖率指标为:

32、

33、其中,f(hx)表征关于高度变量hx的相对覆盖率指标;

34、所述高度寻优函数为:

35、

36、其中,h’表征目标优化高度,argmax表征argmax函数,(.)表征取使argmax函数计算结果最大的高度变量hx,hmin和hmax分别为设定的侦检无人机的最低安全高度和最高限制高度,w1和w2分别为设定的清晰度权重系数和覆盖率权重系数。

37、在一个可能的设计中,所述根据当前时刻的目标优化高度和融合高度测量值确定当前时刻的高度偏差,包括:

38、用当前时刻的目标优化高度减去当前时刻的融合高度测量值,得到当前时刻的高度偏差。

39、在一个可能的设计中,所述根据当前时刻的高度偏差生成高度控制指令,包括:

40、基于当前时刻的高度偏差,采用带死区控制的pid算法计算高度控制量,并根据高度控制量生成高度控制指令。

41、第二方面,提供一种侦检无人机飞行控制系统,包括数据采集单元、融合测量单元、衰减计算单元、面积计算单元、函数构建单元、偏差解算单元和控制输出单元,其中:

42、数据采集单元,用于采集侦检无人机在当前时刻的飞行高度数据和图像侦测数据,所述飞行高度数据包括气压高度数据、卫星定位高度数据和对地测距高度数据,所述图像侦测数据包括可见光图像数据和相机镜头参数;

43、融合测量单元,用于利用气压高度数据、卫星定位高度数据和对地测距高度数据进行多源高度数据融合计算,得到侦检无人机在当前时刻的融合高度测量值;

44、衰减计算单元,用于基于当前时刻的可见光图像数据确定当前时刻的图像侦测清晰度,并调取侦检无人机在上一时刻的融合高度测量值和图像侦测清晰度,利用当前时刻的融合高度测量值和图像侦测清晰度以及上一时刻的融合高度测量值和图像侦测清晰度计算当前时刻的图像清晰度衰减率;

45、面积计算单元,用于基于当前时刻的融合高度测量值和相机镜头参数确定侦检无人机在当前时刻的图像侦测覆盖面积;

46、函数构建单元,用于利用当前时刻的融合高度测量值、图像侦测清晰度和图像清晰度衰减率构建关于高度变量的相对图像清晰度指标,利用当前时刻的图像侦测覆盖面积、融合高度测量值以及相机镜头参数构建关于高度变量的相对覆盖率指标,并利用相对图像清晰度指标和相对覆盖率指标构建关于高度变量的高度寻优函数;

47、偏差解算单元,用于对高度寻优函数进行高度变量求解,得到当前时刻的目标优化高度,并根据当前时刻的目标优化高度和融合高度测量值确定当前时刻的高度偏差;

48、控制输出单元,用于根据当前时刻的高度偏差生成高度控制指令,并输出高度控制指令至侦检无人机的电子调速器。

49、第三方面,提供一种侦检无人机飞行控制系统,包括:

50、存储器,用于存储指令;

51、处理器,用于读取所述存储器中存储的指令,并根据指令执行权利要求上述第一方面中所述的侦检无人机飞行控制方法。

52、有益效果:本发明通过多源高度数据融合,克服了单一数据源在复杂环境下易受干扰的缺陷,提高了高度测量的准确性和可靠性,为精确的高度控制提供了数据基础;通过构建综合清晰度指标和覆盖率指标的侦测质量评估机制进行高度寻优解算,以确定优化高度进行自适应高度调节,实现了从“被动定高飞行”到“主动寻优调节”的跨越,显著提升了图像侦测数据的有效性和任务执行效率;可实现侦检无人机飞行高度的自主优化控制,提高侦测数据的有效性和飞行控制的智能化水平,适用于各种复杂的无人机侦检场景。