[发明专利]一种定位失效检测方法、装置、存储介质及电子设备有效
申请号: | 202011335423.0 | 申请日: | 2020-11-24 |
公开(公告)号: | CN112344966B | 公开(公告)日: | 2023-06-16 |
发明(设计)人: | 陈海波;高宏飞 | 申请(专利权)人: | 深兰科技(上海)有限公司 |
主分类号: | G01C25/00 | 分类号: | G01C25/00;G06F16/29 |
代理公司: | 北京同达信恒知识产权代理有限公司 11291 | 代理人: | 王宁宁 |
地址: | 200336 上海市长宁区威*** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 定位 失效 检测 方法 装置 存储 介质 电子设备 | ||
1.一种定位失效检测方法,其特征在于,包括:
获取移动机器人的激光雷达扫描数据,并提取所述激光雷达扫描数据的地图二维直线特征;
根据所述地图二维直线特征,确定所述地图二维直线特征的特征定位性能预测指标;
根据所述特征定位性能预测指标和获取的机器人位姿粒子集的粒子权重,确定融合特征定位性能预测指标的融合粒子集权重;所述机器人位姿粒子集包含在所述移动机器人定位时用于确定所述移动机器人的位姿的粒子;所述粒子权重是所述机器人位姿粒子集中各个粒子的粒子权重;
若所述融合粒子集权重小于或等于设定阈值,确定所述移动机器人定位失效;
所述提取所述激光雷达扫描数据中的地图二维直线特征,包括:
根据获取的移动机器人的激光雷达扫描数据,确定断点检测算子;
确定所述激光雷达扫描数据的各个相邻的两个测量点之间的距离;
根据所述各个相邻的两个测量点之间的距离和所述断点检测算子,将所述激光雷达扫描数据中的测量点划分为至少一个数据点集;
分别对得到的各个数据点集进行直线拟合,得到各个数据点集对应的直线段;
根据各个数据点集对应的直线段,生成所述激光雷达扫描数据的地图二维直线特征;所述地图二维直线特征是所述直线段构成的集合;
所述根据所述地图二维直线特征,确定所述地图二维直线特征的特征定位性能预测指标,包括:
对于每个数据点集,执行如下步骤:分别根据所述数据点集中每个测量点的坐标数据,确定每个测量点的标量协方差;根据所述每个测量点的标量协方差,确定所述数据点集对应的地图二维直线特征的直线段位置的特征协方差矩阵;
根据所述特征协方差矩阵以及地图二维直线特征的各个直线段的特征,得到所述特征定位性能预测指标。
2.根据权利要求1所述的方法,其特征在于,所述根据所述各个相邻的两个测量点之间的距离和所述断点检测算子,将所述激光雷达扫描数据中的测量点划分为至少一个数据点集,包括:
若相邻的两个测量点之间的距离大于所述断点检测算子,则将该两个测量点划分至不同的数据点集;
若相邻的两个测量点之间的距离小于或等于所述断点检测算子,则将该两个测量点划分至同一个数据点集。
3.根据权利要求1所述的方法,其特征在于,所述根据所述特征定位性能预测指标和获取的机器人位姿粒子集的粒子权重,确定融合特征定位性能预测指标的融合粒子集权重,包括:
根据获取的机器人位姿粒子集的粒子权重,确定所述机器人位姿粒子集中的全部粒子的粒子权重的平均值,作为基本粒子集权重;
根据所述基本粒子集权重和所述特征定位性能预测指标,确定融合特征定位性能预测指标的融合粒子集权重。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深兰科技(上海)有限公司,未经深兰科技(上海)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011335423.0/1.html,转载请声明来源钻瓜专利网。