一种面向无人自主着降的相对位姿测量方法技术

本发明专利技术提供一种面向无人自主着降的相对位姿测量方法，它的步骤：（1）在无人机上安装垂直下视的日盲区紫外波段摄像机并采集合作靶标图像；（2）检测当前时刻摄像机采集合作靶标图像中的LED的像素坐标；使用前一时刻无人机位姿，进行基于位姿预测的LED的2D

【技术实现步骤摘要】
一种面向无人自主着降的相对位姿测量方法


[0001]本专利技术涉及位姿测量领域，具体涉及一种面向无人自主着降的相对位姿测量方法。

技术介绍

[0002]无人机自主着降是实现无人机自主飞行的关键技术之一。
[0003]在该研究领域中，基于视觉的无人机自主着降引导技术是一个新兴的研究方向。传统有人机着降时，飞行员依靠视觉所提供信息定位飞机空间位置和飞机相对着陆平台的旋转关系。而无人机视觉自主着降引导主要依赖于预设的地面合作目标，通过对地面合作目标的检测、识别、跟踪和相对位姿测量实现无人机的定位与自主导航，并根据合作目标在实时图像中的尺度、形状等信息估计无人机降落过程中的飞行姿态。
[0004]国内外学者针对无人机视觉自主着降引导开展了一系列研究。南加州大学设计了“H”形标识着陆目标，采用透视投影不变特征技术提取“H”形特征，依据“H”不变矩特性对大量目标图像上“H”形的区域矩进行统计，得到一个统计量作为该“H”形目标正确的区域矩。加利福尼亚大学设计的视觉辅助着陆目标采用已知的正方形着陆目标图识，视觉算法是用机载摄像机采集目标视频图像，然后对其目标图像进行分割和提取目标角点，继而得到基于视觉状态估计运动信息引导无人机着陆化。
[0005]斯坦福大学航空机器人实验室设计的视觉着陆目标为多个圆环形着陆目标图识。
[0006]南京航空航天大学设计了一种新型着陆目标图识进行辅助视觉着陆，该图识包含两个同心彩色圆。
[0007]上述相对位姿测量基于可见光成像，成像过程受气候条件、环境照度、自然光背景等条件影响较大，信标图案的识别以及特征信息提取算法复杂、稳健性差，严重影响算法的稳定性，从而导致无人机自主着降失败。另外，高分辨率的可见光图像带来巨大的运算量，尤其是在算力有限的机载平台上，容易导致实时性不足。本专利技术设计了一种基于“日盲区”波段的无人机相对位姿测量方法，通过对光谱的过滤，从物理层面上大幅度削除了无效信息，凸显出合作靶标上感兴趣目标点，从而提升系统在复杂环境下的适应性、稳定性以及实时性。
[0008]Perspective
‑
n
‑
Points (PnP)是一种常见的3D
‑
2D的位姿求解方法，该类算法需要已知匹配的3D点和图像2D点。
[0009]此专利技术可应用于无人机灾情救援、物流运输、智能巡线等领域，可带来较大社会效益和经济效益。

技术实现思路

[0010]本专利技术设计一种基于“日盲区”波段的无人机相对位姿测量方法，能够大幅度提升系统在多种环境下的适应性和稳定性；本专利技术旨在提供一种基于视觉的无人机与地面靶标相对位姿测量方法，适用于无人机自主着降领域。
[0011]在“日盲区”波段图像中，合作靶标上的多个LED均体现为亮度较高的光斑，具有较大的相似性，难以辨识不同的LED像点，导致无法直接使用PnP位姿求解方法。
[0012]本专利技术提出了一种基于组合遍历思想的LED的 2D像点和3D物点匹配方法，遍历LED像点和物点所有的匹配组合的候选位姿，使用LED重投影的方法验证匹配组合的可能性；考虑到系统实施的实时性，进一步提出一种基于位姿预测的LED 2D
‑
3D匹配方法，采用线性预测的方法推导下一时刻LED 2D像点的坐标，通过与真实像点坐标比对，判断2D
‑
3D匹配是否有效。
[0013]本专利技术通过组合遍历法实现匹配初始化和重匹配，通过位姿预测法实现匹配关系持续跟踪，两种方法的切换使用，既保证了2D
‑
3D匹配的精度，也提升了匹配速度。稳定、高速的LED 2D
‑
3D匹配方法，为下一步基于P3P的无人机相对位姿优化求解提供了技术基础。
[0014]一种面向无人自主着降的相对位姿测量方法，其特征在于，包括以下步骤：步骤（1）在无人机上安装固定垂直下视摄像机，以当前时刻采集合作靶标的图像、无人机前一时刻与靶标的相对位姿、当前时刻合作靶标中多个LED的物理坐标作为测量系统的输入；步骤（2）当输入为当前时刻摄像机采集的合作靶标图像时，检测出图像中多个LED的像素坐标；使用无人机前一时刻相对位姿，进行基于位姿预测的LED灯2D
‑
3D匹配；如果匹配失败，则用组合遍历法重新确定图像中LED与合作靶标中LED的2D
‑
3D匹配关系；步骤（3）使用匹配后的多组LED点对，以P3P算法的一个解作为位姿初值，迭代计算LED的重投影误差最小值，求解输出位姿优化估计值。
[0015]其中，所述步骤（1）中的在无人机上安装固定垂直下视摄像机为：无人机搭载垂直朝下的摄像机，为了避免到日光干扰，成像器件配合窄带滤光片，将工作谱段限制在日盲区紫外波段，以消除自然背景光的干扰。
[0016]其中，所述步骤（1）中的合作靶标中多个LED的工作波段限制在200nm
‑
280nm。
[0017]其中，所述步骤（2）中包括以下步骤：步骤
①
当前时刻图像中多个LED的检测；步骤
②
基于组合遍历法进行当前时刻图像中多个LED的匹配。
[0018]其中，在所述步骤
①
之前，还包括一个定义的过程：定义LED在靶标上的三维坐标为，单位为米；LED的数量为，则LED的坐标为；LED在图像中的检测出的二维坐标为，单位为像素；检测的数量为，则检测的集合为；一个LED的坐标和其对应检测图像坐标的对应关系表示为，位姿表示为；定义灰度图像，其中u和v分别为图像的像素坐标。
[0019]其中，所述步骤
①
具体为：
LED为紫外LED，其波长与摄像机中的滤镜相匹配；因此，LED在图像中显得非常明亮，通过下述阈值函数检测出LED灯；
ꢀꢀꢀꢀꢀꢀꢀꢀ
(1)其中阈值参数threshold根据经验设置为125；使用图像一阶矩来计算LED光斑中心，其定义为
ꢀꢀꢀꢀꢀꢀꢀ
(2)其中，p、q分别取0或1；图像中的LED检测的坐标为
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(3)
ꢀꢀꢀꢀꢀꢀ
(4)其中，和分别为LED质心的X轴坐标和Y轴坐标；和分别为图像关于X轴和Y轴的矩，表征LED区域的面积。
[0020]其中，所述步骤
②
具体为：由于图像的LED均体现为亮度较高的光斑，具有较大的相似性，因此无法直接区分不同的LED；首先，在图像中选取3个检测到的LED像点，然后在靶标上选取3个LED物点，这样会有多种组合方式；然后，利用P3P算法来计算每种组合；根据P3P算法的特点，每种组合会产生的四个候选位姿；对于每个候选位姿，将靶标上未参与P3P计算的LED再投影到摄像机图像中；如果该LED重投影像点与检测到的像点距离小于阈值，则认为此组LED匹配成功；对于重投影距离阈值，通常使用像素；为了对异常值具有鲁棒性，为每个组合的LED配对生成一个计数直方图；当一个配对被认为是正本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种面向无人自主着降的相对位姿测量方法，其特征在于，包括以下步骤：步骤（1）在无人机上安装固定垂直下视摄像机，以当前时刻采集合作靶标的图像、无人机前一时刻与靶标的相对位姿、当前时刻合作靶标中多个LED的物理坐标作为测量系统的输入；步骤（2）当输入为当前时刻摄像机采集的合作靶标图像时，检测出图像中多个LED的像素坐标；使用无人机前一时刻相对位姿，进行基于位姿预测的LED灯2D
‑
3D匹配；如果匹配失败，则用组合遍历法重新确定图像中LED与合作靶标中LED的2D
‑
3D匹配关系；步骤（3）使用匹配后的多组LED点对，以P3P算法的一个解作为位姿初值，迭代计算LED的重投影误差最小值，求解输出位姿优化估计值。2.根据权利要求1所述的方法，其特征在于，所述步骤（1）中的在无人机上安装固定垂直下视摄像机为：无人机搭载垂直朝下的摄像机，为了避免到日光干扰，成像器件配合窄带滤光片，将工作谱段限制在日盲区紫外波段，以消除自然背景光的干扰。3.根据权利要求1所述的方法，其特征在于，所述步骤（1）中的合作靶标中多个LED的工作波段限制在200nm
‑
280nm。4.根据权利要求1所述的方法，其特征在于，所述步骤（2）中包括以下步骤：步骤
①
当前时刻图像中多个LED的检测；步骤
②
基于组合遍历法进行当前时刻图像中多个LED的匹配。5.根据权利要求4所述的方法，其特征在于，在所述步骤
①
之前，还包括一个定义的过程：定义LED在靶标上的三维坐标为，单位为米；LED的数量为，则LED的坐标为；LED在图像中的检测出的二维坐标为，单位为像素；检测的数量为，则检测的集合为；一个LED的坐标和其对应检测图像坐标的对应关系表示为，位姿表示为；定义灰度图像，其中u和v分别为图像的像素坐标。6.根据权利要求4所述的方法，其特征在于，所述步骤
①
具体为：LED为紫外LED，其波长与摄像机中的滤镜相匹配；因此，LED在图像中显得非常明亮，通过下述阈值函数检测出LED灯；
ꢀꢀꢀꢀꢀꢀ
(1)其中阈值参数threshold根据经验设置为125；使用图像一阶矩来计算LED光斑中心，其定义为
ꢀꢀꢀꢀꢀꢀꢀ
(2)其中，p、q分别取0或1；图像中的LED检测的坐标为
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(3)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(4)其中，和分别为LED质心的X轴坐标和Y轴坐标；和分别为图像关于X轴和Y轴的矩，表征LED区域的面积。7.根据权利要求4所述的方法，其特征在于，所述步骤
②
具体为：由于图像的LED均体现为...

【专利技术属性】
技术研发人员：徐诚，孔繁锵，殷奇缘，
申请(专利权)人：南京航空航天大学，
类型：发明
国别省市：