[发明专利]一种无标定物的激光雷达外参标定方法有效
申请号: | 202111538615.6 | 申请日: | 2021-12-16 |
公开(公告)号: | CN113933820B | 公开(公告)日: | 2022-03-08 |
发明(设计)人: | 汪丹;王劲 | 申请(专利权)人: | 中智行科技有限公司 |
主分类号: | G01S7/497 | 分类号: | G01S7/497;G01S17/89 |
代理公司: | 南京利丰知识产权代理事务所(特殊普通合伙) 32256 | 代理人: | 陈志军 |
地址: | 210033 江苏省南京*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 标定 激光雷达 方法 | ||
1.一种无标定物的激光雷达外参标定方法,其特征在于:包括,
获取预先建立好的点云地图,使待标定激光雷达位于该点云地图范围内;
待标定激光雷达扫描得到一帧原始点云数据,然后提取原始点云数据的线特征和面特征;
通过定位器件对待标定激光雷达进行定位,得到待标定激光雷达的定位点,然后加载以该定位点为圆心的局部点云地图;
将从原始点云数据中提取的线特征和面特征与局部点云地图的线特征和面特征进行匹配,得到对应的偏航角和位移,将其作为待标定激光雷达的初始外参;
以初始外参为中心,加载局部点云地图;
在局部点云地图中搜索与从原始点云数据中提取的线特征和面特征相对应的匹配点和匹配数据,然后将原始点云数据中的点云点投影至点云地图上,对初始外参进行调整,得到优化后外参;
待标定激光雷达扫描得到新一帧原始点云数据,并从新一帧原始点云数据中提取线特征和面特征;
以优化后外参为中心,加载局部点云地图;
在局部点云地图中搜索与新一帧原始点云数据中提取的线特征和面特征相对应的匹配点和匹配数据,然后将点云点投影至点云地图上,对优化后外参再次进行调整,得到优化后外参;
重复若干次,直至前后两帧点云数据优化计算得到的优化后外参的差值小于设定的阈值,得到待标定激光雷达的外参。
2.根据权利要求1所述的无标定物的激光雷达外参标定方法,其特征在于:所述提取原始点云数据的线特征和面特征包括,
对原始点云数据进行分线束处理;
对每一线束上的点的曲率进行计算;
判断线束中的当前点与下一点的夹角是否大于1°,若是,则将当前点、位于当前点前的连续十个点以及位于当前点后的连续十个点剔除;
将每一线束上的剩余点均分为若干段;
对每段中的点按曲率由大到小的顺序筛选线特征,先依次判断当前点是否为遮挡点,若是,则将当前点、位于当前点前的连续十个点以及位于当前点后的连续十个点均置为坏点,然后依次判断当前点的曲率是否大于预设的阈值,若当前点的曲率大于预设的阈值且当前点不是坏点,则认定当前点为线特征,并在当前点被认定为线特征后,将当前点、位于当前点前的连续十个点以及位于当前点后的连续十个点均置为坏点;
对每段中的点按曲率由小到大的顺序筛选面特征,先依次判断当前点是否与激光线束平行,若平行,则将当前点、位于当前点前的连续十个点以及位于当前点后的连续十个点均置为坏点,然后依次判断当前点的曲率是否小于预设的阈值,若当前点的曲率小于预设的阈值且当前点不是坏点,则认定当前点为面特征,并在当前点被认定为面特征后,将当前点、位于当前点前的连续十个点以及位于当前点后的连续十个点均置为坏点。
3.根据权利要求2所述的无标定物的激光雷达外参标定方法,其特征在于:所述对每一线束上的点的曲率进行计算包括,
根据公式一计算第k个线束上的第i个点的曲率,公式一为:,
其中,表示第k个线束上的点云的第i个点,j=1,2,3,…,10;
根据公式一计算得到,然后对这十个曲率进行排序,取中值作为第k个线束上的第i个点的曲率;
按照以上方法计算每个线束上的点的曲率。
4.根据权利要求3所述的无标定物的激光雷达外参标定方法,其特征在于:需要计算曲率的点为每个线束上的第十个点至第n-10个点, n为线束上点的总数。
5.根据权利要求1所述的无标定物的激光雷达外参标定方法,其特征在于:所述局部点云地图的半径为50~200m。
6.根据权利要求1所述的无标定物的激光雷达外参标定方法,其特征在于:所述定位器件包括GPS定位装置和惯性传感器。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中智行科技有限公司,未经中智行科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111538615.6/1.html,转载请声明来源钻瓜专利网。
- 上一篇:网络域协作干扰位置检测方法及系统
- 下一篇:一种用于冷原子探测的无磁光学镜架