用于长走廊环境的地图更新方法、装置、设备和存储介质与流程

文档序号:31126166发布日期:2022-08-13 03:31阅读:138来源:国知局
用于长走廊环境的地图更新方法、装置、设备和存储介质与流程

1.本技术涉及激光建图技术领域,特别涉及一种用于长走廊环境的地图更新方法、装置、设备和存储介质。


背景技术:

2.现有机器人在长走廊环境中进行建图时,由于长走廊环境的特征较少,除机器人两侧墙体外几乎没有障碍物,而激光雷达的测距范围有限,这就导致机器人在长走廊环境中建图时,地图会出现大片未知环境场景,从而影响用户体验以及建图的稳定性、鲁棒性。


技术实现要素:

3.本技术的主要目的为提供一种用于长走廊环境的地图更新方法、装置、设备和存储介质,旨在解决现有机器人处于长走廊环境进行建图时稳定性和鲁棒性较差的弊端。
4.为实现上述目的,本技术提供了一种用于长走廊环境的地图更新方法,包括:
5.采集激光雷达数据;
6.从所述激光雷达数据中筛选出若干个最大测距值;
7.以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值;
8.以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势,其中,所述参照测距值对应的y轴半轴与所述目标测距值对应的最大测距轴之间具有最小夹角;
9.若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则将所述无穷测距值设置为所述目标测距值,并更新当前场景的概率栅格地图。
10.本技术还提供了一种用于长走廊环境的地图更新装置,包括:
11.采集模块,用于采集激光雷达数据;
12.第一筛选模块,用于从所述激光雷达数据中筛选出若干个最大测距值;
13.第二筛选模块,用于以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值;
14.判断模块,用于以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势,其中,所述参照测距值对应的y轴半轴与所述目标测距值对应的最大测距轴之间具有最小夹角;
15.更新模块,用于若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则将所述无穷测距值设置为所述目标测距值,并更新当前场景的概率栅格地图。
16.本技术还提供一种计算机设备,包括存储器和处理器,所述存储器中存储有计算
机程序,所述处理器执行所述计算机程序时实现上述任一项所述方法的步骤。
17.本技术还提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现上述任一项所述的方法的步骤。
18.本技术中提供的一种用于长走廊环境的地图更新方法、装置、设备和存储介质,机器人采集激光雷达数据,然后从激光雷达数据中筛选出若干个最大测距值。机器人以相邻两个最大测距值为一组,从各组最大测距值中筛选出包含有无穷测距值的若干组目标测距值,无穷测距值位于同组的两个目标测距值之间,且无穷测距值的数量大于数量阈值。以机器人的中心为坐标轴原点,行进方向为x轴,垂直于行进方向为y轴,分别判断同组的两个目标测距值与参照测距值之间的测距值是否呈递减趋势,其中,参照测距值对应的y轴半轴与目标测距值对应的最大测距轴之间具有最小夹角。若同组的两个目标测距值与参照测距值之间的测距值呈递减趋势,则将无穷测距值设置为目标测距值,并更新当前场景的概率栅格地图。本技术中,机器人根据同组的两个目标测距值与参照测距值之间的测距值是否呈递减趋势识别当前场景是否为长走廊环境,并在判定当前场景为长走廊环境后,将激光雷达探测不到的区域以目标测距值进行建图,从而实现地图更新,地图上不会出现未知环境场景,有利于提高用户体验,以及建图的稳定性和鲁棒性。
附图说明
19.图1是本技术一实施例中用于长走廊环境的地图更新方法的步骤示意图;
20.图2是本技术一实施例中扫地机与长走廊环境之间的坐标示意图;
21.图3是本技术一实施例中用于长走廊环境的地图更新装置的整体结构框图;
22.图4是本技术一实施例的计算机设备的结构示意框图。
23.本技术目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
24.为了使本技术的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本技术进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本技术,并不用于限定本技术。
25.参照图1,本技术一实施例中提供了一种用于长走廊环境的地图更新方法,包括:
26.s1:采集激光雷达数据;
27.本实施例中,机器人上部署有激光雷达,在机器人行进建图过程中,使用激光雷达逆时针(或顺时针,根据实际需要进行设置)扫描当前场景的环境一周,在激光遇到当前环境中的障碍物时即会返回激光雷达中心到(表征机器人)与障碍物之间的距离值(即测距值),从而得到机器人一周内(即360度)内的障碍物与激光雷达中心之间的距离,这些距离值组成激光雷达扫描一周的激光雷达数据。
28.s2:从所述激光雷达数据中筛选出若干个最大测距值;
29.本实施例中,机器人的建图系统将激光雷达数据所包含的各个测距值进行一一比对,从而筛选出激光雷达数据所包含的所有最大测距值。
30.s3:以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值;
31.参照图2,本实施例中,建图系统将筛选所带的的各个最大测距值按照激光雷达的扫描方向,以及各个最大测距值各自对应的测距角度,以相邻两个最大测距值为一组(比如按照逆时针方向,激光雷达依次采集的最大测距值分别为a、b、c、d(如图2中的r
max1
、r
max2
、r
max3
、r
max4
),则将最大测距值a和最大测距值b为一组,最大测距值b和最大测距值c为一组,最大测距值c和最大测距值d为一组,最大测距值d和最大测距值a为一组,以此类推)。然后,建图系统分别检测并统计同组的两个最大测距值所对应的测距角度之间(比如最大测距值a为0度,最大测距值b为45度,即需要检测0度到45度之间测距值)所包含的无穷测距值的数量,其中,无穷测距值表征激光雷达在扫描周边环境时没有遇到障碍物,因此该测距值为无穷大(实际远处是有障碍物的,只是受限于激光雷达本身的性能没有探测到该远处的障碍物,视为没有探测到)。如果该组两个最大测距值之间所包含的无穷测距值的数量大于数量阈值,则将该组的两个最大测距值选定为目标测距值;据此,建图系统筛选出若干组目标测距值。
32.s4:以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势,其中,所述参照测距值对应的y轴半轴与所述目标测距值对应的最大测距轴之间具有最小夹角;
33.参照图2,本实施例中,建图系统定义机器人的中心为坐标轴原点,行进方向为x轴,垂直于行进方向(即垂直于x轴)的方向为y轴,其中,位于机器人前方的半轴为x轴正半轴,位于机器人左方的半轴为y轴正半轴。建图系统分别对各组目标测距值与各自对应的参照测距值之间的测距值的变化趋势进行识别,参照测距值对应的y轴半轴与目标测距值对应的最大测距轴之间具有最小夹角;以其中一组的两个目标测距值为例,假定目标测距值a位于x轴正半轴的左方,目标测距值d位于x轴正半轴的右方,则与目标测距值a所在的最大测距轴a具有最小夹角的y轴半轴为y轴正半轴,位于y轴正半轴的参照测距值与目标测距值a对应;与目标测距值d所在的最大测距轴d具有最小夹角的y轴半轴为y轴负半轴,位于y轴负半轴的参照测距值与目标测距值d对应。建图系统判断从目标测距值a到y轴正半轴之间各个测距值依序是否呈递减趋势,以及判断从目标测距值d到y轴负半轴之间各个测距值依序是否呈递减趋势。如果从目标测距值a到y轴正半轴的参照测距值之间各个测距值依序呈递减趋势,以及从目标测距值d到y轴负半轴的参照测距值之间各个测距值依序呈递减趋势,则说明机器人当前处于长走廊环境,即当前场景为长走廊。
34.s5:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则将所述无穷测距值设置为所述目标测距值,并更新当前场景的概率栅格地图。
35.本实施例中,建图系统识别到机器人当前处于长走廊环境时(即同组的两个目标测距值与各自对应的参照测距值之间的测距值呈递减趋势),则将同组的两个目标测距值之间的无穷测距值设置为目标测距值,以规避无穷测距值对建图的影响(即将各个不具有实际数值的无穷测距值用具有实际数值的目标测距值替代,使得各个无穷测距值具有实际意义),使得建图系统可以根据各个目标测距值使用光线追踪策略来更新当前场景的概率栅格地图,避免无穷测距值带来的建图过程中的未知环境场景,不仅有利于提高用户体验,同时还可以提高机器人建图的稳定性和鲁棒性。
36.进一步的,所述激光雷达数据包括多个测距值,单个测距值对应单个测距角度;
37.以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值的步骤中,单组所述目标测距值的筛选步骤为:
38.s301:沿逆时针方向选择相邻两个所述最大测距值为一组,并分别获取同组的两个所述最大测距值各自对应的第一测距角度和第二测距角度;
39.本实施例中,激光雷达数据所包含的各个测距值分别对应有测距角度,以单组目标测距值的筛选步骤为例(其余组的目标测距值的筛选逻辑相同),建图系统沿逆时针方向(也可以沿顺时针,与激光雷达的扫描方向相同)选择相邻两个最大测距值为一组,然后分别获取同组的两个最大测距值各自对应的第一测距角度和第二测距角度,其中,第一测距角度和第二测距角度为两个最大测距值各自对应的测距轴与x轴之间的夹角。优选的,建图系统定义位于x轴左方(即机器人左方)的测距角度为正值,位于x轴右方的测距角度为负值。
40.s302:沿逆时针方向,从所述激光雷达数据中筛选出包含于所述第一测距角度和所述第二测距角度之间的各个第一测距值;
41.本实施例中,建图系统沿逆时针方向,按照激光雷达扫描时各个测距值各自对应的测距角度,从而中筛选出位于第一测距角度和第二测距角度之间的各个测距值作为第一测距值,其中,第一测距角度和第二测距角度之间的夹角小于180度。
42.s303:统计各所述第一测距值中所包含的所述无穷测距值的数量,并判断所述无穷测距值的数量是否大于数量阈值;
43.本实施例中,建图系统从各个第一测距值中筛选出所有的无穷测距值,并统计所有无穷测距值的数量。然后调取预先设定的数量阈值,将所有无穷测距值的数量与数量阈值进行比对,判断两者之间的大小关系。
44.s304:若所述无穷测距值的数量大于所述数量阈值,则选择同组的两个所述最大测距值作为单组所述目标测距值。
45.本实施例中,如果单组的两个最大测距值所包含的无穷测距值的数量大于数量阈值,建图系统则选择该组的两个最大测距值作为单组目标测距值,以便后续进行相应的识别处理。
46.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤,包括:
47.s401:以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,将同组所述目标测距值的其中一个所述目标测距值与所述x轴之间的夹角定义为第三测距角度,另一个所述目标测距值与所述x轴之间的夹角定义为第四测距角度,其中,所述第三测距角度和所述第四测距角度均不大于90度;
48.本实施例中,建图系统以机器人的中心为坐标轴原点,行进方向为x轴,垂直于行进方向的方向为y轴;具体地,机器人的行进前端为x轴正半轴,机器人的行进后端(即机器人后退方向对应的一端)为x轴负半轴;定义机器人的左端为y轴正半轴,右端为y轴负半轴。建图系统将同组的两个目标测距值的其中一个目标测距值与x轴之间的夹角定义为第三测距角度,另一个目标测距值与x轴之间的夹角定义为第四测距角度,并且,第三测距角度与第四测距角度均不大于90度,即目标测距值对应的测距轴与x轴之间的夹角,是指测距轴与
最近的x轴半轴之间的夹角。比如目标测距值a和目标测距值b分别位于机器人的前端左右两侧,即第三测距角度和第四测距角度是指目标测距值a和目标测距值b各自对应的测距轴与x轴正半轴之间的夹角。
49.s402:分别判断所述第三测距角度对应的第一测距轴到所述y轴的第一半轴之间的各个所述测距值是否呈递减趋势,以及判断所述第四测距角度对应的第二测距轴到所述y轴的第二半轴之间的各个所述测距值是否呈递减趋势,其中,所述第一半轴与所述第一测距轴之间的夹角最小,所述第二半轴与所述第二测距轴之间的夹角最小;
50.本实施例中,建图系统判断第三测距角度对应的第一测距轴到y轴上最近的第一半轴(即y轴与第一测距轴之间的夹角最小的半轴)之间的各个测距值依序是否呈递减趋势(比如第一测距轴位于机器人的左方,则y轴上最近的第一半轴为y轴正半轴),并判断第四测距角度对应的第二测距轴到y轴上最近的第二半轴(即y轴与第二测距轴之间的夹角最小的半轴)之间的各个测距值依序是否呈递减趋势。
51.s403:若所述第三测距角度对应的第一测距轴到所述第一半轴之间的各个所述测距值呈递减趋势,且所述第四测距角度对应的第二测距轴到所述第二半轴之间的各个所述测距值呈递减趋势,则判定同组的两个所述目标测距值与最近的所述y轴之间的测距值呈递减趋势;
52.本实施例中,如果第三测距角度对应的第一测距轴到y轴上最近的第一半轴之间的各个测距值依序呈递减趋势,并且第四测距角度对应的第二测距轴到y轴上最近的第二半轴之间的各个测距值依序呈递减趋势,则建图系统判定同组的两个目标测距值与最近的y轴之间的测距值依序呈递减趋势,配合同组的两个目标测距值之间包含多个无穷测距值,说明机器人当前处于长走廊环境中。
53.s404:若所述第三测距角度对应的第一测距轴到所述第一半轴之间的各个所述测距值不是呈递减趋势,和/或所述第四测距角度对应的第二测距轴到所述第二半轴之间的各个所述测距值不是呈递减趋势,则判定同组的两个所述目标测距值与最近的所述y轴之间的测距值不是呈递减趋势。
54.本实施例中,如果第三测距角度对应的第一测距轴到y轴上最近的第一半轴之间的各个测距值依序不是呈递减趋势,和/或第四测距角度对应的第二测距轴到y轴上最近的第二半轴之间的各个测距值依序不是呈递减趋势,则建图系统判定同组的两个目标测距值与最近的y轴之间的测距值不是呈递减趋势,说明机器人当前所处的场景环境不属于长走廊环境。
55.进一步的,所述机器人上部署有激光雷达,所述采集激光雷达数据的步骤,包括:
56.s101:控制所述激光雷达按照逆时针方向扫描所述当前场景,得到若干个与单位扫描角度对应的测距值,所述测距值的数量与所述单位扫描角度的数量一致;
57.本实施例中,机器人上部署有激光雷达,机器人在行进过程中,建图系统控制激光雷达按照逆时针方向扫描当前场景,根据激光遇到障碍物后反射回来的数据得到激光雷达中心(表征机器人)与各个障碍物之间的距离,并按照预设的单位扫描角度得到与各个单位扫描角度对应的各个测距值(比如设定激光雷达扫描一周为360度,单位扫描角度为1度,则每1度对应有1个测距值);因此,激光雷达扫描一周获得的测距值的数量与单位扫描角度的数量对应一致。
58.s102:汇总各所述测距值,生成所述激光雷达数据。
59.本实施例中,建图系统汇总各个测距值,生成单帧激光(激光雷达扫描一周)对应的激光雷达数据。
60.进一步的,所述汇总各所述测距值,生成所述激光雷达数据的步骤,包括:
61.s1021:以所述机器人的行进方向为0度,所述机器人的后退方向为-0度建立角度系,并根据所述单位扫描角度,得到各所述测距值分别对应的测距角度;
62.本实施例中,建图系统以机器人的行进方向为0度、机器人的后退方向为-0度建立角度系,并根据预先设定的单位扫描角度,按照激光雷达的扫描方向依次得到各个测距值分别对应的测距值。比如激光雷达的扫描方向为逆时针,则与x轴正半轴重叠的测距值a对应的测距角度为0度,依次下一个单位扫描角度的测距值b对应的测距值角度则为1度,再下一个单位扫描角度的测距值c对应的测距角度则为2度,依次类推,从而得到各个测距值分贝对应的测距角度。
63.s1022:将各所述测距值与各自对应的测距角度建立映射关系,依序汇总得到所述激光雷达数据。
64.本实施例中,建图系统将上述所获得的的各个测距角度与对应的测距值建立映射关系(比如测距值a对应测距角度0度,测距值b对应测距角度1度,依次类推),按照激光雷达的扫描方向依序汇总得到激光雷达数据。
65.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤之后,包括:
66.s6:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则获取当前位置坐标,并根据所述最大测距值和所述当前位置坐标划定走廊区域;
67.本实施例中,如果同组的两个目标测距值与各自对应的参照测距值之间的测距值呈递减趋势,则说明机器人当前处于长廊环境中,建图系统通过机器人上部署的gps定位功能采集得到机器人的当前位置坐标。然后以当前位置坐标为中心,以最大测距值为边界在更新后的概率栅格地图划定出走廊区域。
68.s7:将所述走廊区域标记为长走廊环境。
69.本实施例中,建图系统将地图上的走廊区域标记为长走廊环境,以便用户在看到地图时可以及时、充分了解机器人所处场景的类型。
70.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤之后,还包括:
71.s8:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值不是呈递减趋势,则不更新测距夹角范围内的区域对应的概率栅格地图,其中,所述测距夹角为同组的两个所述目标测距值分别对应的两个所述最大测距轴之间的夹角,所述测距夹角不大于180度。
72.本实施例中,如果同组的两个目标测距值与各自对应的参照测距值之间的测距值不是呈递减趋势,则说明机器人当前不是处于长走廊环境,因此不会更新该组的两个目标
测距值分别对应的两个最大测距轴之间的夹角(即测距夹角)范围内的区域所对应的概率栅格地图。其中,测距角度不大于180度,即测距角度对应的区域为包含有无穷测距值的区域。
73.参照图3,本技术一实施例中还提供了一种用于长走廊环境的地图更新装置,包括:
74.采集模块1,用于采集激光雷达数据;
75.第一筛选模块2,用于从所述激光雷达数据中筛选出若干个最大测距值;
76.第二筛选模块3,用于以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值;
77.判断模块4,用于以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势,其中,所述参照测距值对应的y轴半轴与所述目标测距值对应的最大测距轴之间具有最小夹角;
78.更新模块5,用于若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则将所述无穷测距值设置为所述目标测距值,并更新当前场景的概率栅格地图。
79.进一步的,所述激光雷达数据包括多个测距值,单个测距值对应单个测距角度;
80.所述第二筛选模块3:
81.获取单元,用于沿逆时针方向选择相邻两个所述最大测距值为一组,并分别获取同组的两个所述最大测距值各自对应的第一测距角度和第二测距角度;
82.筛选单元,用于沿逆时针方向,从所述激光雷达数据中筛选出包含于所述第一测距角度和所述第二测距角度之间的各个第一测距值;
83.第一判断单元,用于统计各所述第一测距值中所包含的所述无穷测距值的数量,并判断所述无穷测距值的数量是否大于数量阈值;
84.选择单元,用于若所述无穷测距值的数量大于所述数量阈值,则选择同组的两个所述最大测距值作为单组所述目标测距值。
85.进一步的,所述判断模块4,包括:
86.定义单元,用于以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,将同组所述目标测距值的其中一个所述目标测距值与所述x轴之间的夹角定义为第三测距角度,另一个所述目标测距值与所述x轴之间的夹角定义为第四测距角度,其中,所述第三测距角度和所述第四测距角度均不大于90度;
87.第二判断单元,用于分别判断所述第三测距角度对应的第一测距轴到所述y轴的第一半轴之间的各个所述测距值是否呈递减趋势,以及判断所述第四测距角度对应的第二测距轴到所述y轴的第二半轴之间的各个所述测距值是否呈递减趋势,其中,所述第一半轴与所述第一测距轴之间的夹角最小,所述第二半轴与所述第二测距轴之间的夹角最小;
88.第一判定单元,用于若所述第三测距角度对应的第一测距轴到所述第一半轴之间的各个所述测距值呈递减趋势,且所述第四测距角度对应的第二测距轴到所述第二半轴之间的各个所述测距值呈递减趋势,则判定同组的两个所述目标测距值与最近的所述y轴之间的测距值呈递减趋势;
89.第二判定单元,用于若所述第三测距角度对应的第一测距轴到所述y轴上最近的第一半轴之间的各个所述测距值不是呈递减趋势,和/或所述第四测距角度对应的第二测距轴到所述y轴上最近的第二半轴之间的各个所述测距值不是呈递减趋势,则判定同组的两个所述目标测距值与最近的所述y轴之间的测距值不是呈递减趋势。
90.进一步的,所述机器人上部署有激光雷达,所述采集模块1,包括:
91.扫描单元,用于控制所述激光雷达按照逆时针方向扫描所述当前场景,得到若干个与单位扫描角度对应的测距值,所述测距值的数量与所述单位扫描角度的数量一致;
92.汇总单元,用于汇总各所述测距值,生成所述激光雷达数据。
93.进一步的,所述汇总单元,包括:
94.构建子单元,用于以所述机器人的行进方向为0度,所述机器人的后退方向为-0度建立角度系,并根据所述单位扫描角度,得到各所述测距值分别对应的测距角度;
95.映射子单元,用于将各所述测距值与各自对应的测距角度建立映射关系,依序汇总得到所述激光雷达数据。
96.进一步的,所述地图更新装置,还包括:
97.划定模块6,用于若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则获取当前位置坐标,并根据所述最大测距值和所述当前位置坐标划定走廊区域;
98.标记模块7,用于将所述走廊区域标记为长走廊环境。
99.进一步的,所述地图更新装置,还包括:
100.判定模块8,用于若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值不是呈递减趋势,则不更新测距夹角范围内的区域对应的概率栅格地图,其中,所述测距夹角为同组的两个所述目标测距值分别对应的两个所述最大测距轴之间的夹角,所述测距夹角不大于180度。
101.本实施例中,用于长走廊环境的地图更新装置中各模块、单元用于对应执行与上述用于长走廊环境的地图更新方法中的各个步骤,其具体实施过程在此不做详述。
102.本实施例提供的一种用于长走廊环境的地图更新装置,机器人采集激光雷达数据,然后从激光雷达数据中筛选出若干个最大测距值。机器人以相邻两个最大测距值为一组,从各组最大测距值中筛选出包含有无穷测距值的若干组目标测距值,无穷测距值位于同组的两个目标测距值之间,且无穷测距值的数量大于数量阈值。以机器人的中心为坐标轴原点,行进方向为x轴,垂直于行进方向为y轴,分别判断同组的两个目标测距值与参照测距值之间的测距值是否呈递减趋势,其中,参照测距值对应的y轴半轴与目标测距值对应的最大测距轴之间具有最小夹角。若同组的两个目标测距值与参照测距值之间的测距值呈递减趋势,则将无穷测距值设置为目标测距值,并更新当前场景的概率栅格地图。本技术中,机器人根据同组的两个目标测距值与参照测距值之间的测距值是否呈递减趋势识别当前场景是否为长走廊环境,并在判定当前场景为长走廊环境后,将激光雷达探测不到的区域以目标测距值进行建图,从而实现地图更新,地图上不会出现未知环境场景,有利于提高用户体验,以及建图的稳定性和鲁棒性。
103.参照图4,本技术实施例中还提供一种计算机设备,该计算机设备可以是服务器,其内部结构可以如图4所示。该计算机设备包括通过系统总线连接的处理器、存储器、网络
接口和数据库。其中,该计算机设计的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的数据库用于存储激光雷达数据等数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种用于长走廊环境的地图更新方法。
104.上述处理器执行上述用于长走廊环境的地图更新方法的步骤:
105.s1:采集激光雷达数据;
106.s2:从所述激光雷达数据中筛选出若干个最大测距值;
107.s3:以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值;
108.s4:以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势;
109.s5:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则将所述无穷测距值设置为所述目标测距值,并更新当前场景的概率栅格地图。
110.进一步的,所述激光雷达数据包括多个测距值,单个测距值对应单个测距角度;
111.所述以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值的步骤中,单组所述目标测距值的筛选步骤为:
112.s301:沿逆时针方向选择相邻两个所述最大测距值为一组,并分别获取同组的两个所述最大测距值各自对应的第一测距角度和第二测距角度;
113.s302:沿逆时针方向,从所述激光雷达数据中筛选出包含于所述第一测距角度和所述第二测距角度之间的各个第一测距值;
114.s303:统计各所述第一测距值中所包含的所述无穷测距值的数量,并判断所述无穷测距值的数量是否大于数量阈值;
115.s304:若所述无穷测距值的数量大于所述数量阈值,则选择同组的两个所述最大测距值作为单组所述目标测距值。
116.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤,包括:
117.s401:以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,将同组所述目标测距值的其中一个所述目标测距值与所述x轴之间的夹角定义为第三测距角度,另一个所述目标测距值与所述x轴之间的夹角定义为第四测距角度,其中,所述第三测距角度和所述第四测距角度均不大于90度;
118.s402:分别判断所述第三测距角度对应的第一测距轴到所述y轴的第一半轴之间的各个所述测距值是否呈递减趋势,以及判断所述第四测距角度对应的第二测距轴到所述y轴的第二半轴之间的各个所述测距值是否呈递减趋势,其中,所述第一半轴与所述第一测距轴之间的夹角最小,所述第二半轴与所述第二测距轴之间的夹角最小;
119.s403:若所述第三测距角度对应的第一测距轴到所述第一半轴之间的各个所述测
距值呈递减趋势,且所述第四测距角度对应的第二测距轴到所述第二半轴之间的各个所述测距值呈递减趋势,则判定同组的两个所述目标测距值与最近的所述y轴之间的测距值呈递减趋势;
120.s404:若所述第三测距角度对应的第一测距轴到所述第一半轴之间的各个所述测距值不是呈递减趋势,和/或所述第四测距角度对应的第二测距轴到所述第二半轴之间的各个所述测距值不是呈递减趋势,则判定同组的两个所述目标测距值与最近的所述y轴之间的测距值不是呈递减趋势。
121.进一步的,所述机器人上部署有激光雷达,所述采集激光雷达数据的步骤,包括:
122.s101:控制所述激光雷达按照逆时针方向扫描所述当前场景,得到若干个与单位扫描角度对应的测距值,所述测距值的数量与所述单位扫描角度的数量一致;
123.s102:汇总各所述测距值,生成所述激光雷达数据。
124.进一步的,所述汇总各所述测距值,生成所述激光雷达数据的步骤,包括:
125.s1021:以所述机器人的行进方向为0度,所述机器人的后退方向为-0度建立角度系,并根据所述单位扫描角度,得到各所述测距值分别对应的测距角度;
126.s1022:将各所述测距值与各自对应的测距角度建立映射关系,依序汇总得到所述激光雷达数据。
127.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤之后,包括:
128.s6:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则获取当前位置坐标,并根据所述最大测距值和所述当前位置坐标划定走廊区域;
129.s7:将所述走廊区域标记为长走廊环境。
130.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤之后,还包括:
131.s8:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值不是呈递减趋势,则不更新测距夹角范围内的区域对应的概率栅格地图,其中,所述测距夹角为同组的两个所述目标测距值分别对应的两个所述最大测距轴之间的夹角,所述测距夹角不大于180度。
132.本技术一实施例还提供一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现一种用于长走廊环境的地图更新方法,所述用于长走廊环境的地图更新方法具体为:
133.s1:采集激光雷达数据;
134.s2:从所述激光雷达数据中筛选出若干个最大测距值;
135.s3:以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值;
136.s4:以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减
趋势;
137.s5:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则将所述无穷测距值设置为所述目标测距值,并更新当前场景的概率栅格地图。
138.进一步的,所述激光雷达数据包括多个测距值,单个测距值对应单个测距角度;
139.所述以相邻两个所述最大测距值为一组,从各组所述最大测距值中筛选出包含有无穷测距值的若干组目标测距值的步骤中,单组所述目标测距值的筛选步骤为:
140.s301:沿逆时针方向选择相邻两个所述最大测距值为一组,并分别获取同组的两个所述最大测距值各自对应的第一测距角度和第二测距角度;
141.s302:沿逆时针方向,从所述激光雷达数据中筛选出包含于所述第一测距角度和所述第二测距角度之间的各个第一测距值;
142.s303:统计各所述第一测距值中所包含的所述无穷测距值的数量,并判断所述无穷测距值的数量是否大于数量阈值;
143.s304:若所述无穷测距值的数量大于所述数量阈值,则选择同组的两个所述最大测距值作为单组所述目标测距值。
144.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤,包括:
145.s401:以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,将同组所述目标测距值的其中一个所述目标测距值与所述x轴之间的夹角定义为第三测距角度,另一个所述目标测距值与所述x轴之间的夹角定义为第四测距角度,其中,所述第三测距角度和所述第四测距角度均不大于90度;
146.s402:分别判断所述第三测距角度对应的第一测距轴到所述y轴的第一半轴之间的各个所述测距值是否呈递减趋势,以及判断所述第四测距角度对应的第二测距轴到所述y轴的第二半轴之间的各个所述测距值是否呈递减趋势,其中,所述第一半轴与所述第一测距轴之间的夹角最小,所述第二半轴与所述第二测距轴之间的夹角最小;
147.s403:若所述第三测距角度对应的第一测距轴到所述第一半轴之间的各个所述测距值呈递减趋势,且所述第四测距角度对应的第二测距轴到所述第二半轴之间的各个所述测距值呈递减趋势,则判定同组的两个所述目标测距值与最近的所述y轴之间的测距值呈递减趋势;
148.s404:若所述第三测距角度对应的第一测距轴到所述第一半轴之间的各个所述测距值不是呈递减趋势,和/或所述第四测距角度对应的第二测距轴到所述第二半轴之间的各个所述测距值不是呈递减趋势,则判定同组的两个所述目标测距值与最近的所述y轴之间的测距值不是呈递减趋势。
149.进一步的,所述机器人上部署有激光雷达,所述采集激光雷达数据的步骤,包括:
150.s101:控制所述激光雷达按照逆时针方向扫描所述当前场景,得到若干个与单位扫描角度对应的测距值,所述测距值的数量与所述单位扫描角度的数量一致;
151.s102:汇总各所述测距值,生成所述激光雷达数据。
152.进一步的,所述汇总各所述测距值,生成所述激光雷达数据的步骤,包括:
153.s1021:以所述机器人的行进方向为0度,所述机器人的后退方向为-0度建立角度
系,并根据所述单位扫描角度,得到各所述测距值分别对应的测距角度;
154.s1022:将各所述测距值与各自对应的测距角度建立映射关系,依序汇总得到所述激光雷达数据。
155.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤之后,包括:
156.s6:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值呈递减趋势,则获取当前位置坐标,并根据所述最大测距值和所述当前位置坐标划定走廊区域;
157.s7:将所述走廊区域标记为长走廊环境。
158.进一步的,所述以机器人的中心为坐标轴原点,行进方向为x轴,垂直于所述行进方向为y轴,分别判断同组的两个所述目标测距值与各自对应的参照测距值之间的测距值是否呈递减趋势的步骤之后,还包括:
159.s8:若同组的两个所述目标测距值与各自对应的所述参照测距值之间的测距值不是呈递减趋势,则不更新测距夹角范围内的区域对应的概率栅格地图,其中,所述测距夹角为同组的两个所述目标测距值分别对应的两个所述最大测距轴之间的夹角,所述测距夹角不大于180度。
160.本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储与一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本技术所提供的和实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可以包括只读存储器(rom)、可编程rom(prom)、电可编程rom(eprom)、电可擦除可编程rom(eeprom)或闪存。易失性存储器可包括随机存取存储器(ram)或者外部高速缓冲存储器。作为说明而非局限,ram通过多种形式可得,诸如静态ram(sram)、动态ram(dram)、同步dram(sdram)、双速据率sdram(ssrsdram)、增强型sdram(esdram)、同步链路(synchlink)dram(sldram)、存储器总线(rambus)直接ram(rdram)、直接存储器总线动态ram(drdram)、以及存储器总线动态ram(rdram)等。
161.需要说明的是,在本文中,术语“包括”、“包含”或者其任何其它变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、装置、第一物体或者方法不仅包括那些要素,而且还包括没有明确列出的其它要素,或者是还包括为这种过程、装置、第一物体或者方法所固有的要素。在没有更多限制的情况下,由语句“包括一个
……”
限定的要素,并不排除在包括该要素的过程、装置、第一物体或者方法中还存在另外的相同要素。
162.以上所述仅为本技术的优选实施例,并非因此限制本技术的专利范围,凡是利用本技术说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其它相关的技术领域,均同理包括在本技术的专利保护范围内。
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1