一种3D点云地图全局定位方法

基本信息

申请号 CN201711136207.1 申请日 -
公开(公告)号 CN109801313A 公开(公告)日 2019-05-24
申请公布号 CN109801313A 申请公布日 2019-05-24
分类号 G06T7/30;G06T5/10;G06T7/13 分类 计算;推算;计数;
发明人 不公告发明人 申请(专利权)人 上海宝宏软件有限公司
代理机构 - 代理人 -
地址 201203 上海市浦东新区盛夏路570号3楼
法律状态 -

摘要

摘要 本发明公开了一种3D点云地图全局定位方法,包括以下步骤:首先,制作原始3D点云图每个(X,Y)坐标对应的局部描述子(包涵物体边缘信息);其次,生成当前位置和方向上的局部描述子并计算当前位置和方向上的局部描述子与原始3D点云图每个(X,Y)坐标对应的局部描述子(包涵物体边缘信息)中各个描述子的加权误差;再次,对上述误差进行排序,取误差较小的前M个点的集合PN与上一次的点集PN‑1,根据其他传感器获得的运动数据筛选比较。最后,重复上述过程直到Pn‑1与PN误差小于预设值。本发明实现了在3D点云地图中准确定位,且完全满足实时性的要求,具备非常高的实用价值。