基于任务规划的无人机自主巡检飞行控制方法及系统与流程

摘要: 本发明涉及无人机自主巡检飞行控制,尤其涉及一种基于任务规划的无人机自主巡检飞行控制方法及系统。背景技术:1、目前,无人机已广泛应用于线路、管道、建筑设施以及大范...
基于任务规划的无人机自主巡检飞行控制方法及系统与流程

本发明涉及无人机自主巡检飞行控制,尤其涉及一种基于任务规划的无人机自主巡检飞行控制方法及系统。

背景技术:

1、目前,无人机已广泛应用于线路、管道、建筑设施以及大范围区域的巡检作业。随着巡检范围扩大以及作业任务复杂程度提高,多架无人机协同执行巡检任务逐渐成为常见的作业方式。通过任务规划可以预先确定不同无人机的巡检航线、飞行时序以及相互之间的作业关系,同时随着视觉智能等感知技术的发展,无人机在巡检过程中能够持续获得自身飞行状态和周围环境信息,为自主飞行控制提供数据基础。

2、在一种现有技术中,通常先根据巡检任务分别规划各无人机的飞行航线和对应飞行时序,再由各无人机根据对应的规划航线进行轨迹跟踪,并根据无人机之间的相对位置进行编队调整。采用上述方式时,轨迹跟踪主要根据各无人机相对于规划航线的位置偏差进行修正,编队调整则主要根据无人机之间的相对位置偏差进行修正。当部分无人机在巡检飞行过程中产生位置偏离时,对规划航线进行轨迹修正会同步改变无人机之间的相对位置,而对编队位置进行调整又会改变对应无人机相对于规划航线的飞行状态,使轨迹修正与编队调整产生相互影响,随着飞行控制持续进行,容易造成各无人机的轨迹跟踪状态与编队构型状态不一致。

3、现有技术中存在多架无人机巡检过程中任务轨迹跟踪与编队构型保持协同不足的问题。

技术实现思路

1、本发明提供了一种基于任务规划的无人机自主巡检飞行控制方法及系统,以解决现有技术中存在的多架无人机巡检过程中任务轨迹跟踪与编队构型保持协同不足的问题。

2、第一方面,为了解决上述技术问题,本发明提供了一种基于任务规划的无人机自主巡检飞行控制方法,包括:

3、获取巡检任务对应的多架无人机航线数据和编队关系,根据所述航线数据确定各无人机的时序飞行位置,得到参考轨迹,根据所述编队关系确定各无人机之间的目标相对位置;

4、获取巡检飞行过程中各无人机的飞行状态,根据所述飞行状态确定预测初始状态,将预测时域内各预测周期的控制参数确定为待求控制量,根据所述预测初始状态和所述待求控制量推演后续飞行状态,并按照预设的飞行约束限定状态范围和控制范围,得到预测状态;

5、根据所述预测状态与所述参考轨迹之间的位置关系得到预测轨迹偏差,根据各无人机的所述预测状态计算预测相对位置,根据所述预测相对位置与所述目标相对位置之间的位置关系得到预测构型偏差;

6、根据所述预测轨迹偏差和所述预测构型偏差构建代价函数,在所述飞行约束下对所述代价函数进行滚动优化求解,得到目标控制序列,提取所述目标控制序列中首个预测周期对应的控制参数,得到对应轨迹恢复和编队保持的控制量;

7、将所述控制量发送至对应无人机执行,获取执行后的飞行状态,根据所述飞行状态重新确定预测初始状态并更新所述控制量,重复飞行控制直至巡检任务完成。

8、第二方面,本发明提供了一种基于任务规划的无人机自主巡检飞行控制系统,包括:存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如上述所述的方法。

9、相比于现有技术,本发明具有如下有益效果:

10、(1)本发明通过获取巡检任务对应的多架无人机航线数据和编队关系,根据航线数据确定各无人机的时序飞行位置并形成参考轨迹,同时根据编队关系确定各无人机之间的目标相对位置,使各无人机的航线位置、飞行时序以及编队位置关系建立在统一的任务规划基础上,为后续飞行状态预测和控制量确定提供一致的参考基准,减少分别进行轨迹控制和编队控制时产生的基准不一致。

11、(2)本发明通过根据各无人机的预测状态与参考轨迹之间的位置关系确定预测轨迹偏差,并根据各无人机预测位置之间的相对关系确定预测构型偏差,将预测轨迹偏差和预测构型偏差共同纳入控制量求解过程,在飞行约束下对控制目标进行滚动优化,得到对应轨迹恢复和编队保持的控制量,使无人机在修正自身巡检轨迹的同时兼顾与其他无人机之间的目标相对位置,降低轨迹调整与编队调整之间相互影响造成的协同偏差。

12、(3)本发明通过将求得的控制量发送至对应无人机执行,并根据执行后的飞行状态重新确定预测初始状态,对后续飞行状态和控制量进行连续更新,使每次控制均以无人机当前实际飞行状态作为下一次预测的起始条件,形成任务规划、状态预测、控制执行和状态反馈之间的闭环飞行控制过程,从而提高多架无人机巡检过程中轨迹跟踪与编队构型保持的协调性和飞行控制的连续性。

1.一种基于任务规划的无人机自主巡检飞行控制方法,其特征在于,包括:

2.根据权利要求1所述的基于任务规划的无人机自主巡检飞行控制方法,其特征在于,所述根据所述航线数据确定各无人机的时序飞行位置,得到参考轨迹,包括:

3.根据权利要求1所述的基于任务规划的无人机自主巡检飞行控制方法,其特征在于,所述根据所述编队关系确定各无人机之间的目标相对位置,包括:

4.根据权利要求1所述的基于任务规划的无人机自主巡检飞行控制方法,其特征在于,所述根据所述飞行状态确定预测初始状态,包括:

5.根据权利要求1所述的基于任务规划的无人机自主巡检飞行控制方法,其特征在于,所述将预测时域内各预测周期的控制参数确定为待求控制量,根据所述预测初始状态和所述待求控制量推演后续飞行状态,并按照预设的飞行约束限定状态范围和控制范围,得到预测状态,包括:

6.根据权利要求5所述的基于任务规划的无人机自主巡检飞行控制方法,其特征在于,所述根据所述预测状态与所述参考轨迹之间的位置关系得到预测轨迹偏差,包括:

7.根据权利要求6所述的基于任务规划的无人机自主巡检飞行控制方法,其特征在于,所述根据各无人机的所述预测状态计算预测相对位置,根据所述预测相对位置与所述目标相对位置之间的位置关系得到预测构型偏差,包括:

8.根据权利要求1所述的基于任务规划的无人机自主巡检飞行控制方法,其特征在于,所述根据所述预测轨迹偏差和所述预测构型偏差构建代价函数,包括:

9.根据权利要求1所述的基于任务规划的无人机自主巡检飞行控制方法,其特征在于,所述根据所述飞行状态重新确定预测初始状态并更新所述控制量,包括:

10.一种基于任务规划的无人机自主巡检飞行控制系统,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现权利要求1至9任一项所述的方法。