[发明专利]一种简易的激光雷达点云与光学影像自动配准方法有效
申请号: | 202011572898.1 | 申请日: | 2020-12-24 |
公开(公告)号: | CN112581505B | 公开(公告)日: | 2022-06-03 |
发明(设计)人: | 王强;范生宏;赵美风;勾志阳;张振鑫;王果;何龙;范文杰;崔铁军 | 申请(专利权)人: | 天津师范大学;普达迪泰(天津)智能装备科技有限公司;首都师范大学 |
主分类号: | G06T7/246 | 分类号: | G06T7/246;G06T7/33;G06T7/13;G06T5/00;G06T5/50 |
代理公司: | 西安研创天下知识产权代理事务所(普通合伙) 61239 | 代理人: | 郭璐 |
地址: | 300387 *** | 国省代码: | 天津;12 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 简易 激光雷达 光学 影像 自动 方法 | ||
1.一种简易的激光雷达点云与光学影像自动配准方法,其特征在于,包括如下步骤:
步骤1、预处理过程:
通过相机获得相机光学影像,并进行量化;
通过激光雷达获得三维点云,并裁剪去噪抽稀获得预处理后的三维点云;
步骤2、三维点云投影:将预处理后的三维点云按照仿射运动模型进行采样,再通过旋转、平移,变换,将预处理后的三维点云投影到与仿射运动模型中半球曲面的轴所垂直平面上,生成投影图像,根据投影图像生成深度图像;
步骤3、匹配同名点:采用Harris算子对所述深度图像和所述光学影像进行角点特征提取,通过相关系数法对所述深度图像与光学影像进行匹配同名点,获得深度图像与光学影像的同名点的对应关系;
步骤4、根据步骤3获得的同名点的对应关系,通过直接线性变换求解预处理后的三维点云的空间坐标与光学影像的坐标之间的映射关系;
步骤5、数据融合:通过步骤4获得的映射关系,遍历预处理的三维点云中每个点的坐标,利用映射关系找到光学影像中对应的像元,将像元的纹理信息赋值给对应点云。
2.根据权利要求1所述的一种简易的激光雷达点云与光学影像自动配准方法,其特征在于,上述步骤2中的仿射运动模型,是将激光雷达模拟为虚拟传感器,并设置在半球的经度、纬度的采样点,则仿射运动模型下激光雷达传感器投影的数学表达:
其中,λ>0,表示虚拟传感器的远近的缩放参数;
θ∈[0,90),θ代表倾斜角,表示虚拟传感器在半球采样点与半球曲面的轴夹角;
φ∈[0,2π),表示虚拟传感器投影到与半球曲面的轴垂直的平面,与所述平面Y轴正方向的夹角;
ψ∈[0,2π),表示虚拟传感器沿着自身光轴的旋转角度;
则,旋转变换矩阵表达如下:
则,平移矩阵表达如下:
将观察视点沿X、Y和Z轴进行平移,用T3×1表示:
上式中,x0、y0和z0为初始观察点的坐标,由于初始视点在坐标系原点,因此x0=y0=z0=0,Tx、Ty和Tz分别为X、Y和Z轴上平移量;
则,变换矩阵M为4×4矩阵,是旋转矩阵(2)与平移矩阵(3)组成的新矩阵,由两者相乘得到:
其中,E在这里是单位矩阵,即
经过投影变换后,激光雷达预处理的三维点云坐标实现了转变并生成了二维投影图像。
3.根据权利要求2所述的一种简易的激光雷达点云与光学影像自动配准方法,其特征在于,按照仿射运动模型进行采样是将激光雷达分别虚拟设置在量化的仿射运动模型半球的经度、纬度的量化单位上,获得一组二维投影图像,并生成对应的一组深度图像。
4.根据权利要求3所述的一种简易的激光雷达点云与光学影像自动配准方法,其特征在于,一组深度图像重复上述步骤3,获得一组深度图像与光学影像的同名点的对应关系,计算每个深度图像与光学影像的角点特征的相关系数总和,选择相关系数总和最大的二维点云深度图像作为深度图像。
5.根据权利要求1所述的一种简易的激光雷达点云与光学影像自动配准方法,其特征在于,步骤3中的角点特征提取采用以梯度变化及邻域平滑度为参数的角点提取方法。
6.根据权利要求1所述的一种简易的激光雷达点云与光学影像自动配准方法,其特征在于,步骤3中的匹配同名点的原则采用相关系数最大作为匹配准则。
7.根据权利要求1所述的一种简易的激光雷达点云与光学影像自动配准方法,其特征在于,步骤2中的深度图像生成过程,将投影图像按照三维点云到激光雷达的距离,对投影图像中的对应像元赋予不同的颜色值,生成深度图像。
8.根据权利要求1所述的一种简易的激光雷达点云与光学影像自动配准方法,其特征在于,步骤4中的映射关系的具体求解过程如下:
由公式(1)、(2)、(3)、(4)建立三维点云的空间坐标系与光学影像的坐标之间的关系:
其中,(uA,vA)为三维点云的空间点A在光学影像的坐标系下的坐标,(XA,YA,ZA)为空间点A在雷达三维点云的空间坐标系下坐标;
令公式(5)中l12=1可得出直接线性变换方程(6):
将公式(6)中l1~l11作为未知数列方程(7):
根据公式(7)列出方程:
L=(BTB)-1BTW (8)
其中:L=(l1,l2,l3,l4,l5,l6,l7,l8,l9,l10,l11)T,W=(-u1,-v1,-u2,-v2,…,-un,-vn)T,
根据步骤3的已知匹配点和公式(8)可求解出直接线性变换参数l1~l11,获得预处理后的三维点云的空间坐标与光学影像的坐标之间的映射关系。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于天津师范大学;普达迪泰(天津)智能装备科技有限公司;首都师范大学,未经天津师范大学;普达迪泰(天津)智能装备科技有限公司;首都师范大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011572898.1/1.html,转载请声明来源钻瓜专利网。