【技术实现步骤摘要】
一种海上目标近距离实时位姿监测方法
[0001]本专利技术涉及目标位姿监测,特别是涉及一种海上目标近距离实时位姿监测方法。
技术介绍
[0002]作为占据地表最大空间面积的环境形态,海洋在地球生命的发展历程中扮演着至关重要的角色。随着人类科技与生产力的不断进步与扩张,我们探索海洋的意愿与需求也在日益增长。而在海洋探索任务当中,关于海面结构物目标的位姿监测工作十分重要。通过估计目标的实时位姿可以了解目标的运动趋势、评估作业安全性、为控制系统提供反馈输入等,是分析海上作业分析决策、海上结构物控制等系统的实现基础之一。
[0003]在海上结构物的监测任务当中,由于海上环境下风浪流载荷耦合作用产生复杂非线性响应,近距离监测情境下无法捕捉观测目标全貌图像,GPS+IMU传感精度不足、结构间缺少通信等问题,使得常用方式对其实时相对位姿要素实现精准实时追踪存在一定困难;同时,由于海上漂浮式结构物通常具有较大结构尺度,近距离观测过程中难以直接获取观测目标的全貌信息,故而不便于使用常见基于全局特征的位姿估计算法进行监测。基于以上背景因素,如何精确、高效地近距离实时感知海上目标状态成为了一个重要课题。
[0004]需要说明的是,在上述
技术介绍
部分公开的信息仅用于对本申请的背景的理解,因此可以包括不构成对本领域普通技术人员已知的现有技术的信息。
技术实现思路
[0005]本专利技术的主要目的在于克服上述
技术介绍
的缺陷,提供一种海上目标近距离实时位姿监测方法。
[0006]为实现上述目的,本专利技术采 ...
【技术保护点】
【技术特征摘要】
1.一种海上目标近距离实时位姿监测方法,其特征在于,包括如下步骤:在海上目标结构物上布置若干标识物或标识物组合,所述标识物为二维平面形态或三维立体形态;采集模块获取相应标识物或标识物组合在目标结构物不同位姿下的观测数据;计算模块处理分析所述观测数据,得到监测信息,所得信息通过标识物映射关联目标结构物整体,实现对目标结构物的位姿监测。2.如权利要求1所述的海上目标近距离实时位姿监测方法,其特征在于,所述标识物组合为多个标识物按照设定的位置规律和/或编码方式排列组合而成。3.如权利要求1所述的海上目标近距离实时位姿监测方法,其特征在于,所述采集模块包括图像传感器,用于收集标识物在不同位姿状态下的图像数据。4.如权利要求3所述的海上目标近距离实时位姿监测方法,其特征在于,所述计算模块的处理过程包括:初始化传感器内外参数;利用设定的自适应阈值提取轮廓分割原始数据,提取标识物原始图像;根据标识物的原始图像建立角点二维坐标系,并根据其真实物理尺寸建立标识物的角点三维坐标(X,Y,Z)
T
,以及标识物角点在原始图像中的二维投影点坐标(U,V);根据相机内参列出内参矩阵M;根据角点三维坐标(X,Y,Z)
T
和投影点坐标(U,V)的以下数学关系计算旋转矩阵R和平移矩阵t的初始解R0、t0:通过使用迭代方法,对初始解进行优化,以最小化重投影误差,所述重投影误差是通过将求解得到的相机参数将相机参数和检验点三维坐标代入三维角点坐标与投影点坐标之间的所述数学关系进行计算得到二维投影结果,然后计算标识物角点二维坐标与投影结果之间的差异;经过迭代优化后,得到相机的最终旋转矩阵R和平移矩阵t,表示标识物与传感器在空间中的相对位姿参数。5.如权利要求4所述的海上目标近距离实时位姿监测方法,其特征在于,所述计算模块的处理过程还包括:根据目标物与单一标识物或标识物组合的工程参数,得出目标物三维坐标系P
′
到标识物三维坐标系P之间的旋转矩阵R
′
和平移矩阵t
′
,或者得出每个标识物坐...
【专利技术属性】
技术研发人员:耿子涵,敏杰,任政儒,丁文伯,张晓平,
申请(专利权)人:清华大学深圳国际研究生院,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。