一种基于多目视觉的水下目标位姿估计方法
本发明涉及计算机视觉与水下机器人智能作业,更具体地说,涉及一种基于多目视觉的水下目标位姿估计方法。
背景技术:
1、在水下作业场景中,对水下目标(如设备、生物或结构物)的位姿进行准确估计是实现精准交互、目标跟踪的重要条件 。传统的水下定位方法主要依赖声学传感器,但不可避免地存在定位精度低(通常仅为厘米级至分米级)、实时性较差,且极易受水体扰动及多径效应影响等固有的技术缺陷 。相比之下,视觉定位方法虽然能够提供更高精度(毫米级)的观测结果,但单目视觉由于缺乏深度信息,难以直接且准确地估计目标的三维位姿 。同时,多目视觉系统在水下复杂环境中应用时,迫切需要解决由于光照衰减严重、水体散射强烈以及悬浮颗粒干扰等造成的光学特征丢失、特征匹配困难与多视角有效融合等一系列技术瓶颈 。上述问题的存在,严重限制了多目视觉在水下高精度动态追踪及复杂作业中的进一步工程化发展与应用突破。
技术实现思路
1、为了解决现有技术中水下目标位姿估计精度低、易受复杂水下环境及悬浮物遮挡干扰的问题,本发明提供了一种抗干扰性强且高精度的水下目标位姿估计系统与方法 。本发明搭建了一个搭载闭环伺服电机的水下设备承载平台,并配置多自由度移动云台与相机监测面阵 。在此基础上,系统协同利用光学摄像头从不同角度对水下目标进行有效观测,通过提取主动式标记点的二维灰度特征,并结合三角测量技术精准重构目标的绝对三维空间坐标 。针对水下流沙或生物等造成的视线遮挡现象,本发明创新性地引入了光学-惯性混合系统逻辑,将惯性传感器与光学传感器的视觉特征深度融合以提供短时运动位姿推算,减少遮挡对光学系统的负面影响 。在算法解算端,本发明采用透视n点(pnp)映射模型建立三维世界坐标与二维像素坐标的对应关系,并通过调用 levenberg-marquardt 非线性迭代算法持续微调旋转矩阵和平移向量,不断降低重投影误差,最终直接解算出目标当前时刻精确的最优位姿,全程无需依赖声学定位手段即可实现高鲁棒性的目标三维重构与位姿估计。
2、本发明采用的技术手段如下:
3、一种基于多目视觉的水下目标位姿估计方法,包括以下步骤:
4、s1、系统部署与联调:在水下平台部署搭载多自由度移动云台的相机监测面阵,通过采集水下标定板图像完成相机的内参矩阵标定,并调试云台的闭环伺服电机以确保多视角的精准控制 ;
5、s2、多视角图像采集:协同控制面阵上的多个光学相机,实时获取水下目标的灰度图像序列;
6、s3、二维特征提取:根据相机获取的灰度图和已标定的相机内参,推算特征中心点位置,提取主动式标记点在图像坐标系下的二维像素坐标;
7、s4、三维空间重构与特征融合:基于同一时刻不同相机的二维图像,利用三角测量原理对捕获对象的绝对位置进行解算,构建标记点在世界坐标系下的三维空间坐标;同时融合目标自身的惯性传感器数据,以补偿光学传感器受水下悬浮物遮挡带来的负面影响;
8、s5、位姿解算与非线性优化:利用透视n点算法(pnp)建立三维空间坐标与二维图像投影点之间的映射关系,并采用 levenberg-marquardt 算法不断调整旋转矩阵和平移向量,最小化理论投影点与实际提取的二维特征点之间的重投影误差,最终输出最优的水下目标三维位姿;
9、进一步地,所述步骤s5中位姿解算与非线性优化,其优化过程为:
10、在已知水下目标上特征点的三维世界坐标以及匹配得到的二维像素坐标的基础上,结合摄像头的内参矩阵构建投影映射模型 ;
11、采用 levenberg-marquardt 算法作为非线性优化手段,将计算得出的旋转矩阵和平移向量作为变量进行迭代求解 ;
12、通过持续更新这两个变量的值,使得通过相机投影模型计算出的理论二维投影点,与步骤s3中实际提取到的二维像素坐标之间的几何距离误差之和达到最小 。
13、较现有技术相比,本发明具有以下优点。
14、1、本发明基于多目视觉与三角测量原理,提高了水下三维重构的精确性。通过五个光学摄像头协同观测,结合张正友标定法获取的精确内参矩阵,有效解决了单目视觉缺乏深度信息的问题,实现了对水下目标高精度的绝对三维空间坐标重构。
15、2、本发明引入光学-惯性混合系统,增强了水下目标追踪的抗遮挡鲁棒性。针对水下流沙、悬浮颗粒或生物造成的视线短暂遮挡问题,利用惯性传感器数据在短时间内的连续性,补偿了光学特征丢失带来的断点,保证了位姿估计在复杂水下环境中的连续性与稳定性。
16、3、本发明结合pnp算法与levenberg-marquardt非线性优化,大幅提升了位姿解算的准确度。将寻找最优旋转矩阵和平移向量的过程转化为投影误差最小化的迭代求解过程,极大地降低了水下折射和硬件公差带来的映射误差,从而输出更为精准的三维空间位姿。
17、4、本发明采用多自由度移动云台协同监测,扩大了系统的有效观测视角与环境适应力。云台支持 0°~360°水平旋转以及 -90°~90°俯仰旋转,可根据目标方位动态调整面阵姿态,保证目标始终处于有效观测范围内,显著提高了动态目标的连续追踪能力。
18、5、本发明采用特定波长的定制光学设计,有效克服了水下环境干扰。通过450nm波长光源与具备ip68防护等级的高帧率(180fps)相机组合,能有效穿透水体并抑制杂散光干扰,最远主动追踪距离大于10m,保障了底层图像数据的清晰度与一致性。
1.一种基于多目视觉的水下目标位姿估计方法,其特征在于,包括以下步骤:
2.根据权利要求1所述的一种基于多目视觉的水下目标位姿估计方法,包括以下步骤:
3. 根据权利要求1所述的一种基于多目视觉的水下目标位姿估计方法,其特征在于,在部署多自由度移动云台与相机监测面阵并完成系统标定联调后 ,协同控制多个光学相机实时获取水下目标的多视角灰度图像序列,通过提取图像中主动式标记点的二维像素坐标 ,结合三角测量原理重构标记点的绝对三维空间坐标,同时融合目标惯性传感器数据以补偿水下遮挡导致的光学特征丢失;利用透视n点(pnp)算法建立三维坐标与二维投影点之间的映射关系,并采用非线性优化算法迭代最小化重投影误差,从而精准解算出水下目标的旋转矩阵和平移向量。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com