激光观测信号退化丢失下的全局定位方法、系统和装置与流程

摘要: 本发明涉及移动定位与导航,尤其涉及一种激光观测信号退化丢失下的全局定位方法、系统和装置。背景技术:1、移动机器人在仓储、工厂、商超等室内外场景中广泛应用,其自主...
激光观测信号退化丢失下的全局定位方法、系统和装置与流程

本发明涉及移动定位与导航,尤其涉及一种激光观测信号退化丢失下的全局定位方法、系统和装置。

背景技术:

1、移动机器人在仓储、工厂、商超等室内外场景中广泛应用,其自主移动能力通常依赖稳定、连续的定位与导航系统。现有机器人定位架构多采用相对定位、绝对定位和融合定位相结合的方式:相对定位层基于激光雷达与惯性测量单元输出高频相对位姿,绝对定位层基于当前激光点云与先验点云地图进行匹配以获得全局位姿,融合层则对相对运动约束和全局观测结果进行统一处理,从而输出平滑的全局定位结果。

2、相关技术中,常见方案通过激光惯性里程计进行相对运动估计,并采用点云配准方法实现地图匹配定位;当匹配质量下降时,通常通过提高匹配分数阈值、丢弃部分异常帧、连续失败后触发重定位或提示人工介入等方式进行处理。该类方案在常规无遮挡环境下能够实现较好的定位连续性,但在激光雷达被人体、货物或临时覆盖物短暂遮挡的情况下,传感观测质量会快速下降,相对定位结果、局部地图更新结果以及地图匹配初值之间容易相互影响,导致遮挡解除后的位姿收敛过程变慢,甚至出现长时间定位异常。对于带自动重定位的方案,通常以粗匹配和精匹配的最终结果作为重定位判定依据,在遮挡恢复、点云质量波动或初值偏差较大的情况下,可用匹配结果容易因单次精调评价不理想而被舍弃,影响自动恢复的稳定性。

3、因此,如何在激光观测短时退化或丢失后保持机器人定位系统的连续性、稳定性和自动恢复能力,是移动机器人定位导航领域需要重点解决的问题。尤其是在无人化连续作业场景中,定位系统不仅需要在正常观测条件下保持高精度,还需要在遮挡解除后尽快恢复可靠全局定位,以降低人工重定位频率并提高机器人系统可用性。

4、本部分旨在为权利要求书中陈述的本技术实施例提供背景或上下文。此处的描述不因为包括在本部分中就承认是现有技术。

技术实现思路

1、本发明的一个目的在于提供一种激光观测信号退化丢失下的全局定位方法,能够在激光观测退化或短时丢失后,提高全局定位恢复的稳定性和成功率,减少遮挡解除后的位姿跳变、收敛迟滞和长时间定位异常;还能够降低异常点云、异常相对运动估计对后续定位结果的影响,提高局部地图质量、地图匹配初值可靠性以及自动重定位的可用性,从而提升机器人连续作业能力。本发明的另一个目的在于提供一种激光观测信号退化丢失下的全局定位装置。本发明的另一个目的在于提供一种激光观测信号退化丢失下的全局定位系统。本发明的还一个目的在于提供一种激光观测信号退化丢失下的全局定位装置。本发明的再一个目的在于提供一种计算机可读介质。本发明的还一个目的在于提供一种计算机设备。

2、为了达到以上目的,本发明一方面公开了一种激光观测信号退化丢失下的全局定位方法,包括:

3、若获取的激光观测信号处于可用状态并且存在退化丢失标记,根据缓存的滤波器参考状态,对滤波器进行锚定复位;

4、通过正态分布变换,根据激光观测信号和航位信号进行全局地图匹配,生成全局位姿修正值和匹配分数;

5、若匹配分数大于预设的分数阈值,对全局位姿修正值和获取的里程计位姿进行平滑处理,生成全局定位结果。

6、优选的,方法还包括:

7、对获取的激光观测信号进行全局地图匹配,生成可靠性评价指标;

8、根据可靠性评价指标,生成可靠性指示,可靠性指示包括可用状态或不可用状态。

9、优选的,方法还包括:

10、若可靠性指示为不可用状态,对激光观测信号和对应的滤波器当前状态进行退化隔离,退化隔离包括停止基于滤波器当前状态的全局位姿预测、停止基于激光观测信号的局部环境更新以及将滤波器当前状态标记为不可信。

11、优选的,方法还包括:

12、若处于不可用状态的激光观测信号的累计连续帧数或累计连续时长是否满足预设的退化丢失条件,生成并存储退化丢失标记,并继续执行对获取的激光观测信号进行全局地图匹配,生成可靠性评价指标的步骤。

13、优选的,在对滤波器进行锚定复位之后,还包括:

14、清除退化丢失标记。

15、优选的,方法还包括:

16、若连续多帧激光观测信号均恢复为可用状态,启动激光观测信号的局部环境更新。

17、优选的,通过正态分布变换,根据激光观测信号和航位信号进行全局地图匹配,生成全局位姿修正值和匹配分数,包括:

18、根据激光观测信号和航位信号进行多级位姿推算,生成全局位姿初值;

19、通过正态分布变换,对全局位姿初值和预先采集的全局地图进行匹配修正,生成全局位姿修正值和匹配分数。

20、优选的,根据激光观测信号和航位信号进行多级位姿推算,生成全局位姿初值,包括:

21、对获取的激光观测信号进行全局地图匹配,生成有效匹配特征;

22、判断连续多个有效匹配特征的数量是否均大于或等于预设的特征数阈值;

23、若是,根据相邻两帧的滤波器状态,生成相对运动增量,并根据前一帧的滤波器状态和相对运动增量进行位姿计算,生成全局位姿初值;

24、若否,若航位信号可用,判断相邻两帧的航位信号之间的航位增量是否小于或等于预设的航位阈值;

25、若是,根据前一帧的航位信号和航位增量进行位姿计算,生成全局位姿初值;

26、若航位信号不可用或航位增量大于航位阈值,将存储的最近时间戳的全局位姿结果确定为全局位姿初值。

27、优选的,对全局位姿修正值和获取的里程计位姿进行平滑处理,生成全局定位结果,包括:

28、按照预设的权重组合,对全局位姿修正值和获取的里程计位姿进行加权计算,生成全局定位结果。

29、优选的,方法还包括:

30、若匹配分数小于或等于分数阈值,基于时空对齐的激光观测信号和全局地图,根据存储的最近时间戳的全局位姿结果进行重定位,生成全局定位结果。

31、本发明还公开了一种激光观测信号退化丢失下的全局定位系统,包括:

32、传感数据层,用于获取激光观测信号、滤波器参考状态、航位信号和全局地图;

33、相对运动估计层,用于若获取的激光观测信号处于可用状态并且存在退化丢失标记,根据缓存的滤波器参考状态,对滤波器进行锚定复位;通过正态分布变换,根据激光观测信号和航位信号进行全局地图匹配,生成全局位姿修正值和匹配分数;

34、全局定位层,用于若匹配分数大于预设的分数阈值,对全局位姿修正值和获取的里程计位姿进行平滑处理,生成全局定位结果。

35、本发明还公开了一种激光观测信号退化丢失下的全局定位装置,包括:

36、锚定复位单元,用于若获取的激光观测信号处于可用状态并且存在退化丢失标记,根据缓存的滤波器参考状态,对滤波器进行锚定复位;

37、全局匹配单元,用于通过正态分布变换,根据激光观测信号和航位信号进行全局地图匹配,生成全局位姿修正值和匹配分数;

38、平滑处理单元,用于若匹配分数大于预设的分数阈值,对全局位姿修正值和获取的里程计位姿进行平滑处理,生成全局定位结果。

39、本发明还公开了一种计算机可读介质,其上存储有计算机程序,该程序被处理器执行时实现如上所述方法。

40、本发明还公开了一种计算机设备,包括存储器和处理器,所述存储器用于存储包括程序指令的信息,所述处理器用于控制程序指令的执行,所述处理器执行所述程序时实现如上所述方法。

41、本发明还公开了一种计算机程序产品,包括计算机程序/指令,计算机程序/指令被处理器执行时实现如上所述方法。

42、本发明若获取的激光观测信号处于可用状态并且存在退化丢失标记,根据缓存的滤波器参考状态,对滤波器进行锚定复位;通过正态分布变换,根据激光观测信号和航位信号进行全局地图匹配,生成全局位姿修正值和匹配分数;若匹配分数大于预设的分数阈值,对全局位姿修正值和获取的里程计位姿进行平滑处理,生成全局定位结果,能够在激光观测退化或短时丢失后,提高全局定位恢复的稳定性和成功率,减少遮挡解除后的位姿跳变、收敛迟滞和长时间定位异常;还能够降低异常点云、异常相对运动估计对后续定位结果的影响,提高局部地图质量、地图匹配初值可靠性以及自动重定位的可用性,从而提升机器人连续作业能力。