四旋翼无人机目标自主跟踪方法、装置、设备及介质

摘要: 本申请涉及无人机飞行控制,尤其涉及四旋翼无人机目标自主跟踪方法、装置、设备及介质。背景技术:1、随着无人机在巡检、安防、应急搜寻和移动目标监测等场景中的应用增多...
四旋翼无人机目标自主跟踪方法、装置、设备及介质

本申请涉及无人机飞行控制,尤其涉及四旋翼无人机目标自主跟踪方法、装置、设备及介质。

背景技术:

1、随着无人机在巡检、安防、应急搜寻和移动目标监测等场景中的应用增多,四旋翼无人机需要在复杂环境中根据机载感知数据持续获取目标状态,并自主生成飞行控制指令,以维持对运动目标的跟踪。

2、现有四旋翼无人机目标跟踪方法通常采用感知、规划、控制串联架构,先通过机载相机、惯性测量单元等传感器获取目标和环境信息,再进行目标识别、轨迹规划和飞行控制。

3、然而,在目标突发机动、短时遮挡或观测中断时,串联架构容易出现处理滞后和状态衔接不足,目标丢失后多依赖无指向性搜索,难以根据目标运动历史和环境信息自主恢复跟踪。因此,在目标突发机动或短时观测丢失时,如何使四旋翼无人机基于机载感知数据自主完成目标跟踪控制与搜索恢复成为亟待解决的问题。

技术实现思路

1、本申请的目的在于提供一种四旋翼无人机目标自主跟踪方法、装置、设备及介质,旨在解决在目标突发机动或短时观测丢失时,如何使四旋翼无人机基于机载感知数据自主完成目标跟踪控制与搜索恢复的技术问题。

2、为实现上述目的,本申请提出一种四旋翼无人机目标自主跟踪方法,所述方法应用于四旋翼无人机的机载控制系统,所述方法包括:

3、获取当前控制周期的机载感知数据,所述机载感知数据包括无人机状态数据、第一目标观测数据和环境语义数据;

4、根据所述第一目标观测数据中的目标检测置信度和预设丢失判定条件,确定当前跟踪状态;

5、在所述当前跟踪状态为正常跟踪状态的情况下,根据所述机载感知数据和已存储的上一控制周期控制指令生成跟踪输入数据,并将所述跟踪输入数据输入至端到端跟踪网络,得到第一控制指令,所述第一控制指令包括总推力系数和三维角速度指令;

6、根据所述第一控制指令控制四旋翼无人机跟踪飞行,并记录目标运动历史数据;

7、在所述当前跟踪状态为目标丢失状态的情况下,根据所述目标运动历史数据生成目标运动预测数据,根据所述目标运动预测数据、所述环境语义数据、所述无人机状态数据和所述上一控制周期控制指令生成搜索输入数据,并将所述搜索输入数据输入至端到端重搜索网络,得到第二控制指令;

8、根据所述第二控制指令控制四旋翼无人机搜索飞行,并在搜索飞行过程中获取第二目标观测数据,在所述第二目标观测数据满足预设重获条件的情况下,将所述当前跟踪状态切换至正常跟踪状态。

9、此外,为实现上述目的,本申请还提出一种四旋翼无人机目标自主跟踪装置,所述装置包括:

10、数据获取模块,用于获取当前控制周期的机载感知数据,所述机载感知数据包括无人机状态数据、第一目标观测数据和环境语义数据;

11、状态确定模块,用于根据所述第一目标观测数据中的目标检测置信度和预设丢失判定条件,确定当前跟踪状态;

12、跟踪指令模块,用于在所述当前跟踪状态为正常跟踪状态的情况下,根据所述机载感知数据和已存储的上一控制周期控制指令生成跟踪输入数据,并将所述跟踪输入数据输入至端到端跟踪网络,得到第一控制指令,所述第一控制指令包括总推力系数和三维角速度指令;

13、跟踪执行模块,用于根据所述第一控制指令控制四旋翼无人机跟踪飞行,并记录目标运动历史数据;

14、搜索指令模块,用于在所述当前跟踪状态为目标丢失状态的情况下,根据所述目标运动历史数据生成目标运动预测数据,根据所述目标运动预测数据、所述环境语义数据、所述无人机状态数据和所述上一控制周期控制指令生成搜索输入数据,并将所述搜索输入数据输入至端到端重搜索网络,得到第二控制指令;

15、搜索执行模块,用于根据所述第二控制指令控制四旋翼无人机搜索飞行,并在搜索飞行过程中获取第二目标观测数据,在所述第二目标观测数据满足预设重获条件的情况下,将所述当前跟踪状态切换至正常跟踪状态。

16、此外,为实现上述目的,本申请还提出一种四旋翼无人机目标自主跟踪设备,所述设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序配置为实现如上文所述的四旋翼无人机目标自主跟踪方法的步骤。

17、此外,为实现上述目的,本申请还提出一种存储介质,所述存储介质为计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如上文所述的四旋翼无人机目标自主跟踪方法的步骤。

18、本申请提出的一个或多个技术方案,至少具有以下技术效果:

19、首先,获取当前控制周期的无人机状态数据、第一目标观测数据和环境语义数据,使后续处理能够结合无人机运动状态、目标观测情况和周围环境信息;然后,根据第一目标观测数据中的目标检测置信度和预设丢失判定条件确定当前跟踪状态,使控制方式与目标当前是否处于有效观测范围相对应;在正常跟踪状态下,将机载感知数据与上一控制周期控制指令组合为跟踪输入数据,经端到端跟踪网络生成包括总推力系数和三维角速度指令的第一控制指令,使当前控制能够参考已有控制状态,提高了相邻控制周期的控制连续性;根据第一控制指令控制四旋翼无人机跟踪飞行,并记录目标运动历史数据,为目标丢失后的运动预测保留了依据;在目标丢失状态下,根据目标运动历史数据生成目标运动预测数据,根据目标运动预测数据、环境语义数据、无人机状态数据和上一控制周期控制指令生成搜索输入数据,并通过端到端重搜索网络生成第二控制指令,使搜索飞行能够兼顾目标可能的运动方向、周围环境条件和四旋翼无人机当前运动状态;最后,根据第二控制指令控制四旋翼无人机搜索飞行,在搜索过程中获取第二目标观测数据,并在重新获得有效目标观测后切换至正常跟踪状态,由此形成了正常跟踪、目标丢失、搜索飞行和跟踪恢复相衔接的控制过程。本申请能够在目标突发机动或短时观测丢失时,使四旋翼无人机基于机载感知数据自主完成目标跟踪控制与搜索恢复。

1.一种四旋翼无人机目标自主跟踪方法,其特征在于,所述方法应用于四旋翼无人机的机载控制系统,所述方法包括:

2.如权利要求1所述的方法,其特征在于,所述在所述当前跟踪状态为正常跟踪状态的情况下,根据所述机载感知数据和已存储的上一控制周期控制指令生成跟踪输入数据,并将所述跟踪输入数据输入至端到端跟踪网络,得到第一控制指令的步骤包括:

3.如权利要求1所述的方法,其特征在于,所述根据所述第一目标观测数据中的目标检测置信度和预设丢失判定条件,确定当前跟踪状态的步骤包括:

4.如权利要求1所述的方法,其特征在于,所述根据所述第一控制指令控制四旋翼无人机跟踪飞行,并记录目标运动历史数据的步骤包括:

5.如权利要求1所述的方法,其特征在于,所述在所述当前跟踪状态为目标丢失状态的情况下,根据所述目标运动历史数据生成目标运动预测数据,根据所述目标运动预测数据、所述环境语义数据、所述无人机状态数据和所述上一控制周期控制指令生成搜索输入数据,并将所述搜索输入数据输入至端到端重搜索网络,得到第二控制指令的步骤包括:

6.如权利要求5所述的方法,其特征在于,所述根据所述未来目标位置序列、所述方向概率分布、所述候选搜索区域集合、所述区域置信度向量、所述无人机状态数据和所述上一控制周期控制指令生成搜索输入数据的步骤包括:

7.如权利要求1所述的方法,其特征在于,所述根据所述第二控制指令控制四旋翼无人机搜索飞行,并在搜索飞行过程中获取第二目标观测数据,在所述第二目标观测数据满足预设重获条件的情况下,将所述当前跟踪状态切换至正常跟踪状态的步骤包括:

8.一种四旋翼无人机目标自主跟踪装置,其特征在于,所述装置应用如权利要求1至7中任一项所述的四旋翼无人机目标自主跟踪方法,所述装置包括:

9.一种四旋翼无人机目标自主跟踪设备,其特征在于,所述设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序配置为实现如权利要求1至7中任一项所述的四旋翼无人机目标自主跟踪方法的步骤。

10.一种存储介质,其特征在于,所述存储介质为计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至7中任一项所述的四旋翼无人机目标自主跟踪方法的步骤。