[发明专利]激光定位初始化方法有效
申请号: | 201910306885.0 | 申请日: | 2019-04-17 |
公开(公告)号: | CN110031825B | 公开(公告)日: | 2021-03-16 |
发明(设计)人: | 顾浩;黄友;张国龙;张放;李晓飞;张德兆;王肖;霍舒豪 | 申请(专利权)人: | 北京智行者科技有限公司 |
主分类号: | G01S7/497 | 分类号: | G01S7/497;G01S17/06 |
代理公司: | 北京慧诚智道知识产权代理事务所(特殊普通合伙) 11539 | 代理人: | 李楠 |
地址: | 100096 北京市昌平区回*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 激光 定位 初始化 方法 | ||
1.一种激光定位初始化方法,其特征在于,所述方法包括:
获取多个点云序列的拼接帧点云信息;所述多个点云序列按照预设第一距离依次排列;每个所述点云序列包括获取时间依次递增的第一帧点云、第二帧点云和第三帧点云,所述第一帧点云、第二帧点云和所述第三帧点云拼接得到拼接帧点云;所述拼接帧点云信息包括拼接帧点云的局部位置坐标、拼接帧点云中各点云的位置、反射率和高度;
对所述拼接帧点云进行采样,得到多个采样点云;
根据所述采样点云中各点云的位置,确定点云分布中心;
根据所述点云分布中心,对所述采样点云进行主成分分析,生成主成分分析特征矩阵;
根据所述主成分分析特征矩阵,构建特征坐标系;
根据所述点云分布中心和所述特征坐标系,对所述采样点云进行划分,生成多个象限,在每个所述象限内以三维直方图存储相应采样点云的反射率和/或高度;
根据所述拼接帧点云的局部位置坐标,为包括多个三维直方图的所述采样点云命名,生成所述采样点云的特征文件;多个所述拼接帧的采样点云的特征文件构成特征文件集;
实时获取当前帧点云信息;所述当前帧点云信息包括当前帧点云的位置坐标、当前帧点云中各点云的位置、反射率和高度;
对所述当前帧点云进行采样,得到多个当前采样点云;
根据所述当前采样点云中各点云的位置,确定当前点云分布中心;
根据所述当前点云分布中心,对所述当前采样点云进行主成分分析,生成当前主成分分析特征矩阵;
根据所述当前主成分分析特征矩阵及矩阵的旋转特性,构建四个当前特征坐标系;
根据所述当前点云分布中心和所述四个当前特征坐标系,对所述当前采样点云进行划分,在每个当前特征坐标系下,生成多个当前象限,在每个所述当前象限内以实时三维直方图存储相应当前采样点云的反射率和/或高度;
根据预设的搜索中心与多个所述拼接帧点云的局部位置坐标的距离,获取所述距离在预设第二距离内的第一数量个拼接帧点云对应的第一数量个特征文件;
将所述实时三维直方图与所述第一数量个特征文件中的三维直方图进行第一匹配计算,得到第一匹配结果;
根据第一匹配结果中的分值,确定第二数量个特征文件;所述第二数量小于所述第一数量;
根据所述第二数量个特征文件的局部位置坐标和所述主成分分析特征矩阵以及所述当前主成分分析特征矩阵,计算当前帧点云的第二数量个实时位置;
在多个方位上,对所述第二数量个特征文件进行平移,确定第二数量个特征文件中每个特征文件在每个方位上平移后的位置;
将所述第二数量个实时位置与每个特征文件在每个方位上平移后的位置进行第二匹配计算,得到第二匹配结果;
当所述第二匹配结果中的分值大于预设阈值时,确定完成激光定位的初始化;
其中,所述根据所述第二数量个特征文件的局部位置坐标和所述主成分分析特征矩阵以及所述当前主成分分析特征矩阵,计算当前帧点云的第二数量个实时位置,具体包括:
将所述第二数量个特征文件中每个特征文件的局部位置坐标和所述主成分分析特征矩阵、所述当前主成分分析特征矩阵的倒数相乘,得到与该特征文件对应的当前帧点云的一个实时位置。
2.根据权利要求1所述的方法,其特征在于,所述第一帧点云、第二帧点云和所述第三帧点云拼接得到拼接帧点云,具体包括:
计算第一帧点云相对于第二帧点云的第一相对位姿变换;
计算第三帧点云相对于第二帧点云的第二相对位姿变换;
根据所述第一相对位姿变换、所述第二相对位姿变换和所述第二帧点云的位姿,叠加得到拼接帧点云。
3.根据权利要求1所述的方法,其特征在于,所述根据所述采样点云中各点云的位置,确定点云分布中心,具体包括:
获取所述采样点云中点云的个数;
将所述采样点云中各点云的x坐标、y坐标和z坐标分别相加,得到x坐标相加结果、y坐标相加结果和z坐标相加结果;
将所述x坐标相加结果、y坐标相加结果和z坐标相加结果分别除以点云的个数,得到点云分布中心。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京智行者科技有限公司,未经北京智行者科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910306885.0/1.html,转载请声明来源钻瓜专利网。
- 上一篇:激光雷达联合标定方法及装置
- 下一篇:一种仿蝙蝠接收部位模拟装置及使用方法