一种基于先验视觉标签的无人机定位方法技术

本发明专利技术涉及无人机定位技术领域，具体公开了一种基于先验视觉标签的无人机定位方法，包括如下步骤：步骤1、获得先验视觉标签地图；步骤2、对SLAM系统进行初始化；步骤3、求解相机位姿并同时更新地图，然后去除地图中的冗余关键帧和冗余地图点；步骤4、对步骤3求解的相机位姿进行优化，获得最终的相机姿态系统；本发明专利技术所提供的定位方法，最终能够获得经过优化后的相机姿态系统，即相机位姿、视觉标签位姿及地图点空间位置，从而完成煤棚内无人机的精确定位；能够适应无人机在没有GPS信号的环境中使用，能够提供稳定、安全的导航信息，保障无人机的正常运转。的正常运转。的正常运转。

【技术实现步骤摘要】
一种基于先验视觉标签的无人机定位方法


[0001]本专利技术涉及无人机定位
，具体为一种基于先验视觉标签的无人机定位方法。

技术介绍

[0002]随着无人机技术的不断发展，无人机的应用范围越来越广，比如应用在军事行动、地质勘测、物流运输、农业应用、影视拍摄、消防抗灾以及救援巡查等诸多领域。
[0003]现有无人机的定位多基于GPS定位技术实现，对无人机的应用环境有要求，在煤矿等GPS信号微弱或不存在的情况下，无人机无法正常工作，给使用带来不便。

技术实现思路

[0004]本专利技术的目的在于提供一种基于先验视觉标签的无人机定位方法，以解决上述
技术介绍
中提出的问题。
[0005]为实现上述目的，本专利技术提供如下技术方案：一种基于先验视觉标签的无人机定位方法，包括如下步骤：
[0006]步骤1、获得先验视觉标签地图；
[0007]步骤2、对SLAM系统进行初始化；
[0008]步骤3、求解相机位姿并同时更新地图，然后去除地图中的冗余关键帧和冗余地图点；
[0009]步骤4、对步骤3求解的相机位姿进行优化，获得最终的相机姿态系统。
[0010]优选的，所述步骤1中，在使用环境中布置一个包括多个二维码的地图，每个二维码具有自己独立的ID和位姿信息，获得的视觉标签地图作为无人机导航的先验知识。
[0011]优选的，所述步骤2中，使用基于先验视觉标签的相对位姿求解子方法求解图像第一帧与第二帧之间的相对位姿，并判断SLAM系统是否成功求得相对位姿，若成功初始化，则进入特征点三角化环节，若失败，则使用基于特征点的相对位姿求解子方法求解图像第一帧与第二帧之间的相对位姿后再进行三角化；此后将三角化得到的特征点构造为地图点，同时添加关键帧与点以及点与关键帧之间的观测属性，并计算最佳描述子，更新观测方向和距离范围，将新的地图点插入地图，完成初始地图的更新。
[0012]优选的，所述基于先验视觉标签的相对位姿求解子方法的过程为：计算第一帧f0中视觉标签与第一帧f0的相对位姿γ0，第二帧f1中视觉标签与第二帧f1的相对位姿γ1，两帧之间的相对位姿T具体为：
[0013]优选的，所述基于特征点的相对位姿求解子方法的过程为：先计算本质矩阵模型和单应矩阵模型，本质矩阵模型计算方法为：图像的第一帧f0和第二帧f1中的一对特征点p1和p2是空间中一点P在图片中的投影，一对特征点p1和p2可以确定空间中的一点P，在第一帧f0所设坐标系下点P的空间位置为：
[0014]P＝[X,Y,Z]T
；
[0015]影模型中，点p1和p2的像素坐标分别为：
[0016]x0＝KP
[0017]x1＝K(RP+t)；
[0018]其中，K为相机的内参矩阵，根据对极约束可得：
[0019][0020]令本质矩阵E＝t^R，然后根据点p1和p2的像素位置求解本质矩阵E；
[0021]单应矩阵模型的计算方法为：使用DLT算法求解单应矩阵H；然后通过计算上述本质矩阵模型和单应矩阵模型各自的得分，分值计算方法为：
[0022][0023][0024]其中，为匹配点对经过本质矩阵模型或单应矩阵模型在当前帧的重投影误差；为匹配点对在经过本质矩阵模型或单应矩阵模型在参考帧的重投影误差；计算判断指标R
H
，计算方法为：
[0025]若R
H
＞0.45，则选择单应矩阵H恢复位姿(R,t)，否则选择本质矩阵H恢复(R,t)。
[0026]优选的，所述特征点三角化环节的具体过程为：空间点P在初始帧第一帧f0的归一化平面里的位置为：
[0027][0028]空间点P在初始帧第二帧f1的归一化平面里的位置为：
[0029][0030]根据位置变化关系有：
[0031]z
r
p
r
＝T
rw
P
w
[0032]z
c
p
c
＝T
cw
P
w
；其中，T
rw
为初始帧的单位矩阵，T
cw
为第二帧f1和第一帧f0的相对位姿变化；由三维向量叉乘自己为零，得到：
[0033]p
r
×
z
r
p
r
＝p
r
×
T
rw
P
w
＝0
[0034]p
c
×
z
c
p
c
＝p
c
×
T
cw
P
w
＝0；
[0035]整理后得到：
[0036]最终，求解得到特征点的空间坐标P
w
。
[0037]优选的，所述步骤3中，相机位姿求解方法为第一位姿求解子方法或第二位姿求解子方法；
[0038]其中第一位姿求解子方法具体为：采用恒速模型，根据上一帧图像的位姿和速度得到当前帧中相机的初始位姿，相机从时刻k到时刻k
‑
1的位姿变化与相机从时刻k
‑
1到时刻k
‑
2的位姿变化相同，即：
[0039]因此，得到：
[0040]对上式进行递推以及取逆变换，具体为：
[0041][0042][0043][0044]相机的运动速度即为：计算当前帧到上一帧的平移向量t，将最后一帧特征点对应的三维点重新投影到当前帧，在重新投影位置寻找特征点，按照最小化重投影误差的方法对当前帧的位姿进行优化；
[0045]第二位姿求解子方法具体为：获得参考关键帧与当前帧匹配得到的匹配地图点和视觉标签，若匹配到的视觉标签个数大于两个，则根据视觉标签的世界位姿和视觉标签的局部坐标系与当前帧坐标系的相对位姿关系得到当前帧的初始位姿：
[0046]然后根据最小化重投影误差的方法对当前帧的位姿进行优化，重投影误差的计算方法为：
[0047][0048]其中，(R,t)为视觉标签角点从视觉标签局部坐标系转换到相机坐标系的变换关系，x
i
为视觉标签的角点在图像中的像素坐标，p
i
为视觉标签的角点在视觉标签局部坐标系中的坐标，π
m
为相机投影模型。
[0049]优选的，所述步骤3中，更新地图的具体过程为：对于当前帧，若满足：至少含有一个原地图中，不存在的新的视觉标签或在当前帧中跟踪到的特征点数大于50或当前帧跟踪到的特征点与参考关键帧的重复率小于90％，则将当前帧作为关键帧添加到地图中，同时将当前帧三角化得到的地图点也添加到地图中；去除地图中的冗余关键帧的具体过程为：若地图中存在三个关键帧能够观测到本关键帧中大于90％的地图点和所有的视觉标签，则将此关键帧判断为冗余关键帧，同时从地图中去除；去除冗余地图点的具体过程为：将地图点投影至共本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于先验视觉标签的无人机定位方法，其特征在于：包括如下步骤：步骤1、获得先验视觉标签地图；步骤2、对SLAM系统进行初始化；步骤3、求解相机位姿并同时更新地图，然后去除地图中的冗余关键帧和冗余地图点；步骤4、对步骤3求解的相机位姿进行优化，获得最终的相机姿态系统。2.根据权利要求1所述的一种基于先验视觉标签的无人机定位方法，其特征在于：所述步骤1中，在使用环境中布置一个包括多个二维码的地图，每个二维码具有自己独立的ID和位姿信息，获得的视觉标签地图作为无人机导航的先验知识。3.根据权利要求1所述的一种基于先验视觉标签的无人机定位方法，其特征在于：所述步骤2中，使用基于先验视觉标签的相对位姿求解子方法求解图像第一帧与第二帧之间的相对位姿，并判断SLAM系统是否成功求得相对位姿，若成功初始化，则进入特征点三角化环节，若失败，则使用基于特征点的相对位姿求解子方法求解图像第一帧与第二帧之间的相对位姿后再进行三角化；此后将三角化得到的特征点构造为地图点，同时添加关键帧与点以及点与关键帧之间的观测属性，并计算最佳描述子，更新观测方向和距离范围，将新的地图点插入地图，完成初始地图的更新。4.根据权利要求3所述的一种基于先验视觉标签的无人机定位方法，其特征在于：所述基于先验视觉标签的相对位姿求解子方法的过程为：计算第一帧f0中视觉标签与第一帧f0的相对位姿γ0，第二帧f1中视觉标签与第二帧f1的相对位姿γ1，两帧之间的相对位姿T具体为：5.根据权利要求3所述的一种基于先验视觉标签的无人机定位方法，其特征在于：所述基于特征点的相对位姿求解子方法的过程为：先计算本质矩阵模型和单应矩阵模型，本质矩阵模型计算方法为：图像的第一帧f0和第二帧f1中的一对特征点p1和p2是空间中一点P在图片中的投影，一对特征点p1和p2可以确定空间中的一点P，在第一帧f0所设坐标系下点P的空间位置为：P＝[X,Y,Z]
T
；影模型中，点p1和p2的像素坐标分别为：其中，K为相机的内参矩阵，根据对极约束可得：令本质矩阵E＝t^R，然后根据点p1和p2的像素位置求解本质矩阵E；单应矩阵模型的计算方法为：使用DLT算法求解单应矩阵H；然后通过计算上述本质矩阵模型和单应矩阵模型各自的得分，分值计算方法为：
其中，为匹配点对经过本质矩阵模型或单应矩阵模型在当前帧的重投影误差；为匹配点对在经过本质矩阵模型或单应矩阵模型在参考帧的重投影误差；计算判断指标R
H
，计算方法为：若R
H
＞0.45，则选择单应矩阵H恢复位姿(R,t)，否则选择本质矩阵H恢复(R,t)。6.根据权利要求3所述的一种基于先验视觉标签的无人机定位方法，其特征在于：所述特征点三角化环节的具体过程为：空间点P在初始帧第一帧f0的归一化平面里的位置为：空间点P在初始帧第二帧f1的归一化平面里的位置为：根据位置变化关系有：其中，T
rw
为初始帧的单位矩阵，T
cw
为第二帧f1和第一帧f0的相对位姿变化；由三维向量叉乘自己为零，得到：整理后得到：最终，求解得到特征点的空间坐标P
w
。7.根据权利要求1所述的一种基于先验视觉标签的无人机定位方法，其特征在于：所述步...

【专利技术属性】
技术研发人员：沈润杰，刘立杰，黄诚，何斌，
申请(专利权)人：苏州同港无人机研究院有限公司上海外高桥发电有限责任公司，
类型：发明
国别省市：