一种基于无人扫地车的传感器融合定位检测校准方法与流程

摘要: 本发明涉及多传感器融合,特别涉及一种基于无人扫地车的传感器融合定位检测校准方法。背景技术:1、现有无人扫地车的定位方法仍存在不足:一方面,无人扫地车在雨天、高架...
一种基于无人扫地车的传感器融合定位检测校准方法与流程

本发明涉及多传感器融合,特别涉及一种基于无人扫地车的传感器融合定位检测校准方法。

背景技术:

1、现有无人扫地车的定位方法仍存在不足:一方面,无人扫地车在雨天、高架桥下、建筑物密集区域等复杂环境中行驶时,激光雷达易受到雨滴附着影响,毫米波雷达易受到桥体、桥墩等环境目标产生的多路径反射干扰,gnss定位信号也容易受到环境遮挡,导致不同传感器的定位数据出现不同程度的偏差;另一方面,现有定位方法通常采用固定的传感器融合策略,难以结合激光雷达的雨滴异常回波、毫米波雷达的多路径反射以及gnss卫星信号遮挡等具体干扰状态,对各传感器的定位可靠性进行针对性分析和动态调整。此外,现有方法对不同传感器干扰因素之间的综合影响分析不足,难以根据实际环境变化及时校准无人扫地车的定位结果,进而影响无人扫地车在复杂道路环境下的定位稳定性和行驶安全性。

技术实现思路

1、基于此,本发明有必要提供一种基于无人扫地车的传感器融合定位检测校准方法,以解决至少一个上述技术问题。

2、为实现上述目的,一种基于无人扫地车的传感器融合定位检测校准方法,包括以下步骤:

3、步骤s1:控制无人扫地车按照预设检测路线行驶,记录定位结果;在行驶过程中同步采集激光雷达数据、毫米波雷达数据以及gnss定位数据;

4、步骤s2:针对激光雷达数据识别环境目标,并接收环境目标反射的激光信号;根据激光信号检测雨滴异常回波点;利用毫米波雷达数据计算多路径反射干扰强度;

5、步骤s3:根据gnss定位数据识别卫星信号接收状态;利用卫星信号接收状态检测卫星信号异常方向;沿卫星信号异常方向识别环境遮挡目标,并利用环境遮挡目标计算卫星信号遮挡率;

6、步骤s4:利用雨滴异常回波点、多路径反射干扰强度和卫星信号遮挡率计算传感器综合干扰度;根据传感器综合干扰度校准定位结果。

7、本发明的有益效果为:

8、1.通过同步采集无人扫地车行驶过程中的激光雷达数据、毫米波雷达数据以及gnss定位数据,并分别检测雨滴异常回波点、多路径反射干扰强度和卫星信号遮挡率,解决现有定位方法难以针对不同传感器在复杂道路环境下受到的差异化干扰进行分析的问题,提高无人扫地车对雨天、高架桥下及复杂道路环境的传感器干扰识别能力。

9、2.通过根据雨滴在激光雷达表面的重复撞击次数和撞击重复周期分析雨滴水膜的补液速度、累积状态及扩展范围,并结合激光信号遮挡强度识别雨滴异常回波点,解决现有激光雷达在雨天环境下容易因雨滴附着产生异常回波、影响环境感知和定位精度的问题,提高对雨滴附着干扰的检测准确性和激光雷达定位数据的可靠性。

10、3.通过对毫米波雷达回波的传播路径进行分析,计算不同雷达回波之间的回波路径差,并识别延迟反射形成的多路径反射回波,根据反射回波强度和多路径回波叠加程度计算多路径反射干扰强度,解决高架桥桥体、桥墩及道路附属设施等环境目标容易产生多路径反射、导致毫米波雷达测距和定位结果发生偏差的问题,提高复杂道路环境下毫米波雷达数据的抗干扰能力。

1.一种基于无人扫地车的传感器融合定位检测校准方法,其特征在于,包括以下步骤:

2.根据权利要求1所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,步骤s2中针对激光雷达数据识别环境目标,并接收环境目标反射的激光信号包括:

3.根据权利要求1所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,步骤s2中根据激光信号检测雨滴异常回波点包括:

4.根据权利要求3所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,根据雨滴聚集状态计算雨滴附着度包括:

5.根据权利要求4所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,根据雨滴撞击重复周期和重复撞击次数计算雨滴水膜在激光雷达表面的雨滴附着度包括:

6.根据权利要求5所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,根据雨滴累积量划分水膜扩展范围包括:

7.根据权利要求3所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,在雨滴聚集区域利用雨滴附着度计算激光信号遮挡强度包括:

8.根据权利要求3所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,根据激光信号遮挡强度确定雨滴异常回波点包括:

9.根据权利要求1所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,步骤s2中利用毫米波雷达数据计算多路径反射干扰强度包括:

10.根据权利要求1所述的基于无人扫地车的传感器融合定位检测校准方法,其特征在于,步骤s4中根据传感器综合干扰度校准定位结果包括: