多机器人持续监控方法和非临时性计算机可读存储介质

文档序号:31053622发布日期:2022-08-06 09:37阅读:96来源:国知局
多机器人持续监控方法和非临时性计算机可读存储介质

1.本发明涉及多机器人持续监控技术领域,具体而言,涉及一种多机器人持续监控方法和实现所述多机器人持续监控方法的非临时性计算机可读存储介质。


背景技术:

2.机器人自问世以来,在农业、工业、商业、服务业、医疗、救援、军事、空天等领域的应用使人类从繁重的任务中解放出来,甚至代替人类从事危险的工作。为使机器人能够完成更加复杂、多变的任务,多机器人系统逐渐成为机器人领域的研究热点。相对于单机器人系统,多机器人相互协作可以弥补个体能力的不足,在任务执行效率、鲁棒性、灵活性和容错性等方面具有优异表现。各种应用领域广泛存在着对某一环境或区域进行持续监控的任务,这类任务的完成通常需要耗费巨大的人力且在特定场合具有一定的危险性,因此已成为多机器人系统研究的基本问题之一。
3.针对有障碍环境中多机器人系统持续监控问题,相关技术中基于泰森多边形(voronoi)和虚拟力方法构建了一种分布式监控算法,但voronoi图重点研究如何对环境进行分区,并不能很好地适应环境的动态变化。而在无障碍环境中通常将目标空间进行网格划分,每个网格都有一个表示自上次观察到它以来所经过的时间的年龄,持续监测的目标是将长期观察到的所有网格的最大年龄降至最低,但没有研究这种半启发式方法在有障碍环境下的有效性,将其直接应用于有障碍环境不能完全避开障碍物。


技术实现要素:

4.本发明旨在至少解决现有技术中存在的技术问题之一。为此,本发明提出一种多机器人持续监控方法,所述多机器人持续监控方法具有访问频率高、一致性好等优点。
5.本发明还提出一种实现所述多机器人持续监控方法的非临时性计算机可读存储介质。
6.根据本发明第一方面实施例的多机器人持续监控方法,所述机器人为n个,待访问二维平面区域被均匀划分为l
×
m个网格,每个所述网格为边长为单位1的正方形,所述待访问二维平面区域设置有多个障碍物,每个所述障碍物占用一个所述网格,所述机器人位于单个所述网格的中心处且每时间步沿所述网格的边长方向移动至相邻所述网格的中心处,所述机器人的传感器的监测范围等于单个所述网格的面积,所述方法包括:
7.s1,建立xoy坐标系,所述网格的中心处的坐标为(i,j),初始化所述机器人的当前位置car_pos、所述障碍物的位置obs_pos、每个所述网格的单元值cell、每个所述机器人与每个所述网格之间的距离distance_all、每个所述机器人的移动速度vel,cell为l
×
m数组;
8.s2,根据以下公式计算每个所述机器人的导向值value:
9.if(i,j)in obs_pos:
[0010]vi,j
=-inf or v
i,j
=nan
[0011]
else:
[0012][0013]
式中,v
i,j
表示坐标为(i,j)的网格对应的导向值,cell
i,j
表示坐标为(i,j)的网格对应的单元值,ω0和ω1分别是加权系数,δ
kj
是所述机器人与坐标为(i,j)的网格之间的距离,δ
nj
是其余机器人与坐标为(i,j)的网格之间的距离;
[0014]
s3,获取每个所述机器人的最大导向值value对应的坐标并将其作为全局目标位置添加至opt_count中;
[0015]
s4,搜索每个所述机器人的当前位置car_pos的相邻网格并剔除其中被所述障碍物占用的网格;
[0016]
s5,计算所述相邻网格与对应的所述全局目标位置之间的距离,选取与所述全局目标位置之间距离最小的所述相邻网格作为所述机器人下一步以速度vel运动至的单步目标位置;
[0017]
s6,判断每个所述机器人是否到达步骤s5的所述单步目标位置,如果到达则更新所述机器人的当前位置car_pos,将其对应的网格的单元值置0、其余网格的单元值增δt或根据以下公式更新其对应的网格的单元值cell
i,j

[0018]
cell
i,j
=a
i,j-αb
i,j
[0019]
式中,a
i,j
表示坐标为(i,j)的网格更新前的单元值(首次计算即初始化值),α为加权系数,b
i,j
为坐标为(i,j)的网格每被所述机器人访问一次的衰减值;
[0020]
s7,判断是否满足结束条件,如果没有满足则执行步骤s2;或,
[0021]
所述机器人为n个,待访问二维平面区域被均匀划分为l
×
m个网格,每个所述网格为边长为单位1的正方形,所述待访问二维平面区域设置有用于限定出通道和/或路口的多个围挡,所述通道或所述路口的最小宽度为r,每个所述围挡占用一个或多个所述网格的边,所述机器人位于所述网格的顶点且每时间步沿所述网格的边长移动至相邻所述网格的顶点处,所述机器人的传感器的监测范围在其前进方向上为以所述机器人所在顶点为圆心、半径为r的半圆,所述方法包括:
[0022]
s1,建立xoy坐标系,分布在所述坐标系中的所述网格的顶点的坐标为(i,j),初始化所述机器人的当前位置car_pos、所述围挡的位置obs_pos、每个所述网格的单元值cell、每个所述机器人与每个所述网格之间的距离distance_all、每个所述机器人的移动速度vel,cell为l
×
m数组;
[0023]
s2,根据以下公式计算每个所述机器人的导向值value:
[0024]
if(i,j)in obs_pos:
[0025]vi,j
=-inf or v
i,j
=nan
[0026]
else:
[0027][0028]
式中,v
i,j
表示坐标点(i,j)对应的导向值,a
i,j
表示坐标点(i,j)的信息值,所述信息值为以坐标点(i,j)为中心的num个所述网格的单元值的平均值,ω0和ω1分别是加权系数,δ
kj
是所述机器人与坐标点(i,j)之间的距离,δ
nj
是其余机器人与坐标点(i,j)之间的距离;
[0029]
s3,获取每个所述机器人的最大导向值value对应的坐标点并将其作为全局目标位置添加至opt_count中;
[0030]
s4,搜索每个所述机器人的当前位置car_pos的相邻坐标点并剔除其中被所述围挡占用的坐标点;
[0031]
s5,计算所述相邻坐标点与对应的所述全局目标位置之间的距离,选取与所述全局目标位置之间距离最小的所述相邻坐标点作为所述机器人下一步以速度vel运动至的单步目标位置;
[0032]
s6,判断每个所述机器人是否到达步骤s5的所述单步目标位置,如果到达则更新所述机器人的当前位置car_pos,将其对应的坐标点的num个所述网格的单元值置0、其余网格的单元值增δt或根据以下公式更新其对应的坐标点的num个所述网格的单元值cell
x,y

[0033]
cell
x,y
=a
x,y-αb
x,y
[0034]
式中,a
x,y
表示索引为(x,y)的网格更新前的单元值(首次计算即初始化值),α为加权系数,b
x,y
表示索引为(x,y)的网格每被所述机器人访问一次的衰减值;
[0035]
s7,判断是否满足结束条件,如果没有满足则执行步骤s2。
[0036]
根据本发明实施例的多机器人持续监控方法,能够应用于有障碍环境(包括类迷宫环境)而无需考虑分区,适应性较好,并且利于提高所有无障碍网格被多次访问后的最小访问频率和访问频率倾向性,使得网格的访问频率与待访问二维平面区域的访问频率的一致性较好。
[0037]
另外,根据本发明实施例的多机器人持续监控方法还具有如下附加的技术特征:
[0038]
根据本发明的一些实施例,根据以下公式计算位于坐标为(x,y)的网格的所述机器人与坐标为(i,j)的网格之间的距离δ
kj

[0039][0040]
和/或,根据以下公式计算坐标为(i,j)的所述相邻网格与对应的所述目标位置(i',j')之间的距离h:
[0041][0042]
根据本发明的一些实施例,若在同一次分配中多个所述机器人的目标位置相同,则为其中距离所述目标位置较远的机器人分配其次优目标位置,和/或,
[0043]
若在同一次分配中多个所述机器人的单步目标位置相同,则为其中所述相邻网格的数量较多的机器人重新分配所述单步目标位置。
[0044]
在本发明的一些实施例中,所述次优目标位置为所述机器人的第二大导向值value对应的坐标。
[0045]
在本发明的一些实施例中,重新分配所述单步目标位置的方法包括:
[0046]
从所述相邻网格中删除原单步目标位置,随机选取当前所述相邻网格中的一个作为重新分配的所述单步目标位置。
[0047]
根据本发明的一些实施例,所述机器人的全局目标位置为多个时剔除与所述机器人的当前位置相等的位置并选择与所述机器人的距离最小的位置。
[0048]
根据本发明的一些实施例,若所述相邻网格为所述机器人前次访问的网格,则选取其余所述相邻网格。
[0049]
根据本发明的一些实施例,若在所述机器人的前进方向上所述传感器的监测范围内没有所述围挡,则更新对应的2
×r×
r个所述网格的单元值;若在所述机器人的前进方向上所述传感器的监测范围内有所述围挡,则剔除被所述围挡挡住的网格后更新其余网格的单元值。
[0050]
根据本发明的一些实施例,多个所述网格的单元值cell的初始值和/或δt不同,或,多个所述网格的单元值cell的初始值和/或衰减值不同。
[0051]
根据本发明第二方面实施例的非临时性计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现如上所述的多机器人持续监控方法。
[0052]
根据本发明实施例的非临时性计算机可读存储介质,能够应用于有障碍环境(包括类迷宫环境)而无需考虑分区,适应性较好,并且利于提高所有无障碍网格被多次访问后的最小访问频率和访问频率倾向性,使得网格的访问频率与待访问二维平面区域的访问频率的一致性较好。
[0053]
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
[0054]
图1是根据本发明实施例的多机器人持续监控方法的待访问二维平面区域示意图;
[0055]
图2是根据本发明实施例的多机器人持续监控方法的流程图;
[0056]
图3是根据本发明实施例的多机器人持续监控方法的单元值更新流程图;
[0057]
图4是根据本发明实施例的多机器人持续监控方法的单元值衰减示意图;
[0058]
图5是根据本发明实施例的多机器人持续监控方法的迭代135次访问频率和所占百分比对比图;
[0059]
图6是根据本发明实施例的多机器人持续监控方法的迭代150次访问频率和所占百分比对比图;
[0060]
图7是根据本发明实施例的多机器人持续监控方法的多遍访问频率和所占百分比变化趋势图;
[0061]
图8是根据本发明另一个实施例的多机器人持续监控方法的待访问二维平面区域示意图;
[0062]
图9是根据本发明实施例的第一访问规则原理图;
[0063]
图10是根据本发明实施例的第二访问规则原理图;
[0064]
图11是根据本发明实施例的第三访问规则原理图;
[0065]
图12是根据本发明实施例的第四访问规则原理图;
[0066]
图13是根据本发明实施例的第五访问规则原理图;
[0067]
图14是根据本发明实施例的第六访问规则原理图。
具体实施方式
[0068]
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附
图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。
[0069]
下面参考附图描述根据本发明实施例的多机器人持续监控方法。
[0070]
如图1和图2所示,待访问二维平面区域(即目标空间)为采用网格分解法划分成10
×
10网格的正方形区域,每个网格以其中心处的坐标(i,j)为位置坐标,每个网格的边长为单位值1。目标空间中设置有占据一定数量网格的障碍物,空白网格表示障碍物所占据区域(数量为19)。目标空间中设置3个移动机器人。移动机器人处在网格的中心处,在每一次迭代中移动机器人k(k=1,2,3)都有一个起始位置和一个目标位置。将时间离散化为时间点,在时间点移动机器人k位于其相应的位置上。规定移动机器人每次只移动一个网格或者静止在当前位置,在连续的时间点之间每个移动机器人只能从一个网格移动至与其相邻的网格或者移动机器人在当前网格保持空闲。任一无障碍网格在同一时间点最多只能被一个移动机器人占用。每个移动机器人的传感器监测范围等于单个网格面积。每个移动机器人沿平行于网格的边长方向移动。
[0071]
实施例一
[0072]
根据本发明实施例的多机器人持续监控方法,包括以下步骤:
[0073]
s1,建立xoy坐标系,网格的中心处的坐标为(i,j),初始化机器人的当前位置car_pos、障碍物的位置obs_pos、每个网格的单元值cell、每个机器人与每个网格之间的距离distance_all、每个机器人的移动速度vel、每个机器人所对应的导向值value、每个机器人单次被分配的目标位置opt_count。例如,car_pos、obs_pos、opt_count均为坐标点集合,cell为10
×
10的数组,distance_all和value分别为3
×
10
×
10的数组,每层对应一个机器人的数据。
[0074]
s2,根据以下公式计算每个机器人的导向值value:
[0075]
if(i,j)in obs_pos:
[0076]vi,j
=-inf or v
i,j
=nan
[0077]
else:
[0078][0079]
式中,v
i,j
表示坐标为(i,j)的网格对应的导向值,cell
i,j
表示坐标为(i,j)的网格对应的单元值,ω0和ω1分别是加权系数,δ
kj
是机器人与坐标为(i,j)的网格之间的距离,δ
nj
是其余机器人与坐标为(i,j)的网格之间的距离。ω0=-1/vel,ω1=-1/vel。例如,根据以下公式计算位于坐标为(x,y)的网格的机器人与坐标为(i,j)的网格之间的距离δ
kj

[0080][0081]
多个移动机器人之间的相对位置会影响对目标位置的选择,因此控制策略通过定义与每个网格关联的导向值v
i,j
来表示,移动机器人与网格之间的距离以及其余移动机器人与网格之间的距离会影响网格的导向值。移动机器人计算网格的导向值并趋向具有最大值的网格。
[0082]
s3,获取每个机器人的最大导向值value对应的坐标并将其作为目标位置添加至集合opt_count中。若在同一次分配中多个机器人的目标位置相同,则为其中距离目标位置较远的机器人分配其次优目标位置。例如,次优目标位置为机器人的第二大导向值value对应的坐标。
[0083]
当环境中设置障碍物时令障碍物所占用网格的值v
i,j
极小(赋值-10000或无穷小)。但仅改变有障碍网格的值v
i,j
并不能使移动机器人完全避开有障碍网格。这是因为v
i,j
用于计算移动机器人的目标位置,将v
i,j
赋值-10000只能保证不会将该网格选作移动机器人的目标位置,移动机器人在朝着目标位置移动的过程中仍然可能经过该有障碍网格。因此有必要寻求一种避障方法。
[0084]
s4,搜索每个机器人的当前位置car_pos的相邻网格并剔除其中被障碍物占用的网格。若相邻网格为机器人前次访问的网格,则选取其余相邻网格,即,在相邻网格中包括机器人刚刚访问过的网格时将其剔除。
[0085]
s5,计算相邻网格与对应的目标位置之间的距离,选取与目标位置之间距离最小的相邻网格作为机器人下一步以速度vel运动至的单步目标位置。
[0086]
例如,根据以下公式计算坐标为(i,j)的相邻网格与对应的目标位置(i',j')之间的距离h:
[0087][0088]
若在同一次分配中多个机器人的单步目标位置相同,则为其中相邻网格的数量较多的机器人重新分配单步目标位置。重新分配单步目标位置的方法包括:
[0089]
从相邻网格中删除原单步目标位置,随机选取当前相邻网格中的一个作为重新分配的单步目标位置。
[0090]
s6,判断每个机器人是否到达步骤s5的单步目标位置,如果到达则更新机器人的当前位置car_pos并将其对应的网格的单元值置0、其余网格的单元值增δt。cell
i,j
初始值为0,坐标为(i,j)的网格被访问前cell
i,j
每单位时间步增5(即δt=5),一旦被访问cell
i,j
置为0。ω0=-1,ω1=-1。
[0091]
其中多个网格的单元值cell的初始值和/或δt可以不同。这样,可以根据不同网格的重要程度控制对其访问次数,例如,重要区域需要多次访问,对其访问次数会多于其余区域。
[0092]
s7,判断是否满足结束条件,如果没有满足则执行步骤s2。例如,结束条件为迭代200次。
[0093]
实施例二
[0094]
根据本发明另一个实施例的多机器人持续监控方法,包括以下步骤:
[0095]
s1,建立xoy坐标系,网格的中心处的坐标为(i,j),初始化机器人的当前位置car_pos、障碍物的位置obs_pos、每个网格的单元值cell、每个机器人与每个网格之间的距离distance_all、每个机器人的移动速度vel、每个机器人所对应的导向值value、每个机器人单次被分配的目标位置opt_count。
[0096]
s2,根据以下公式计算每个机器人的导向值value:
[0097]
if(i,j)in obs_pos:
[0098]vi,j
=-inf or v
i,j
=nan
[0099]
else:
[0100][0101]
式中,v
i,j
表示坐标为(i,j)的网格对应的导向值,cell
i,j
表示坐标为(i,j)的网格
对应的单元值,ω0和ω1分别是加权系数,δ
kj
是机器人与坐标为(i,j)的网格之间的距离,δ
nj
是其余机器人与坐标为(i,j)的网格之间的距离。
[0102]
s3,获取每个机器人的最大导向值value对应的坐标并将其作为目标位置添加至集合opt_count中。
[0103]
s4,搜索每个机器人的当前位置car_pos的相邻网格并剔除其中被障碍物占用的网格。
[0104]
s5,计算相邻网格与对应的目标位置之间的距离,选取与目标位置之间距离最小的相邻网格作为机器人下一步以速度vel运动至的单步目标位置。
[0105]
s6,判断每个机器人是否到达步骤s5的单步目标位置,如果到达则更新机器人的当前位置car_pos并根据以下公式更新其对应的网格的单元值cell
i,j

[0106]
cell
i,j
=a
i,j-αb
i,j
[0107]
式中,a
i,j
表示坐标为(i,j)的网格更新前的单元值(首次计算即初始化值),α为加权系数,b
i,j
为坐标为(i,j)的网格每被机器人访问一次的衰减值。单元值的更新流程如图3所示,图4示出了网格每被访问一次单元值便衰减一定值。a
i,j
初值为100,每个网格被访问一次则单元值减少5(b
i,j
=5),α=1,ω0=-1,ω1=-1。其中多个网格的单元值cell的初始值和/或衰减值可以不同。
[0108]
s7,判断是否满足结束条件,如果没有满足则执行步骤s2。
[0109]
如图5-图7所示,sgm表示实施例一的方法,ppigm表示实施例二的方法。sgm在多遍访问目标空间情况下被访问2次的网格占比最多,以图7中曲线的峰值及其附近数值表征在多遍访问目标空间情况下对每个无障碍网格的访问次数的倾向性,ppigm相对于sgm增大了最小访问次数,访问次数的倾向性沿图7的水平轴方向右移,较多的网格得到了较多的访问次数,对目标空间的访问频率与对网格的访问频率的一致性较好。根据本发明实施例的多机器人持续监控方法,不仅无需考虑分区、适应性较好,而且在多次迭代后完成对所有无障碍网格的访问,在对所有无障碍网格的多遍访问后提高最小访问频率和访问频率倾向性,使得网格的访问频率与目标空间的访问频率的一致性较好。
[0110]
实施例三
[0111]
如图8所示,移动机器人为3个,待访问二维平面区域被均匀划分为15
×
17个网格,每个网格为边长为单位1的正方形,待访问二维平面区域设置有用于限定出通道和/或路口的多个围挡,如此形成类迷宫环境。图中带点、三角形和方块的直线表示移动机器人的路径。通道或路口的最小宽度为2,每个围挡占用一个或多个网格的边,机器人位于网格的顶点且每时间步沿网格的边长移动至相邻网格的顶点处,机器人的传感器的监测范围在其前进方向上为以机器人所在顶点为圆心、半径为2的半圆,方法包括:
[0112]
s1,建立xoy坐标系,分布在坐标系中的网格的顶点的坐标为(i,j),初始化机器人的当前位置car_pos、围挡的位置obs_pos、每个网格的单元值cell、每个机器人与每个网格之间的距离distance_all、每个机器人的移动速度vel,cell为15
×
17数组。由于目标空间的四个边均设置围挡,因此i∈(1,14),j∈(1,16)。
[0113]
s2,根据以下公式计算每个机器人的导向值value:
[0114]
if(i,j)in obs_pos:
[0115]vi,j
=-inf or v
i,j
=nan
[0116]
else:
[0117][0118]
式中,v
i,j
表示坐标点(i,j)对应的导向值,a
i,j
表示坐标点(i,j)的信息值,信息值为以坐标点(i,j)为中心的num个网格的单元值的平均值,ω0和ω1分别是加权系数,δ
kj
是机器人与坐标点(i,j)之间的距离,δ
nj
是其余机器人与坐标点(i,j)之间的距离。例如,a
i,j
取以坐标点(i,j)为中心的四个网格的单元值的平均值,a
i,j
=(cell[i-1][j-1]+cell[i-1][j]+cell[i][j-1]+cell[i][j])/4。
[0119]
s3,获取每个机器人的最大导向值value对应的坐标点并将其作为全局目标位置添加至opt_count中。机器人的全局目标位置为多个时,剔除与机器人的当前位置重合的位置并选择与机器人的距离最小的位置。同理,当机器人的次优目标位置与机器人的当前位置重合时,选择其余位置作为次优目标位置。
[0120]
s4,搜索每个机器人的当前位置car_pos的相邻坐标点并剔除其中被围挡占用的坐标点。
[0121]
s5,计算相邻坐标点与对应的全局目标位置之间的距离,选取与全局目标位置之间距离最小的相邻坐标点作为机器人下一步以速度vel运动至的单步目标位置。
[0122]
s6,判断每个机器人是否到达步骤s5的单步目标位置,如果到达则更新机器人的当前位置car_pos,将其对应的坐标点的num个网格的单元值置0、其余网格的单元值增δt或根据以下公式更新其对应的坐标点的num个网格的单元值cell
x,y

[0123]
cell
x,y
=a
x,y-αb
x,y
[0124]
式中,a
x,y
表示索引为(x,y)的网格更新前的单元值(首次计算即初始化值),α为加权系数,b
x,y
表示索引为(x,y)的网格每被机器人访问一次的衰减值。
[0125]
s7,判断是否满足结束条件,如果没有满足则执行步骤s2。
[0126]
对于二维目标空间,移动机器人具有上下左右四个行进方向。15
×
17的目标空间的最窄处为2、r=2,若没有围挡遮挡移动机器人的视野,那么移动机器人的行进方向为上时,cell[i-2][j+1]、cell[i-2][j]、cell[i-1][j]、cell[i-1][j+1]、cell[i][j]、cell[i][j+1]、cell[i+1][j+1]、cell[i+1][j]的值均被更新;移动机器人的行进方向为下时,cell[i-2][j-1]、cell[i-2][j-2]、cell[i-1][j-1]、cell[i-1][j-2]、cell[i][j-1]、cell[i][j-2]、cell[i+1][j-1]、cell[i+1][j-2]的值均被更新;移动机器人的行进方向为左时,cell[i-2][j+1]、cell[i-2][j]、cell[i-1][j]、cell[i-1][j+1]、cell[i-2][j-1]、cell[i-2][j-2]、cell[i-1][j-1]、cell[i-1][j-2]的值均被更新;移动机器人的行进方向为右时,cell[i][j]、cell[i][j+1]、cell[i+1][j+1]、cell[i+1][j]、cell[i][j-1]、cell[i][j-2]、cell[i+1][j-1]、cell[i+1][j-2]。当i或j的取值邻近取值范围的上界或下界时,i-1、i-2或j-1、j-2的取值会超出取值范围,因此有必要先判断i或j的取值是否越界再更新cell的值。
[0127]
若移动机器人的视野范围内存在围挡,那么被围挡挡住的网格便不会更新cell值。以移动机器人的行进方向为上为例,由于围挡在环境模型中以直线段的形式存在,因此被围挡占用的坐标点不可能单独存在,至少两个坐标点同时被围挡占用。如图9所示,将移动机器人(实心三角形表示)的视野视为带箭头的虚线表示的扫描线,在移动机器人的视野范围内,除移动机器人自身占用的坐标点外还有14个坐标点,对于处于最外围的坐标点(空
1,j+1)为视野盲区;如图12(b)所示,被占用内围坐标点为(i+1,j+1)、(i-1,j+1)和(i,j+1),则网格(i,j+1)、(i+1,j+1)、(i-2,j+1)和(i-1,j+1)为视野盲区;如图12(c)所示,被占用内围坐标点为(i,j+1)、(i+1,j+1)和(i+1,j),则网格(i,j+1)、(i+1,j+1)和(i+1,j)为视野盲区。
[0132]
若被占用的三个内围坐标点中只有两个坐标点相邻:如图13(a)所示,被占用内围坐标点为(i-1,j)、(i-1,j+1)和(i+1,j+1),则网格(i-2,j)、(i-2,j+1)和(i+1,j+1)为视野盲区;如图13(b)所示,被占用内围坐标点为(i-1,j)、(i-1,j+1)和(i+1,j),则网格(i-2,j)和(i-2,j+1)为视野盲区;如图13(c)所示,被占用内围坐标点为(i-1,j+1)、(i,j+1)和(i+1,j),则网格(i-2,j+1)和(i-1,j+1)为视野盲区;如图13d所示,被占用内围坐标点为(i,j+1)、(i+1,j+1)和(i-1,j),则网格(i,j+1)和(i+1,j+1)为视野盲区;如图13e所示,被占用内围坐标点为(i+1,j+1)、(i+1,j)和(i-1,j+1),则网格(i+1,j)、(i+1,j+1)和(i-2,j+1)为视野盲区;如图13f所示,被占用内围坐标点为(i+1,j+1)、(i+1,j)和(i-1,j),则网格(i+1,j)和(i+1,j+1)为视野盲区。
[0133]
若内围坐标点中有四个被围挡占用,排列组合可得共有5种情况。如图14(a)所示,被占用的内围坐标点为(i-1,j)、(i-1,j+1)、(i,j+1)和(i+1,j+1),则网格(i-2,j)、(i-2,j+1)、(i-1,j+1)、(i,j+1)和(i+1,j+1)为视野盲区;如图14(b)所示,被占用的内围坐标点为(i+1,j)、(i-1,j+1)、(i,j+1)和(i+1,j+1),则网格(i+1,j)、(i-2,j+1)、(i-1,j+1)、(i,j+1)和(i+1,j+1)为视野盲区;如图14(c)所示,被占用的内围坐标点为(i-1,j)、(i-1,j+1)、(i,j+1)和(i+1,j),则网格(i-2,j)、(i-2,j+1)和(i-1,j+1)为视野盲区;如图14(d)所示,被占用的内围坐标点为(i+1,j)、(i,j+1)、(i-1,j)和(i+1,j+1),则网格(i+1,j)、(i,j+1)和(i+1,j+1)为视野盲区;如图14(e)所示,被占用的内围坐标点为(i-1,j)、(i-1,j+1)、(i+1,j)和(i+1,j+1),则网格(i-2,j)、(i-2,j+1)、(i+1,j)和(i+1,j+1)为视野盲区。
[0134]
若内围的五个坐标点都被围挡占据,则网格若内围的五个坐标点均是自由坐标点,则(i-2,j)、(i-2,j+1)、(i-1,j+1)、(i,j+1)、(i+1,j+1)和(i+1,j)为视野盲区。若内围的五个坐标点均是自由坐标点,则移动机器人的视野没有被遮挡,相应的八个网格的cell值都被更新。当移动机器人的行进方向为另外三个方向时,网格的访问情况依据前述规则确定。
[0135]
根据本发明第二方面实施例的非临时性计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现如上所述的多机器人持续监控方法。
[0136]
根据本发明实施例的非临时性计算机可读存储介质,能够应用于有障碍环境而无需考虑分区,适应性较好,并且利于提高所有无障碍网格被多次访问后的最小访问频率和访问频率倾向性,使得网格的访问频率与待访问二维平面区域的访问频率的一致性较好。
[0137]
在本发明的描述中,需要理解的是,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个该特征。在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上。
[0138]
在本发明的描述中,“第一特征”、“第二特征”可以包括一个或者更多个该特征,第一特征在第二特征“之上”或“之下”可以包括第一和第二特征直接接触,也可以包括第一和第二特征不是直接接触而是通过它们之间的另外的特征接触。第一特征在第二特征“之
上”、“上方”和“上面”包括第一特征在第二特征正上方和斜上方,或仅仅表示第一特征水平高度高于第二特征。
[0139]
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“具体实施例”、“示例”或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
[0140]
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1