一种适用于刚性锥柱组合目标的非共线双相机位姿测量方法

摘要: 本发明属于机器视觉高速动态位姿检测领域,具体涉及一种适用于刚性锥柱组合目标的非共线双相机位姿测量方法。背景技术:1、随着机器视觉技术的快速发展,非接触式视觉位姿...
一种适用于刚性锥柱组合目标的非共线双相机位姿测量方法

本发明属于机器视觉高速动态位姿检测领域,具体涉及一种适用于刚性锥柱组合目标的非共线双相机位姿测量方法。

背景技术:

1、随着机器视觉技术的快速发展,非接触式视觉位姿测量已成为高速运动目标状态监测的核心技术手段。其中,双相机协同测量方案因部署灵活、无需主动光源、适配远距离测量等优势,被广泛应用于各类动态目标的位姿检测场景。

2、现有双机位姿测量技术中,绝大多数方案基于平行双目相机架构设计,对两台相机的安装位置、光轴平行度、基线距离有严格的限定,无法适配右侧视角加前下方视角配合这类非共线、大视差、光轴非平行的灵活部署场景;在非共线大视差条件下,现有双相机外参标定方法精度不足,易出现极线约束失效的问题,直接导致后续位姿解算误差大幅提升。

3、针对回转体类目标的位姿测量,现有技术多针对纯圆柱形目标设计,对于下半圆柱段、上半圆锥段组成的刚性锥柱组合回转体目标,存在明显的技术短板:一方面,该类目标多为无纹理金属表面,现有基于orb、sift等通用纹理特征的提取与匹配方案,极易出现特征误匹配甚至无法匹配的问题;另一方面,高速移动场景下,目标成像存在严重的运动模糊,现有算法无法稳定提取目标的有效几何特征,进一步加剧了匹配难度与位姿解算的不稳定性。

4、在位姿解算环节,现有通用多视图pnp算法未利用锥柱组合目标的固有几何先验信息,针对回转体目标的解算存在奇异性、多解问题,尤其在非共线大视差、高速动态场景下,解算结果易出现跳变、发散,无法保证位姿测量的精度与连续性;同时,现有算法未针对高速移动目标的运动特性做时序优化,连续帧位姿结果抖动严重,无法满足高速动态场景下的稳定测量需求。需要特别说明的是,与平行双目视觉系统不同,非共线大视差部署场景下,两台相机的极线几何关系更为复杂,对极线约束的精度要求更高,外参标定的微小误差会被严重放大,导致特征匹配的误匹配率显著提升;此外,大视差下的透视投影变形会使常规的圆形、直线特征检测算法失效,这也是现有技术在非共线场景下难以实现高精度测量的核心痛点。

技术实现思路

1、基于上述问题,本发明提出一种适用于刚性锥柱组合目标的非共线双相机位姿测量方法,解决现有技术在非共线大视差场景下,对高速移动锥柱组合无纹理目标位姿测量存在的外参标定精度低、特征提取与匹配稳定性差、位姿解算存在多解奇异性、动态测量实时性与精度不足的技术问题,实现对高速移动锥柱组合目标6d位姿的高精度、高鲁棒性、高实时性测量。

2、实现本发明目的的具体技术方案为:

3、一种适用于刚性锥柱组合目标的非共线双相机位姿测量方法,包括以下步骤:

4、步骤1、相机内参标定;

5、步骤2、双相机外参精标定;

6、步骤3、图像采集和预处理;

7、步骤4、双视角特征无歧义匹配;

8、步骤5、带几何约束的多视图位姿解算。

9、相比于现有技术,本发明的有益效果在于:

10、(1)本发明完全适配非共线、大视差、光轴非平行的双相机灵活部署场景,通过锥柱组合目标的固有几何约束对双相机外参进行迭代优化,大幅提升了大视差场景下的外参标定精度,解决了现有平行双目相机方案(光轴平行、基线固定)部署受限、极线约束易失效的问题,工程适配性更强。其中,“非共线”指两台相机的投影中心不共线、空间位置分离,无需严格限定光轴方向与基线距离,区别于传统平行双目架构的严苛部署要求。

11、(2)本发明针对锥柱组合目标的结构特性,构建了以锥尖点为核心的专属几何特征体系,锥尖点为唯一无歧义的强边缘特征,即使在高速运动模糊场景下仍可实现亚像素级稳定提取;结合极线约束与拓扑约束的双约束匹配策略,彻底解决了无纹理回转体目标特征误匹配、匹配歧义的问题。

12、(3)本发明将锥柱组合目标的同轴、半径固定、半顶角固定等固有几何硬约束,融入多视图pnp位姿优化模型,彻底消除了回转体目标位姿解算的奇异性与多解问题,大幅提升了位姿解算的精度与稳定性。

13、(4)本发明针对高速移动目标的运动特性,构建了适配高速匀速运动的扩展卡尔曼滤波模型,结合几何约束对连续帧位姿结果进行时序优化,有效抑制了动态测量过程中的帧间跳变与抖动,可满足高速动态场景下的实时性测量需求。

14、(5)本发明为算法实现方案,无需额外硬件装置支撑,无需对目标做贴标、喷涂等预处理,部署成本低、适配性强,可广泛应用于各类高速动态试验、工业高速检测、航空航天试验等场景中,锥柱组合类回转体目标的位姿测量,工程实用性与推广价值显著。

15、下面结合具体实施方式对本发明做进一步的说明。

1.一种适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,包括以下步骤:

2.根据权利要求1所述的适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,所述步骤1中相机内参标定即对非共线双相机中的两台空间位置分离、光轴非平行的单目相机进行独立单目标定,获得各自的内参矩阵:

3.根据权利要求1所述的适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,所述步骤2中的双相机外参精标定,具体为:

4.根据权利要求3所述的适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,所述步骤3中的图像采集和预处理,具体为:

5.根据权利要求4所述的适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,所述图像的自适应去模糊采用基于维纳滤波的运动模糊复原算法,复原核为适配高速直线运动的匀速运动模糊核;

6.根据权利要求4所述的适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,所述步骤4中的双视角特征无歧义匹配,具体为:

7.根据权利要求4所述的适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,所述步骤5中的带几何约束的多视图位姿解算,具体为:

8.根据权利要求4所述的适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,所述非共线双相机位姿测量方法还包括构建目标的高速匀速运动模型,采用扩展卡尔曼滤波ekf框架,将锥柱组合目标的几何约束作为状态约束加入滤波更新过程,对连续帧位姿结果进行平滑滤波,输出稳定的6d位姿序列:

9.根据权利要求7所述的适用于刚性锥柱组合目标的非共线双相机位姿测量方法,其特征在于,将解算出的位姿进行精度验证:

10.一种适用于刚性锥柱组合目标的非共线双相机位姿测量系统,其特征在于,包括以下模块: