[发明专利]目标对象的定位方法、装置、设备及存储介质有效
申请号: | 202010402113.X | 申请日: | 2020-05-13 |
公开(公告)号: | CN111596298B | 公开(公告)日: | 2022-10-14 |
发明(设计)人: | 高航;万国伟;宋适宇 | 申请(专利权)人: | 北京百度网讯科技有限公司 |
主分类号: | G01S17/06 | 分类号: | G01S17/06;G01S7/48 |
代理公司: | 北京同立钧成知识产权代理有限公司 11205 | 代理人: | 张娜;臧建明 |
地址: | 100085 北京市*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 目标 对象 定位 方法 装置 设备 存储 介质 | ||
1.一种目标对象的定位方法,其特征在于,包括:
确定预测位姿和多个候选位姿,所述预测位姿与多个候选位姿中的每个候选位姿之间的距离小于预设值;
获取激光点云数据;
根据所述激光点云数据和占据栅格地图,确定在所述预测位姿处所述激光点云数据投影在所述占据栅格地图中的第一栅格位置,以及在所述多个候选位姿中的每个候选位姿处所述激光点云数据投影在所述占据栅格地图中的第二栅格位置,所述占据栅格地图用于标定当前环境对应的栅格位置存在物体的占有率;
根据所述第一栅格位置和所述第二栅格位置,确定所述目标对象的当前位姿。
2.根据权利要求1所述的方法,其特征在于,所述根据所述第一栅格位置和所述第二栅格位置,确定所述目标对象的当前位姿,包括:
根据所述第一栅格位置和所述第二栅格位置,确定所述目标对象在所述预测位姿的第一概率和所述目标对象在所述多个候选位姿中每个候选位姿的第二概率;
根据所述第一概率和所述第二概率,确定所述目标对象的当前位姿。
3.根据权利要求2所述的方法,其特征在于,所述根据所述第一栅格位置和所述第二栅格位置,确定所述目标对象在所述预测位姿的第一概率和所述目标对象在所述多个候选位姿中每个候选位姿的第二概率,包括:
根据所述第一栅格位置的占有率确定所述目标对象在所述预测位姿的第一概率;
根据所述第二栅格位置的占有率确定所述多个候选位姿中每个候选位姿的第二概率。
4.根据权利要求2所述的方法,其特征在于,所述根据所述第一概率和所述第二概率,确定所述目标对象的当前位姿,包括:
确定所述目标对象在所述预测位姿的第一历史概率和所述目标对象在所述多个候选位姿中每个候选位姿的第二历史概率;
根据所述第一概率和所述第一历史概率,确定所述目标对象在所述预测位姿的第一目标概率;
根据所述第二概率和所述第二历史概率,确定所述目标对象在所述每个候选位姿的第二目标概率;
根据所述第一目标概率和所述第二目标概率,确定所述目标对象的当前位姿。
5.根据权利要求4所述的方法,其特征在于,所述根据所述第一目标概率和所述第二目标概率,确定所述目标对象的当前位姿,包括:
根据所述第一目标概率和所述第二目标概率对所述预测位姿和所述多个候选位姿进行加权平均处理,得到所述目标对象的当前位姿。
6.根据权利要求1-5任一项所述的方法,其特征在于,所述确定在所述预测位姿处所述激光点云数据投影在所述占据栅格地图中的第一栅格位置,包括:
将所述激光点云数据的坐标转换为在所述预测位姿下对应的世界坐标系下的第一坐标;
将所述第一坐标投影在所述占据栅格地图中,得到所述第一栅格位置。
7.根据权利要求1-5任一项所述的方法,其特征在于,所述确定在所述多个候选位姿中的每个候选位姿处所述激光点云数据投影在所述占据栅格地图中的第二栅格位置,包括:
将所述激光点云数据的坐标转换为在每个候选位姿下对应的世界坐标系下的第二坐标;
将所述第二坐标投影在所述占据栅格地图中,得到所述第二栅格位置。
8.根据权利要求1-5任一项所述的方法,其特征在于,所述方法还包括:
根据预先采集到的点云数据,生成所述占据栅格地图。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京百度网讯科技有限公司,未经北京百度网讯科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010402113.X/1.html,转载请声明来源钻瓜专利网。