[发明专利]用于运输载具的传感器标定方法、装置及存储介质在审
申请号: | 202111552804.9 | 申请日: | 2021-12-17 |
公开(公告)号: | CN114252872A | 公开(公告)日: | 2022-03-29 |
发明(设计)人: | 赵德力;曾阳露;陶永康;傅志刚;彭登 | 申请(专利权)人: | 广东汇天航空航天科技有限公司 |
主分类号: | G01S7/497 | 分类号: | G01S7/497;G01C25/00 |
代理公司: | 深圳市智圈知识产权代理事务所(普通合伙) 44351 | 代理人: | 谭逢 |
地址: | 511400 广东省广州市*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 用于 运输 传感器 标定 方法 装置 存储 介质 | ||
1.一种用于运输载具的传感器标定方法,所述运输载具上设有定位系统及激光雷达,其特征在于,所述方法包括:
根据所述定位系统输出的定位数据获取基准里程数据,所述基准里程数据包括里程时间戳及与所述里程时间戳对应的里程数据,所述里程数据采用第一坐标系描述;
根据所述激光雷达输出的数据获取第一点云序列,所述第一点云序列包括多个点云数据包,所述点云数据包包括点云时间戳及多个激光点数据,所述激光点数据包括坐标及点时间偏移量;
根据所述点云时间戳、所述点时间偏移量及所述基准里程数据获取所述点云数据包中每个激光点的里程信息;
将所述第一点云序列内的激光点的坐标采用预设的第一起始标定矩阵转换至所述第一坐标系得到第二点云序列;以及
以所述第二点云序列内激光点在其最近邻域内点之间的距离为参数表征所述第一起始标定矩阵的误差,以预设的迭代算法对所述第一起始标定矩阵进行迭代优化得到第一标定矩阵。
2.如权利要求1所述的方法,其特征在于,所述以预设的迭代算法对所述第一起始标定矩阵进行迭代优化得到第一标定矩阵,包括:
以预设的迭代算法对所述第一起始矩阵进行迭代优化;
在所述误差小于预设阈值的情况下,结束所述迭代优化得到所述第一标定矩阵。
3.如权利要求1所述的方法,其特征在于,所述迭代算法包括迭代次数,所述以预设的迭代算法对所述起始标定矩阵进行迭代优化得到第一标定矩阵,包括:
以预设的迭代算法对所述第一起始矩阵进行迭代优化;
在所述迭代次数大于预设值的情况下,结束所述迭代优化得到所述第一标定矩阵。
4.如权利要求1所述的方法,其特征在于,所述以所述第二点云序列内激光点在其最近邻域内点之间的距离为参数表征所述第一起始标定矩阵的误差,包括:
计算所述第二点云序列内所有激光点在其最近邻域内点之间的距离的和,以所述和为参数表征所述第一起始标定矩阵的误差。
5.如权利要求1-4任一项所述的方法,其特征在于,所述第一起始标定矩阵包括旋转标定矩阵和平移标定矩阵,所述将所述第一点云序列内的激光点的坐标采用预设的第一起始标定矩阵转换至所述第一坐标系得到第二点云序列,包括:
在所述平移标定矩阵置空的条件下,将所述第一点云序列内的激光点的坐标采用所述第一起始标定矩阵转换至所述第一坐标系得到所述第二点云序列。
6.如权利要求5所述的方法,其特征在于,所述方法还包括:
将所述第一点云序列内的激光点的坐标采用预设的第二起始标定矩阵转换至所述第一坐标系得到第三点云序列,所述预设的第二起始标定矩阵是在所述平移标定矩阵置空的情况下,以所述第二点云序列内激光点在其最近邻域内点之间的距离为参数表征所述第一起始标定矩阵的误差,以预设的迭代算法对所述第一起始标定矩阵进行迭代优化得到;
以所述第三点云序列内激光点在其最近邻域内点之间的距离为参数表征所述第二起始标定矩阵的误差,以预设的迭代算法对所述第二起始标定矩阵进行迭代优化得到所述第一标定矩阵。
7.如权利要求1-4任一项所述的方法,其特征在于,所述第一起始标定矩阵包括旋转标定矩阵和平移标定矩阵,所述将所述第一点云序列内的激光点的坐标采用预设的第一起始标定矩阵转换至所述第一坐标系得到第二点云序列,包括:
在所述旋转标定矩阵置空的条件下,将所述第一点云序列内的激光点的坐标采用所述第一起始标定矩阵转换至所述第一坐标系得到所述第二点云序列。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广东汇天航空航天科技有限公司,未经广东汇天航空航天科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111552804.9/1.html,转载请声明来源钻瓜专利网。