一种大型无人机实时定位的误差补偿方法技术

本发明专利技术提供一种大型无人机实时定位的误差补偿方法，包括如下步骤：S1，获取无人机实时定位的误差数据集；S2，基于误差数据集构建误差模型；S3，应用所述误差模型；S4，更新所述误差模型。本发明专利技术充分考虑各个传感器的工作方式、工作状态和数据传输延时问题，对大型无人机实时定位的系统误差进行了准确的描述，通过机器学习的方式，结合具体无人机本身样本获取和训练，避免了传统通用模型和无人机系统匹配的误差问题，显著地提升了无人机的实时定位精度。度。度。

【技术实现步骤摘要】
一种大型无人机实时定位的误差补偿方法


[0001]本专利技术涉及无人机定位
，具体而言，涉及一种大型无人机实时定位的误差补偿方法。

技术介绍

[0002]无人机实时定位常采用机载pos系统直接传感器定向。一般情况下需要对机载GNSS的偏心分量、惯导与相机的偏心角、相机内方位元素作出校正改正。虽然上述改正能大幅度提高定位精度，但是惯导的量测误差、GNSS\IMU的工作状态以及定位误差仍然制约着直接传感器定向的精度。这些系统误差在无人机执行远视距、小俯仰角的定位任务时影响尤为巨大。

技术实现思路

[0003]本专利技术旨在提供一种大型无人机实时定位的误差补偿方法，以解决系统误差在无人机执行远视距、小俯仰角的定位任务时影响巨大的问题。
[0004]本专利技术提供的一种大型无人机实时定位的误差补偿方法，包括如下步骤：S1，获取无人机实时定位的误差数据集；S2，基于误差数据集构建误差模型；S3，应用所述误差模型；S4，更新所述误差模型。
[0005]进一步的，步骤S1包括如下子步骤：S11，设置检校场范围，获取检校场范围内基于卫星或无人机平台的高分辨率影像；S12，规划无人机飞行任务；S13，无人机飞行过程中使光电吊舱姿态周期性变化；S14，以固定间隔从光电吊舱相机拍摄的视频中取视频帧以及该视频帧时刻的遥测信息和该视频帧时刻前1s的遥测信息，取出视频帧集合I；S15，对于视频帧集合I中的每帧图像，根据POS数据解算图像中像元的地理位置并执行地理校正，获得新图像集合J；S16，使用高分辨率影像分别与新图像集合J中图像进行特征匹配并根据匹配结果给视频帧集合I中像元赋予精确的地理坐标，得到点集和点集；S17，对于视频帧集合I中第i幅图像，基于点集和点集提供的像元坐标和三维空间坐标，采用单像空间后方交会方法计算外方位元素，其线元素记为，其角元素转化为四元数后记为；重复上述过程，计算视频帧集合I中每幅图像的外方位元素；S18，建立位置误差数据集和姿态误差数据集：对于视频帧集合I中第i幅图像，根据其拍摄时刻和前1s时刻遥测信息计算经过偏心分量和偏心角修正的投影中心和四元数：
、、和；将、偏航角、GNSS工作状态和相对于视频帧前1s的遥测信息解算的、偏航角、GNSS工作状态作为自变量，作为因变量建立位置误差数据集；同理，将、各个姿态角、惯导工作状态和视频帧前1s的遥测信息解算的、各个姿态角、惯导工作状态作为自变量，作为因变量建立姿态误差数据集；重复上述过程，直到完成视频帧集合I中所有图像的计算，得到误差数据集。
[0006]进一步的，步骤S12中，无人机在检校场内围绕检校场中心O采用花瓣状飞行路线飞行。
[0007]进一步的，步骤S13中，无人机飞行过程中使光电吊舱姿态周期性变化是指光电吊舱方位角和俯仰角随时间t变化，表示为：
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)式中，T为光电吊舱姿态变化的周期；T的取值不大于规划航线的预估飞行时间的；表示t除以T的余数；和分别表示光电吊舱的俯仰角的最小值和最大值；s为正整数，表示在T周期内，俯仰角以的周期变化。
[0008]进一步的，步骤S15包括：对于视频帧集合I中第i幅图像，根据POS数据采用直接传感器定向计算像点点集的地理坐标，得到点集；其中，像点点集，w为图像的宽度，h为图像的高度；由点集和点集建立二次多项式模型表示为：
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(2)式中，x、y为点集的坐标；X、Y为的坐标；a0、a1、a2、a3、a4、a5、b0、b1、b2、b3、b4、b5为待定系数，由最小二乘法求得；并利用二次多项式模型计算视频帧集合I中第i幅图像每一个像元的地理坐标，再进行灰度重采样得到新图像；重复上述步骤，将视频帧集合I中所有图像处理完，得到新图像集合J。
[0009]进一步的，步骤S16包括：对于新图像集合J中第i幅图像，根据其地理位置匹配到高分辨率影像的局部区域；以局部高分辨率影像和新图像集合J中第i幅图像为数据源执行特征匹配并使用RANSAC算法筛选出正确的匹配关系，将高分辨率影像和新图像集合J中的影像特征点点集分别记为、；
通过式(3)将点集、中点的像元坐标转换为地理坐标，记为点集和点集：
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(3)式中，A为高分辨率影像或新图像集合J中第i幅影像的仿射变换矩阵的齐次形式，x、y表示或的像元坐标，X、Y表示地理坐标；将点集中每个点代入到二次多项式模型中计算每个点在视频帧集合I中第i幅图像的像元坐标，结果记为点集；对于点集中每一个点，将其地理坐标代入到高精度的DEM中求取高程；将点集中每一个点的地理坐标和求取的高程组合形成三维空间坐标，结果记为点集；重复上述步骤，直到新图像集合J中所有图像处理完毕。
[0010]进一步的，步骤S2包括如下子步骤：S21，以基于遗传算法优化初始权重和阈值的BP神经网络作为误差模型；S22，将误差数据集标准化并打乱顺序按一定比例分为训练集和测试集；S23，利用遗传算法查找BP神经网络的初始权重和阈值；S24，根据步骤S23的初始权重和阈值初始化BP神经网络，将BP神经网络输出和因变量的平方和作为损失函数，通过输入训练集不断更新BP神经网络的权重值和阈值，得到误差模型；S25，根据误差模型在训练集和测试集上的表现，确定误差模型的预测精度、鲁棒性和收敛性；若误差模型表现欠佳，回到步骤S21调整BP神经网络的超参数。
[0011]进一步的，步骤S3包括如下子步骤：S31，计算当前时刻和前1s时刻遥测信息经过偏心分量和偏心角修正的投影中心、四元数：、、和；S32，将、偏航角、GNSS工作状态和相对于视频帧前1s的遥测信息解算的、偏航角、GNSS工作状态输入到位置误差模型中得到投影中心补偿值；同理，将、各个姿态角、惯导工作状态和视频帧前1s的遥测信息解算的、各个姿态角、惯导工作状态输入到姿态误差模型中得到四元数补偿值；S33，计算补偿后的投影中心S和四元数q：
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(4)式中，为补偿前的投影中心，为补偿前的四元数，为四元数加法；S34，根据投影中心S和四元数q确定任意像点的摄影光线方程，该摄影光线方程与地表的交点即为像点的地理坐标。
[0012]进一步的，步骤S4包括如下子步骤：S41，检校任务按照步骤S1获取误差数据集；日常飞行中按一定频率判断像主点坐
标是否落在高分辨率影像覆盖区域内，若是，通过执行步骤S14~S18获取误差数据集；S42，新的误差数据集数量累计达到预设数据量后，从原误差数据集中随机抽取与新的误差数据集相同数据量的数据，然后将抽取的数据与新的误差数据集共同组成新的训练集，通过将新的训练集输入原有误差模型进行训练的方式对原有误差模型进行更新。
[0013]综上所述，由于采用了上述技术方案，本专利技术的有益效果是：1. 本专利技术利用高分辨率影像解决了控制点问题，使得前期只需布设少量控制点，节省了工作量。由于后方交会时的像点的位置由特征本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种大型无人机实时定位的误差补偿方法，其特征在于，包括如下步骤：S1，获取无人机实时定位的误差数据集；S2，基于误差数据集构建误差模型；S3，应用所述误差模型；S4，更新所述误差模型。2.根据权利要求1所述的大型无人机实时定位的误差补偿方法，其特征在于，步骤S1包括如下子步骤：S11，设置检校场范围，获取检校场范围内基于卫星或无人机平台的高分辨率影像；S12，规划无人机飞行任务；S13，无人机飞行过程中使光电吊舱姿态周期性变化；S14，以固定间隔从光电吊舱相机拍摄的视频中取视频帧以及该视频帧时刻的遥测信息和该视频帧时刻前1s的遥测信息，取出视频帧集合I；S15，对于视频帧集合I中的每帧图像，根据POS数据解算图像中像元的地理位置并执行地理校正，获得新图像集合J；S16，使用高分辨率影像分别与新图像集合J中图像进行特征匹配并根据匹配结果给视频帧集合I中像元赋予精确的地理坐标，得到点集和点集；S17，对于视频帧集合I中第i幅图像，基于点集和点集提供的像元坐标和三维空间坐标，采用单像空间后方交会方法计算外方位元素，其线元素记为，其角元素转化为四元数后记为；重复上述过程，计算视频帧集合I中每幅图像的外方位元素；S18，建立位置误差数据集和姿态误差数据集：对于视频帧集合I中第i幅图像，根据其拍摄时刻和前1s时刻遥测信息计算经过偏心分量和偏心角修正的投影中心和四元数：、、和；将、偏航角、GNSS工作状态和相对于视频帧前1s的遥测信息解算的、偏航角、GNSS工作状态作为自变量，作为因变量建立位置误差数据集；同理，将、各个姿态角、惯导工作状态和视频帧前1s的遥测信息解算的、各个姿态角、惯导工作状态作为自变量，作为因变量建立姿态误差数据集；重复上述过程，直到完成视频帧集合I中所有图像的计算，得到误差数据集。3.根据权利要求2所述的大型无人机实时定位的误差补偿方法，其特征在于，步骤S12中，无人机在检校场内围绕检校场中心O采用花瓣状飞行路线飞行。4.根据权利要求3所述的大型无人机实时定位的误差补偿方法，其特征在于，步骤S13中，无人机飞行过程中使光电吊舱姿态周期性变化是指光电吊舱方位角和俯仰角随时间t变化，表示为：
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)
式中，T为光电吊舱姿态变化的周期；T的取值不大于规划航线的预估飞行时间的；表示t除以T的余数；和分别表示光电吊舱的俯仰角的最小值和最大值；s为正整数，表示在T周期内，俯仰角以的周期变化。5.根据权利要求4所述的大型无人机实时定位的误差补偿方法，其特征在于，步骤S15包括：对于视频帧集合I中第i幅图像，根据POS数据采用直接传感器定向计算像点点集的地理坐标，得到点集；其中，像点点集，w为图像的宽度，h为图像的高度；由点集和点集建立二次多项式模型，表示为：
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(2)式中，x、y...

【专利技术属性】
技术研发人员：罗登，陈翔，杨磊，潘星，
申请(专利权)人：四川腾盾科技有限公司，
类型：发明
国别省市：