[发明专利]用于定位无人车的方法和装置有效
申请号: | 201810969118.3 | 申请日: | 2018-08-23 |
公开(公告)号: | CN109146976B | 公开(公告)日: | 2020-06-02 |
发明(设计)人: | 李昊;万国伟;周尧;宋适宇;董芳芳 | 申请(专利权)人: | 百度在线网络技术(北京)有限公司 |
主分类号: | G06T7/77 | 分类号: | G06T7/77;G06K9/62 |
代理公司: | 北京英赛嘉华知识产权代理有限责任公司 11204 | 代理人: | 王达佐;马晓亚 |
地址: | 100085 北京市*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 用于 定位 无人 方法 装置 | ||
1.一种用于定位无人车的方法,包括:
将第一分辨率的当前点云投影图像与所述第一分辨率的地图匹配,基于匹配结果,生成第一直方图滤波器;
基于所述第一直方图滤波器中元素的概率值,在所述第一直方图滤波器中确定至少两个第一响应区,其中,第一响应区对应的元素的概率值大于所述第一直方图滤波器中其余元素的概率值;
将所述至少两个第一响应区映射到预先建立的第二直方图滤波器中,以在所述预先建立的直方图滤波器中确定出第二响应区;基于第二分辨率的当前点云投影图像与第二分辨率的地图的匹配结果以及所述第二响应区,生成第二直方图滤波器,其中,所述第一分辨率小于第二分辨率;
对所述第二直方图滤波器中目标元素的概率值进行加权平均,在所述第二分辨率地图中确定所述无人车的定位结果。
2.根据权利要求1所述的方法,其中,所述基于第二分辨率的当前点云投影图像与第二分辨率的地图的匹配结果以及所述第二响应区,生成第二直方图滤波器,包括:
基于所述第二分辨率的当前点云投影图像与所述第二分辨率的地图的匹配结果,确定所述预先建立的第二直方图滤波器中所述第二响应区对应的元素的概率值以生成所述第二直方图滤波器。
3.根据权利要求1所述的方法,其中,所述第一直方图滤波器包括第一反射值直方图滤波器和/或第一高度值直方图滤波器。
4.根据权利要求1所述的方法,其中,在将第一分辨率的当前点云投影图像与所述第一分辨率的地图匹配,基于匹配结果,生成第一直方图滤波器之前,所述方法还包括:
获取指定区域的点云数据,对所获取的数据进行栅格化处理得到所述第一分辨率的地图,其中,所述第一分辨率的地图包括投影在栅格中的点云的反射值的统计信息和/或高度值的统计信息;
获取当前帧点云数据,对所述当前帧点云数据进行栅格化处理得到所述第一分辨率的当前点云投影图像,其中,所述第一分辨率的当前点云投影图像包括投影在栅格中的点云的反射值的统计信息和/或高度值的统计信息。
5.根据权利要求4所述的方法,其中,所述将第一分辨率的当前点云投影图像与所述第一分辨率的地图匹配,基于匹配结果,生成第一直方图滤波器,包括:
基于所述第一分辨率的当前点云投影图像中的反射值的统计信息和所述第一分辨率的地图中的反射值的统计信息,将所述第一分辨率的当前点云投影图像与第一分辨率的地图匹配,基于匹配结果,生成第一反射值直方图滤波器;和/或
基于所述第一分辨率的当前点云投影图像中栅格的高度值的统计信息和所述第一分辨率的地图中栅格的高度值的统计信息,将所述第一分辨率的当前点云投影图像与第一分辨率的地图匹配,基于匹配结果,生成第一高度值直方图滤波器。
6.根据权利要求5所述的方法,其中,所述基于所述第一直方图滤波器中元素的概率值,在所述第一直方图滤波器中确定至少两个第一响应区,包括:
确定所述第一反射值直方图滤波器和所述第一高度值直方图滤波器对所述至少两个第一响应区的贡献比;
在所述第一反射值直方图滤波器和所述第一高度值直方图滤波器中按照所述贡献比分别确定与所述至少两个第一响应区对应的元素,以确定所述至少两个第一响应区。
7.根据权利要求2所述的方法,其中,所述基于所述第二分辨率的当前点云投影图像与所述第二分辨率的地图的匹配结果,确定所述预先建立的第二直方图滤波器中所述第二响应区对应的元素的概率值以生成所述第二直方图滤波器,包括:
获取与前一帧点云投影图像对应的第二直方图滤波器;
基于与前一帧点云投影图像对应的第二直方图滤波器中的元素的概率值,确定贝叶斯的先验概率;
基于所述第二分辨率的当前点云投影图像与所述第二分辨率的地图的匹配程度确定贝叶斯的条件概率,利用贝叶斯法则得到所述第二直方图滤波器中与所述第二响应区对应的元素的概率值;
将所述第二直方图滤波器中其余元素的概率值设为预设值。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于百度在线网络技术(北京)有限公司,未经百度在线网络技术(北京)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201810969118.3/1.html,转载请声明来源钻瓜专利网。