一种无人机导航定位相对位姿误差确定方法、电子设备及存储介质与流程

摘要: 本发明涉及无人机飞行轨迹判断,特别是涉及一种无人机导航定位相对位姿误差确定方法、电子设备及存储介质。背景技术:1、近年来,随着无人机行业高速发展,无人机在国民经...
一种无人机导航定位相对位姿误差确定方法、电子设备及存储介质与流程

本发明涉及无人机飞行轨迹判断,特别是涉及一种无人机导航定位相对位姿误差确定方法、电子设备及存储介质。

背景技术:

1、近年来,随着无人机行业高速发展,无人机在国民经济建设发展中的资源监察、灾害应对、安全应急、民生服务等多个领域发挥越来越大的作用;无人机实现飞行控制、避障、路径规划以及抓取等各种复杂任务的基础和前提是能够对无人机进行实时的检测和跟踪;现有技术中,通常是基于一种类型的检测信号对无人机进行跟踪,例如:基于无线电频谱信号对无人机进行飞行轨迹跟踪;但是,一种类型的信号有可能会受到环境因素或者其他因素的影响,导致轨迹跟踪不准确;因此,为了提高无人机轨迹跟踪的准确性,会将同一无人机对应的另一种雷达监测信号的飞行轨迹进行融合,实现无人机轨迹的跟踪;然而,如何判断无线电频谱信号的飞行轨迹和雷达信号的飞行轨迹是否对应于同一无人机,并在此基础上准确确定无人机的导航定位相对位姿误差,成为亟待解决的技术问题。

技术实现思路

1、针对上述技术问题,本发明采用的技术方案为:

2、根据本申请的第一方面,提供了一种无人机导航定位相对位姿误差确定方法,所述方法包括以下步骤:

3、e100,获取雷达信号飞行轨迹对应的每一雷达信号飞行轨迹点,以得到雷达信号飞行轨迹点列表a=(a1,a2,…,ai,…,an),i=1,2,…,n;其中,ai为雷达信号飞行轨迹对应的第i个雷达信号飞行轨迹点,n为雷达信号飞行轨迹对应的雷达信号飞行轨迹点的数量。

4、e200,获取无线电频谱信号飞行轨迹对应的每一无线电频谱信号飞行轨迹点,以得到无线电频谱信号飞行轨迹点列表b=(b1,b2,…,bi,…,bn);其中,bi为无线电频谱信号飞行轨迹对应的第i个无线电频谱信号飞行轨迹点;ai和bi在同一时间点生成。

5、e300,获取同一时间点的雷达信号飞行轨迹点和无线电频谱信号飞行轨迹点的距离,以得到距离列表δl=(δl1,δl2,…,δli,…,δln);其中,δli为ai和bi之间的距离。

6、e400,根据δl,判断a对应的雷达信号飞行轨迹和b对应的无线电频谱信号飞行轨迹是否对应于同一无人机。

7、根据本申请的另一方面,还提供了一种非瞬时性计算机可读存储介质,存储介质中存储有至少一条指令或至少一段程序,至少一条指令或至少一段程序由处理器加载并执行以实现上述无人机导航定位相对位姿误差确定方法。

8、根据本申请的另一方面,还提供了一种电子设备,包括处理器和上述非瞬时性计算机可读存储介质。

9、本发明至少具有以下有益效果:

10、本发明的无人机导航定位相对位姿误差确定方法,获取雷达信号飞行轨迹对应的每一雷达信号飞行轨迹点,以得到雷达信号飞行轨迹点列表a;获取无线电频谱信号飞行轨迹对应的每一无线电频谱信号飞行轨迹点,以得到无线电频谱信号飞行轨迹点列表b;获取同一时间点的雷达信号飞行轨迹点和无线电频谱信号飞行轨迹点的距离,以得到距离列表δl;根据δl,判断a对应的雷达信号飞行轨迹和b对应的无线电频谱信号飞行轨迹是否对应于同一无人机;若对应于同一无人机,则利用二者融合修正外部坐标,并结合无人机自身坐标,确定无人机的导航定位相对位姿误差。本发明既实现了对两条轨迹是否属于同一无人机的准确判断,又能够在此基础上精确计算出相对位姿误差,为无人机导航定位精度评估提供了可靠依据。

1.一种无人机导航定位相对位姿误差确定方法,其特征在于,所述方法包括以下步骤:

2.根据权利要求1所述的无人机导航定位相对位姿误差确定方法,其特征在于,步骤e400包括以下步骤:

3.根据权利要求2所述的无人机导航定位相对位姿误差确定方法,其特征在于,步骤e400还包括以下步骤:

4.根据权利要求1所述的无人机导航定位相对位姿误差确定方法,其特征在于,步骤e500包括以下步骤:

5.根据权利要求4所述的无人机导航定位相对位姿误差确定方法,其特征在于,步骤e600包括以下步骤:

6.根据权利要求2所述的无人机导航定位相对位姿误差确定方法,其特征在于,γ的取值范围为0.9-0.95。

7.根据权利要求1所述的无人机导航定位相对位姿误差确定方法,其特征在于,a和b通过预设的插值算法得到。

8.一种非瞬时性计算机可读存储介质,所述存储介质中存储有至少一条指令或至少一段程序,其特征在于,所述至少一条指令或所述至少一段程序由处理器加载并执行以实现如权利要求1-7中任意一项所述的无人机导航定位相对位姿误差确定方法。

9.一种电子设备,其特征在于,包括处理器和权利要求8所述的非瞬时性计算机可读存储介质。