CN108444484B - 一种构建栅格地图的控制方法和芯片及机器人 - Google Patents
一种构建栅格地图的控制方法和芯片及机器人 Download PDFInfo
- Publication number
- CN108444484B CN108444484B CN201810198945.7A CN201810198945A CN108444484B CN 108444484 B CN108444484 B CN 108444484B CN 201810198945 A CN201810198945 A CN 201810198945A CN 108444484 B CN108444484 B CN 108444484B
- Authority
- CN
- China
- Prior art keywords
- grid
- marked
- robot
- boundary
- coordinate
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 51
- 230000009191 jumping Effects 0.000 claims description 4
- 230000008859 change Effects 0.000 claims description 3
- 230000005012 migration Effects 0.000 claims description 3
- 238000013508 migration Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 7
- 230000006399 behavior Effects 0.000 description 3
- 238000004140 cleaning Methods 0.000 description 3
- 238000001514 detection method Methods 0.000 description 3
- 238000010408 sweeping Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000003247 decreasing effect Effects 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
- G01C21/32—Structuring or formatting of map data
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种构建栅格地图的控制方法,当栅格地图已标记栅格的坐标达到所述栅格地图边界的预设范围时,根据已标记栅格的坐标偏移结果超过边界的情况,计算出坐标实际变化量。本发明通过对栅格地图进行偏移,解决了机器人出发点位置受实际地图边界影响的问题,使得机器人在各种地形环境下充分利用栅格地图运动,提高栅格地图的利用率。
Description
技术领域
本发明涉及电子信息和智能控制技术领域,具体涉及一种构建栅格地图的控制方法和芯片及机器人。
背景技术
目前大多数扫地机器人都是使用栅格法进行建图的,然后再更新栅格地图状态。栅格法是使用大小相同的栅格划分机器人的工作空间,并用栅格数组来表示环境,每个栅格要么处于自由空间中,要么在障碍物空间中。这种方法的优点是简单,易于实现,具有表示不规则障碍物的能力,从而为路径规划的实现带来了很多方便;缺点是表示效率不高,存在着时空开销与精度之间的矛盾。
机器人以遍历的方式创建栅格地图,机器人的出发点一般定位于栅格地图的中心点,栅格地图范围大小固定,假如机器人一直朝一个方向清扫,则地图很容易超过边界。比如机器人出发点位置的右边靠墙,左边的可清扫区域的范围比较大,那么机器人朝出发点位置的左边方向运动会导致其实际使用的地图超过边界,而出发点位置的右边方向的地图却空着没有使用,所以静态建立好的栅格地图中有一些空间被闲置而没有利用到,导致清扫面积受限。现有公布号为CN106873601A的中国专利为解决上述问题,根据实际使用地图超过边界的情况,实时平移整个栅格地图,但在地图超过边界时需要开辟内存来缓冲已经越界的栅格地图数据,待地图平移后将缓冲数据写入地图中,这一过程使得算法流程复杂,并使得硬件系统的负载加大。
发明内容
本发明提供了一种构建栅格地图的控制方法,机器人的当前位置达到栅格地图边界的预设范围时,根据实际使用栅格地图的情况,对已标记栅格的坐标进行偏移。本发明的具体技术方案如下:
一种构建栅格地图的控制方法,包括如下步骤:
步骤S1:当机器人当前位置达到栅格地图边界的预设范围时,进入步骤S2,否则跳出步骤S1;
步骤S2:判断已标记栅格的坐标预偏移结果是否超过所述栅格地图边界,是则计算出坐标实际变化量,并进入步骤S3,否则跳出步骤S2;
步骤S3:根据坐标实际变化量对已标记栅格的坐标进行偏移,所述已标记栅格保持偏移前的状态信息不变。
进一步地,所述控制方法的的步骤S1的具体方法包括:
步骤S11:在所述栅格地图的X-Y平面直角坐标系的第一象限内绘制机器人工作区域的边界,并记录机器人的当前位置对应的栅格坐标,并进入步骤S12;
其中,所述栅格地图的坐标取值范围是,第一边界是直线X=0,第二边界是直线X=Xn,第三边界是直线Y=0,第四边界是直线Y=Yn,Xc是机器人的当前位置对应栅格的横坐标,Yc是机器人的当前位置对应栅格的纵坐标;M表示为所述栅格地图边界的预设范围内的坐标变化量;abs表示取机器人当前位置与所述栅格地图边界的距离的绝对值。
进一步地,所述控制方法的步骤S2的具体方法包括:
其中MAXx是机器人在X轴方向上已标记栅格的最大横坐标,MINx是机器人在X轴方向上已标记栅格的最小横坐标,MAXy是机器人在Y轴方向上已标记栅格的最大纵坐标,MINy是机器人在Y轴方向上已标记栅格的最小纵坐标,N表示所述栅格地图中已标记栅格的坐标在X轴或Y轴方向上的参考变化量。
进一步地,所述控制方法的步骤S3的具体方法包括:
时,如果所述已标记栅格的横坐标加上Xn-MAXx,则所述已标记栅格的坐标往X轴正方向偏移Xn-MAXx个栅格,所述已标记栅格保持偏移前的状态信息不变;如果所述已标记栅格的横坐标加上N,则所述已标记栅格的坐标往X轴正方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变;
时,如果所述已标记栅格的横坐标减去MINx,则所述已标记栅格的坐标往X轴负方向偏移MINx个栅格,所述已标记栅格保持偏移前的状态信息不变;如果所述已标记栅格的横坐标减去N,则所述已标记栅格的坐标往X轴负方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变;
时,如果所述已标记栅格的纵坐标加上Yn-MAXy,则所述已标记栅格的坐标往Y轴正方向偏移Yn-MAXy个栅格,所述已标记栅格保持偏移前的状态信息不变;如果所述已标记栅格的纵坐标加上N,则所述已标记栅格的坐标往Y轴正方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变;
时,如果所述已标记栅格的纵坐标减去MINy,则所述已标记栅格的坐标往Y轴负方向偏移MINy个栅格,所述已标记栅格保持偏移前的状态信息不变;如果所述已标记栅格的纵坐标减去N,则所述已标记栅格的坐标往Y轴负方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变。
进一步地,所述已标记栅格的状态信息是机器人根据实际环境对栅格地图进行标记得到的,包括了机器人正常通过、机器人遇到障碍物和机器人进行沿边行为。
进一步地,所述坐标变化量M的数值设置为2。
进一步地,所述已标记栅格的坐标发生偏移过程中,机器人静止不动;所述已标记栅格的坐标偏移后,机器人当前位置对应的栅格坐标不在栅格地图边界的预设范围内。
进一步地,在所述栅格地图的X-Y平面直角坐标系上, 机器人出发点对应的栅格坐标为(Xn/2,Yn/2)。
一种芯片,用于存储程序,所述程序用于控制机器人执行上述的一种构建栅格地图的控制方法。
一种机器人,包括控制芯片,所述控制芯片为上述的芯片。
本发明的有益效果在于:本发明提供的一种构建栅格地图的控制方法,根据机器人当前位置达到栅格地图边界预设范围的情况,将栅格地图上已标记栅格进行偏移,在不超过所述栅格地图边界的前提下,利用栅格地图中剩余的空白栅格,扩大机器人在栅格地图中可利用的坐标区域,使得机器人在各种地形环境下充分利用栅格地图运动,有效地提高栅格地图利用率,相对于现有技术,算法步骤更为简洁,在系统内存较小的情况下,栅格地图的使用更加合理。
附图说明
图 1为本发明一种构建栅格地图的控制方法流程图;
图2为机器人达到所述栅格地图的边界线X=0的预设范围时,栅格地图中已标记栅格的坐标路径示意图;
图3为附图2中已标记栅格的坐标向X轴正方向偏移Xn-MAXx个栅格后的已标记栅格的坐标路径示意图;
图4为附图2中已标记栅格的坐标向X轴正方向偏移N个栅格后的已标记栅格的坐标路径示意图;
图5为机器人达到所述栅格地图的边界线X=Xn的预设范围时,栅格地图中已标记栅格的坐标路径示意图;
图6为附图5中已标记栅格的坐标向X轴负方向偏移MINx个栅格后的已标记栅格的坐标路径示意图;
图7为附图5中已标记栅格的坐标向X轴负方向偏移N个栅格后的已标记栅格的坐标路径示意图;
图8为栅格地图坐标动态偏移前后标记栅格的变化示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行详细描述。应当理解,下面所描述的具体实施例仅用于解释本发明,并不用于限定本发明。
本发明所述机器人为扫地机器人,通过距离信息传感器所获取的距离信息、角度信息传感器所获得的角度信息、碰撞检测传感器获取的碰撞信息及障碍物检测传感器获取的障碍信息来构建栅格地图,借助于该地图,可以方便地进行自定位和路径规划。本实施采用栅格化处理的地图。
机器人在运行时可以认为是在一个二维平面的运行,在机器人工作区域内任取一点,记该点为原点(0,0),任取一经过原点(0,0)的直线,以该直线为Y 轴,以与Y 轴垂直并相交于原点(0,0)的直线为X 轴,建立X-Y 平面直角坐标系。
本发明所述机器人以弓字型行走,用于清扫空旷区域。在清扫过程会根据实际环境对栅格地图进行标记,比如栅格被标记成黑色表示扫地机器人未使用此栅格,绿色代表样机正常通过的点,红色与蓝色代表障碍物点,白色的点代表此点进行过沿边行为。
针对所述栅格地图的利用率问题,提出了一种构建栅格地图的控制方法,具体步骤包括,步骤S1:当机器人当前位置对应的栅格坐标已经达到栅格地图边界的预设范围时,进入步骤S2,否则跳出步骤S1;步骤S2:判断已标记栅格的坐标偏移结果是否超过所述栅格地图边界的坐标,是则计算出坐标实际变化量,并进入步骤S3,否则跳出步骤S2;步骤S3:根据坐标实际变化量对已标记栅格的坐标进行偏移,所述已标记栅格保持偏移前的状态信息不变。
作为其中一种实施方式,所述控制方法的步骤S1的具体方法包括,步骤S11:在 X-Y平面直角坐标系的第一象限内绘制机器人的工作区域边界线,其坐标取值范围是,即X轴坐标点(Xn,0)所在的垂直X轴的直线X=Xn、X轴坐标点(0,0)所在的垂直X轴的直线X=0、Y轴坐标点(0,Yn)所在的垂直Y轴的直线Y=Yn和Y轴坐标点(0,0)所在的垂直Y轴的直线Y=0作为栅格地图的边界,直线X=0可定义为第一边界,直线X=Xn可定义为第二边界,直线Y=0可定义为第三边界,直线Y=Yn可定义为第四边界,整个栅格地图由所述四条边界围成的区域组成;步骤S12:判断是否,即判断机器人的当前位置与所述栅格地图边界X=0的距离是否小于M,是则确定机器人的当前位置对应的栅格坐标达到所述栅格地图第一边界的预设范围,并进入步骤S2,否则进入步骤S13;步骤S13:判断是否,即判断机器人的当前位置与所述栅格地图边界X=Xn的距离是否小于M,是则确定机器人的当前位置对应的栅格坐标达到所述栅格地图第二边界的预设范围,并进入步骤S2,否则进入步骤S14;步骤S14:判断是否,即判断机器人的当前位置与所述栅格地图边界Y=0的距离是否小于M,是则确定机器人的当前位置对应的栅格坐标达到所述栅格地图第三边界的预设范围,并进入步骤S2,否则进入步骤S15;步骤S15:判断是否,即判断机器人的当前位置与所述栅格地图边界Y=Yn的距离是否小于M,是则确定机器人的当前位置对应的栅格坐标达到所述栅格地图第四边界的预设范围,并进入步骤S2,否则返回步骤S11。所述函数abs表示取机器人当前位置与所述栅格地图边界的距离的绝对值。
作为其中一种实施方式,M表示所述栅格地图边界的预设范围内的坐标变化量,所述坐标变化量M的数值设置为2,使得所述栅格地图边界的预设范围取值适中,有利于本发明所述机器人检测地图边界。
机器人在运动的时候会获取一个实时的位置参数(X,Y),并进行标记,在这过程中,机器人在X轴方向上已标记栅格的最大横坐标记为MAXx,已标记栅格的最小横坐标记为MINx;机器人在Y轴方向上已标记栅格的最大纵坐标记为MAXy,已标记栅格的最小纵坐标记为MINy。
作为其中一种实施方式,附图2至附图7中,将所述栅格地图中已标记栅格的坐标在X轴方向上偏移,至于Y轴方向上已标记栅格的坐标偏移情况同X轴方向上已标记栅格的坐标偏移情况类似,故不再附图说明。abs表示取机器人当前位置对应栅格的坐标到所述栅格地图边界的距离的绝对值。由所述控制方法的步骤S2可知,机器人达到所述地图边界的预设范围时,已标记栅格的坐标预偏移结果是否大于所述栅格地图边界的坐标的具体判断方法如下:
在附图2、附图3和附图4中,带箭头的弓字形虚线是机器人已标记栅格的坐标路径,其中附图3和附图4中已标记栅格的坐标路径是由附图2中已标记栅格的坐标路径偏移过来的。如附图2所示,,机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界X=0的预设范围,判断是否,是则表示所述栅格地图中已标记栅格的最大横坐标加上所述参考变化量N进行预偏移,其结果大于所述栅格地图的边界X=Xn的横坐标,这超出所述栅格地图的覆盖范围,故将附图2中已标记栅格的横坐标加上偏移量Xn-MAXx,使得附图2中已标记栅格的坐标路径偏移得到附图3中已标记栅格的坐标路径,其中附图2的已标记栅格的最大横坐标MAXx加上偏移量Xn-MAXx等于附图3中所述栅格地图的边界X=Xn的横坐标,机器人出发点对应的栅格坐标由附图2的O(Xn/2,Yn/2)变为附图3的O1(Xn/2+Xn-MAXx,Yn/2),机器人当前位置对应的栅格坐标由附图2的(Xc,Yc)变为附图3的(Xc+Xn-MAXx,Yc);否则, 将附图2所述栅格地图中已标记栅格的横坐标加上所述参考变化量N,使得附图2中已标记栅格的坐标路径偏移得到附图4中已标记栅格的坐标路径,其中附图4中已标记栅格的最大横坐标是MAXx+N,机器人出发点对应的栅格坐标由附图2的O(Xn/2,Yn/2)变为附图4的O1(Xn/2+N,Yn/2),机器人当前位置对应的栅格坐标由附图2的(Xc,Yc)变为附图4的(Xc+N,Yc)。所述栅格地图完成坐标偏移过程中,已标记栅格的横坐标都加上相应的坐标偏移量,其纵坐标不变。此时,附图3中机器人当前位置对应的栅格坐标(Xc+Xn-MAXx,Yc)和附图4中机器人当前位置对应的栅格坐标(Xc+N,Yc)都不在对应附图中所述栅格地图边界X=0的预设范围内,机器人实际使用地图相对于所述栅格地图向X轴负方向偏移,其在X轴负方向上可利用的空白栅格增加。如果机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界X=0的预设范围,且所述栅格地图中已标记栅格的最大横坐标等于所述栅格地图的边界X=Xn的横坐标,则所述参考变化量N等于0,所述栅格地图不发生偏移,实际使用的地图长或宽真正达到了整个栅格地图的极限。
在附图5、附图6和附图7中,带箭头的弓字形虚线是机器人已标记栅格的坐标路径,其中附图6和附图7中的已标记栅格的坐标路径是由附图5偏移过来的。如附图5所示,当时,机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界线X=Xn预设范围,判断是否,是则所述栅格地图中已标记栅格的最小横坐标MINx减去所述参考变化量N进行预偏移,其结果小于所述栅格地图的边界线X=0的横坐标,这超出所述栅格地图的覆盖范围,故将附图5中已标记栅格的横坐标减去偏移量MINx,使得附图5中已标记栅格的坐标路径偏移得到附图6中已标记栅格的坐标路径,其中附图5中已标记栅格的最小横坐标MINx减去偏移量MINx等于附图6中所述栅格地图的边界X=0的横坐标,机器人出发点对应的栅格坐标由附图5的O(Xn/2,Yn/2)变为附图6的O1(Xn/2-MINx,Yn/2),机器人当前位置对应的栅格坐标由附图5的(Xc,Yc)变为附图6的(Xc-MINx,Yc);否则,将附图5所述栅格地图中已标记栅格的横坐标减去所述参考变化量N,使得附图5中已标记栅格的坐标路径偏移得到附图7中已标记栅格的坐标路径,其中附图7中已标记栅格的最小横坐标是MINx-N,机器人出发点对应的栅格坐标由附图5的O(Xn/2,Yn/2)变为附图7的O1(Xn/2-N,Yn/2),机器人当前位置对应的栅格坐标由附图5的(Xc,Yc)变为附图7的(Xc-N,Yc)。所述栅格地图完成坐标偏移过程中,已标记栅格的横坐标都减去相应的坐标变化量,其纵坐标不变。附图6中机器人当前位置对应的栅格坐标(Xc- MINx,Yc)和附图7中机器人当前位置对应的栅格坐标(Xc-N,Yc)都不在对应附图中所述栅格地图边界X=Xn的预设范围内,机器人实际使用地图相对于所述栅格地图向X轴正方向偏移,其在X轴正方向上可利用的空白栅格增加。如果机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界X=Xn的预设范围,且所述栅格地图中已标记栅格的最小横坐标等于所述栅格地图的边界X=0的横坐标,所述参考变化量N等于0,所述栅格地图不发生偏移,实际使用的地图长或宽真正达到了整个栅格地图的极限。
当,机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界线Y=0的预设范围,判断是否,是则表示所述栅格地图中已标记栅格的最大纵坐标加上所述参考变化量N进行预偏移,其结果大于所述栅格地图的边界线Y=Yn的纵坐标,这超出所述栅格地图的覆盖范围,故需将所述栅格地图中已标记栅格的坐标的最大纵坐标MAXy加上偏移量Yn-MAXy,其结果等于所述栅格地图的边界线Y=Yn的纵坐标,机器人出发点对应的栅格坐标由(Xn/2,Yn/2)变为(Xn/2,Yn/2+Yn-MAXy),机器人当前位置对应的栅格坐标由(Xc,Yc)变为(Xc,Yc+Yn-MAXy);否则,把所述栅格地图中已标记栅格的纵坐标加上所述参考变化量N,机器人出发点对应的栅格坐标由(Xn/2,Yn/2)变为(Xn/2,Yn/2+N),机器人当前位置对应的栅格坐标由(Xc,Yc)变为(Xc,Yc+N)。所述栅格地图完成坐标偏移过程中,已标记栅格的横坐标不变,其纵坐标都加上相应的坐标偏移量。此时,机器人当前位置对应的栅格坐标不在所述栅格地图边界Y=0的预设范围内,机器人实际使用地图相对于所述栅格地图向Y轴负方向偏移,其在Y轴负方向上可利用的空白栅格增加。如果机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界Y=0的预设范围,且所述栅格地图中已标记栅格的最大纵坐标等于所述栅格地图的边界Y=Yn的纵坐标,则所述参考变化量N等于0,所述栅格地图不发生偏移,实际使用的地图长或宽真正达到了整个栅格地图的极限。
当时,机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界线Y=Yn预设范围,判断是否,是则所述栅格地图中已标记栅格的最小纵坐标MINy减去所述参考变化量N进行预偏移,其结果小于所述栅格地图的边界线Y=0的纵坐标,这超出所述栅格地图的覆盖范围,故需将所述栅格地图中已标记栅格的坐标的最小纵坐标MINy减去偏移量MINy,其结果等于所述栅格地图的边界线Y=0的纵坐标,机器人出发点对应的栅格坐标由O(Xn/2,Yn/2)变为O1(Xn/2,Yn/2-MINx),机器人当前位置对应的栅格坐标由(Xc,Yc)变为(Xc,Yc-MINx);否则,把所述栅格地图中已标记栅格的纵坐标减去所述参考变化量N,机器人出发点对应的栅格坐标由(Xn/2,Yn/2)变为(Xn/2,Yn/2-N),机器人当前位置对应的栅格坐标由(Xc,Yc)变为(Xc,Yc-N)。所述栅格地图完成坐标偏移过程中,已标记栅格的纵坐标都减去相应的坐标偏移量,其横坐标不变。此时,机器人当前位置对应的栅格坐标不在所述栅格地图边界Y=Yn的预设范围内,机器人实际使用地图相对于所述栅格地图向Y轴正方向偏移,其在Y轴正方向上可利用的空白栅格增加。如果机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界Y=Yn的预设范围,且所述栅格地图中已标记栅格的最小纵坐标等于所述栅格地图的边界Y=0的纵坐标,则所述参考变化量N等于0,所述栅格地图不发生偏移,实际使用的地图长或宽真正达到了整个栅格地图的极限。
由所述控制方法的步骤S3可知,根据坐标实际变化量对已标记栅格的坐标进行偏移,所述已标记栅格保持偏移前的状态信息不变。如附图2至附图7所示,由于Y轴方向上已标记栅格的坐标偏移情况同X轴方向上已标记栅格的坐标偏移情况类似,故只对X轴方向上的坐标偏移情况附图说明。abs表示取机器人当前位置对应栅格的坐标到所述栅格地图边界的距离的绝对值。具体的步骤如下:
结合附图1和附图2可知,当,机器人的当前位置对应的栅格坐标达到所述栅格地图的边界X=0的预设范围,在附图3中所述已标记栅格的横坐标加上偏移量Xn-MAXx, 表示所述已标记栅格往X轴正方向偏移Xn-MAXx个栅格,使得已标记栅格的最大横坐标的点偏移到所述栅格地图的边界线X=Xn处,所述已标记栅格保持偏移前的状态信息不变;在附图4中,所述已标记栅格的横坐标加上所述参考变化量N,表示所述已标记栅格往X轴正方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变。假设已标记栅格的最大横坐标MAXx为10, 所述栅格地图的边界X=Xn的横坐标为12,当X<0的区域中存在实际环境边界X=-5,与所述栅格地图边界X=0相差5个栅格,则MAXx+5>Xn,为了避免所述栅格地图偏移超过边界X=12,所述栅格地图中已标记栅格在X轴方向上的偏移量为Xn-MAXx,使得所述栅格地图的覆盖范围从边界X=0开始往X轴负方向偏移2个栅格,不到达实际环境边界X=-5,而已标记栅格的最大横坐标10加上偏移量2等于所述栅格地图的边界X=Xn的横坐标12。当所述实际环境边界X=-1与所述栅格地图边界X=0相差1个栅格时,则MAXx+1≤Xn,所述栅格地图中已标记栅格在X轴方向上的偏移量为1,使得所述栅格地图的覆盖范围从边界X=0开始往X轴负方向偏移1个栅格,机器人实际使用地图的边界与所述实际环境边界X=-1重合,所述栅格地图偏移完成,机器人继续运动,机器人当前位置达到地图边界的预设范围时会停止。
结合附图1和附图5可知,当时,机器人的当前位置对应的栅格坐标(Xc,Yc)达到所述栅格地图的边界线X=Xn的预设范围,在附图6中所述已标记栅格的横坐标减去偏移量MINx,表示所述已标记栅格往X轴负方向偏移MINx个栅格,使得已标记栅格的最小横坐标的点偏移到所述栅格地图的边界线X=0处,所述已标记栅格保持偏移前的状态信息不变;在附图7中所述已标记栅格的横坐标减去所述参考变化量N,表示已标记栅格往X轴负方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变。假设已标记栅格的最小横坐标MINx=2,所述栅格地图的边界X=Xn的横坐标为12,当X>12的区域中存在实际环境边界X=17,与所述栅格地图边界X=12相差5个栅格,则MINx-5<0,为了避免所述栅格地图偏移超过边界X=0,所述栅格地图中已标记栅格在X轴方向上的偏移量为MINx,使得所述栅格地图的覆盖范围从边界X=12开始往X轴正方向偏移2个栅格,不到达实际环境边界X=17,而已标记栅格的最小横坐标2减去偏移量2等于所述栅格地图的边界X=0的横坐标。当所述实际环境边界X=13与所述栅格地图边界X=12相差1个栅格时,则0,所述栅格地图中已标记栅格在X轴方向上的偏移量为1,使得所述栅格地图的覆盖范围从边界X=12开始往X轴正方向偏移1个栅格,机器人实际使用地图的边界与所述实际环境边界X=13重合,所述栅格地图偏移完成,机器人继续运动,机器人当前位置达到地图边界的预设范围时会停止。
当,机器人的当前位置对应的栅格坐标达到所述栅格地图的边界线Y=0的预设范围时,所述已标记栅格的纵坐标加上偏移量Yn-MAXy,表示所述已标记栅格往Y轴正方向偏移Yn-MAXy个栅格,使得已标记栅格的最大纵坐标的点偏移到所述栅格地图的边界线Y=Yn处,所述已标记栅格保持偏移前的状态信息不变;所述已标记栅格的纵坐标加上所述参考变化量N,表示所述已标记栅格往Y轴正方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变。假设已标记栅格的最大纵坐标MAXy=10, 所述栅格地图的边界Y=Yn的纵坐标为12。当Y<0的区域中存在实际环境边界Y=-5,与所述栅格地图边界Y=0相差5个栅格,则MAXy+5>Yn,为了避免所述栅格地图偏移超过边界Y=12,所述栅格地图中已标记栅格在Y轴方向上的偏移量为Yn-MAXy,使得所述栅格地图的覆盖范围从边界Y=0开始往Y轴负方向偏移2个栅格,不会到达实际环境边界Y=-5,而已标记栅格的最大纵坐标10加上偏移量2等于所述栅格地图的边界Y=Yn的纵坐标12。当所述实际环境边界Y=-1与所述栅格地图边界Y=0相差1个栅格时,则MAXy+1≤Yn,所述栅格地图中已标记栅格在Y轴方向上的偏移量为1,使得所述栅格地图的覆盖范围从边界Y=0开始往Y轴负方向偏移1个栅格,机器人实际使用地图的边界与所述实际环境边界Y=-1重合,所述栅格地图偏移完成,机器人继续运动,机器人当前位置达到地图边界的预设范围时会停止。
当时,机器人当前位置对应的栅格坐标达到所述栅格地图的边界线Y=Yn的预设范围时,所述已标记栅格的纵坐标减去偏移量MINy,表示所述已标记栅格往Y轴负方向偏移MINy个栅格,使得已标记栅格的最小纵坐标的点偏移到所述栅格地图的边界线Y=0处,所述已标记栅格保持偏移前的状态信息不变;所述已标记栅格的纵坐标减去所述参考变化量N,表示所述已标记栅格往Y轴负方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变。假设已标记栅格的最小纵坐标MINy=2,所述栅格地图的边界Y=Yn的纵坐标为12。当Y>12的区域中存在实际环境边界Y=17,与所述栅格地图边界Y=12相差5个栅格,则MINy-5<0,为了避免所述栅格地图偏移超过边界Y=0,所述栅格地图中已标记栅格在Y轴方向上的偏移量为MINy,使得所述栅格地图的覆盖范围从边界Y=12开始往Y轴正方向偏移2个栅格,不会到达实际环境边界Y=17,而已标记栅格的最小纵坐标2减去偏移量2等于所述栅格地图的边界Y=0的纵坐标。当所述实际环境边界Y=13与所述栅格地图边界Y=12相差1个栅格时,则0,所述栅格地图中已标记栅格在Y轴方向上的偏移量为1,使得所述栅格地图的覆盖范围从边界Y=12开始往Y轴正方向偏移1个栅格,机器人实际使用地图的边界与所述实际环境边界Y=13重合,所述栅格地图偏移完成,机器人继续运动,机器人当前位置达到地图边界的预设范围时会停止。
作为其中一种实施方式,所述已标记栅格的状态信息是机器人根据实际环境对栅格地图进行标记得到的,包括了机器人正常通过、机器人遇到障碍物和机器人进行沿边行为。所述控制方法的步骤S3中,需要根据坐标实际变化量对已标记栅格的坐标进行偏移,但是所述已标记栅格保持偏移前的状态信息不变。如附图8所示, 的栅格环境中,标记为‘0’的栅格表示机器人正常通过,标记为‘1’的栅格表示机器人遇到障碍物。在栅格地图坐标偏移之前,栅格坐标A(2,3) 处标记为‘0’,栅格坐标B(3,3) 处标记为‘1’; 在栅格地图坐标偏移过程中,B(3,3)偏移到B1(4,3),B1(4,3) 处的栅格标记为‘1’,保留偏移前的状态信息,而B(3,3)对应栅格的状态信息被清除; A(2,3)偏移到A1(3,3),A1(3,3)处的栅格被填充地图的状态信息,标记为‘0’,保留偏移前的状态信息,而A(2,3)对应栅格的状态信息被清除。其中偏移前的A(2,3)和偏移后的A1(3,3)都对应着实际环境中的同一位置,偏移前的B(3,3)和偏移后的B1(4,3)都对应着实际环境中的同一位置。在栅格地图坐标偏移后,X轴负方向上的空白栅格区域面积相对于偏移前的增加,而X轴正方向上的空白栅格区域面积相对于偏移前的减少,X轴负方向上的空白栅格区域增加的面积等于X轴正方向上的空白栅格区域减少的面积,整个栅格地图面积大小不变。这一实施合理、有效地利用栅格地图的空间,提高了机器人建图的灵活性。
作为其中一种实施方式,机器人出发点对应的栅格坐标设置为(Xn/2,Yn/2),即栅格地图工作区域的中心坐标, 能够兼顾到所述栅格地图在四个方向上有足够多的偏移量,使得机器人的出发点位置不因为实际地形而限制移动扫描的范围,提高地图在各个方向上的利用率。
作为其中一种实施方式,所述已标记栅格的坐标发生偏移过程中,机器人静止不动。偏移完成后,地图中的栅格数据更新,机器人实际使用地图相对于整个栅格地图有所偏移,机器人当前位置对应的栅格坐标不在所述栅格地图边界的预设范围内,相对地扩展了机器人可运动区域,但整个栅格地图的覆盖面积大小不变。
本领域普通技术人员可以理解:实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。这些程序可以存储于计算机可读取存储介质(比如ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质)中。该程序在执行时,执行包括上述各方法实施例的步骤。
一种芯片,用于存储程序,所述程序用于控制机器人执行上述栅格地图坐标动态偏移。所述芯片通过检测到机器人的当前位置信息,判断其是否达到栅格地图各个方向上边界的预设范围,然后再根据已标记栅格的坐标预偏移超过边界的情况,计算出栅格地图坐标的坐标实际变化量,并控制所述栅格地图坐标进行偏移。
装配所述芯片作为控制芯片的机器人,在运动过程中检测达到所述栅格地图边界的预设范围内时,停止运动,根据已标记栅格的坐标预偏移超过边界的情况,控制栅格地图坐标进行偏移。待栅格地图坐标偏移完成后,机器人当前位置坐标已经不在所述栅格地图边界的预设范围内,机器人继续运动。机器人达到所述栅格地图边界的预设范围内时,停止运动,再根据已标记栅格的坐标预偏移超过边界的情况,控制所述栅格地图坐标进行偏移。机器人通过偏移栅格地图,尽可能地使用栅格地图中可利用的栅格空间。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (9)
1.一种构建栅格地图的控制方法,其特征在于,包括如下步骤:
步骤S1:当机器人当前位置达到栅格地图边界的预设范围时,进入步骤S2,否则跳出步骤S1;其中,栅格地图边界的预设范围是在栅格地图的覆盖范围内;
步骤S2:判断已标记栅格的坐标预偏移结果是否超过所述栅格地图边界,是则计算出坐标实际变化量,并进入步骤S3,否则跳出步骤S2;
步骤S3:根据坐标实际变化量对已标记栅格的坐标进行偏移,所述已标记栅格保持偏移前的状态信息不变;
所述控制方法的步骤S2的具体方法包括:
步骤S21:abs(Xc-0)≤M时,判断是否MAXx+N>Xn,是则所述已标记栅格的横坐标加上Xn-MAXx,并进入步骤S3,否则加上N,并进入步骤S3;
步骤S22:abs(Xc-Xn)≤M时,判断是否MINx-N<0,是则所述已标记栅格的横坐标减去MINx,并进入步骤S3,否则减去N,并进入步骤S3;
步骤S23:abs(Yc-0)≤M时,判断是否MAXy+N>Yn,是则所述已标记栅格的纵坐标加上Yn-MAXy,并进入步骤S3,否则加上N,并进入步骤S3;
步骤S24:abs(Yc-Yn)≤M时,判断是否MINy-N<0,是则所述已标记栅格的纵坐标减去MINy,并进入步骤S3,否则减去N,并进入步骤S3;
其中MAXx是机器人在X轴方向上已标记栅格的最大横坐标,MINx是机器人在X轴方向上已标记栅格的最小横坐标,MAXy是机器人在Y轴方向上已标记栅格的最大纵坐标,MINy是机器人在Y轴方向上已标记栅格的最小纵坐标,N表示所述栅格地图中已标记栅格的坐标在X轴或Y轴方向上的参考变化量;
其中,所述栅格地图的坐标取值范围是{0≤X≤Xn,0≤Y≤Yn},第一边界是直线X=0,第二边界是直线X=Xn,第三边界是直线Y=0,第四边界是直线Y=Yn,Xc是机器人的当前位置对应栅格的横坐标,Yc是机器人的当前位置对应栅格的纵坐标;M表示为所述栅格地图边界的预设范围内的坐标变化量;abs表示取机器人当前位置与所述栅格地图边界的距离的绝对值。
2.根据权利要求1所述控制方法,其特征在于,所述控制方法的步骤S1的具体方法包括:
步骤S11:在所述栅格地图的X-Y平面直角坐标系的第一象限内绘制机器人工作区域的边界,并记录机器人当前位置对应的栅格坐标,并进入步骤S12;
步骤S12:判断是否abs(Xc-0)≤M,是则确定机器人的当前位置达到所述栅格地图第一边界的预设范围,并进入步骤S2;否则进入步骤S13;
步骤S13:判断是否abs(Xc-Xn)≤M,是则确定机器人的当前位置达到所述栅格地图第二边界的预设范围,并进入步骤S2,否则进入步骤S14;
步骤S14:判断是否abs(Yc-0)≤M,是则确定机器人的当前位置达到所述栅格地图第三边界的预设范围,并进入步骤S2,否则进入步骤S15;
步骤S15:判断是否abs(Yc-Yn)≤M,是则确定机器人的当前位置达到所述栅格地图第四边界的预设范围,并进入步骤S2,否则跳出步骤S1。
3.根据权利要求2所述控制方法,其特征在于,所述控制方法的步骤S3的具体方法包括:
abs(Xc-0)≤M时,如果所述已标记栅格的横坐标加上Xn-MAXx,则所述已标记栅格的坐标往X轴正方向偏移Xn-MAXx个栅格,所述已标记栅格保持偏移前的状态信息不变;如果所述已标记栅格的横坐标加上N,则所述已标记栅格的坐标往X轴正方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变;
abs(Xc-Xn)≤M时,如果所述已标记栅格的横坐标减去MINx,则所述已标记栅格的坐标往X轴负方向偏移MINx个栅格,所述已标记栅格保持偏移前的状态信息不变;如果所述已标记栅格的横坐标减去N,则所述已标记栅格的坐标往X轴负方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变;
abs(Yc-0)≤M时,如果所述已标记栅格的纵坐标加上Yn-MAXy,则所述已标记栅格的坐标往Y轴正方向偏移Yn-MAXy个栅格,所述已标记栅格保持偏移前的状态信息不变;如果所述已标记栅格的纵坐标加上N,则所述已标记栅格的坐标往Y轴正方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变;
abs(Yc-Yn)≤M时,如果所述已标记栅格的纵坐标减去MINy,则所述已标记栅格的坐标往Y轴负方向偏移MINy个栅格,所述已标记栅格保持偏移前的状态信息不变;如果所述已标记栅格的纵坐标减去N,则所述已标记栅格的坐标往Y轴负方向偏移N个栅格,所述已标记栅格保持偏移前的状态信息不变。
4.根据权利要求1或权利要求3中所述控制方法,其特征在于,所述已标记栅格的状态信息是机器人根据实际环境对栅格地图进行标记得到的,包括了机器人正常通过、机器人遇到障碍物和机器人进行沿边行为。
5.根据权利要求2至权利要求3中任一项所述控制方法,其特征在于,所述坐标变化量M的数值设置为2。
6.根据权利要求1至权利要求3中任一项所述控制方法,其特征在于,所述已标记栅格的坐标发生偏移过程中,机器人静止不动;所述已标记栅格的坐标偏移后,机器人当前位置对应的栅格坐标不在栅格地图边界的预设范围内。
7.根据权利要求2所述控制方法,其特征在于,在所述栅格地图的X-Y平面直角坐标系上,机器人出发点对应的栅格坐标设置为(Xn/2,Yn/2)。
8.一种芯片,用于存储程序,其特征在于,所述程序用于控制机器人执行权利要求1至7任一项所述的一种构建栅格地图的控制方法。
9.一种机器人,包括控制芯片,其特征在于,所述控制芯片为权利要求8所述的芯片。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810198945.7A CN108444484B (zh) | 2018-03-12 | 2018-03-12 | 一种构建栅格地图的控制方法和芯片及机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810198945.7A CN108444484B (zh) | 2018-03-12 | 2018-03-12 | 一种构建栅格地图的控制方法和芯片及机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108444484A CN108444484A (zh) | 2018-08-24 |
CN108444484B true CN108444484B (zh) | 2020-09-15 |
Family
ID=63194066
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810198945.7A Active CN108444484B (zh) | 2018-03-12 | 2018-03-12 | 一种构建栅格地图的控制方法和芯片及机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108444484B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108896048A (zh) * | 2018-06-01 | 2018-11-27 | 浙江亚特电器有限公司 | 用于移动载具的路径规划方法 |
CN111693045B (zh) * | 2019-03-13 | 2024-08-23 | 北京奇虎科技有限公司 | 扫地机的清扫路线生成方法及装置 |
CN111700552B (zh) * | 2019-03-18 | 2023-09-01 | 北京奇虎科技有限公司 | 地图尺寸扩充的方法、装置、设备及计算机可读存储介质 |
CN112212863B (zh) * | 2019-07-09 | 2024-08-09 | 苏州科瓴精密机械科技有限公司 | 栅格地图的创建方法及创建系统 |
CN112393737B (zh) * | 2019-08-16 | 2024-03-08 | 苏州科瓴精密机械科技有限公司 | 障碍地图的创建方法、系统,机器人及可读存储介质 |
CN112631267B (zh) * | 2019-10-09 | 2023-01-24 | 苏州宝时得电动工具有限公司 | 自动行走设备控制方法及自动行走设备 |
CN111240322B (zh) * | 2020-01-09 | 2020-12-29 | 珠海市一微半导体有限公司 | 机器人移动限制框的工作起点确定方法及运动控制方法 |
CN112486182B (zh) * | 2020-12-08 | 2022-12-02 | 南通大学 | 一种实现未知环境地图构建与路径规划的扫地机器人及其使用方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103472823B (zh) * | 2013-08-20 | 2015-11-18 | 苏州两江科技有限公司 | 一种智能机器人用的栅格地图创建方法 |
CN104035444B (zh) * | 2014-06-27 | 2016-08-24 | 东南大学 | 机器人地图构建存储方法 |
WO2017167207A1 (zh) * | 2016-03-29 | 2017-10-05 | 苏州宝时得电动工具有限公司 | 自动工作系统及其工作区域的地图建立方法 |
CN106248084A (zh) * | 2016-10-14 | 2016-12-21 | 广西师范大学 | 一种室内定位导航系统及其数据处理方法 |
CN106908775B (zh) * | 2017-03-08 | 2019-10-18 | 同济大学 | 一种基于激光反射强度的无人车实时定位方法 |
CN106873601B (zh) * | 2017-04-11 | 2020-01-21 | 珠海市一微半导体有限公司 | 栅格地图构建中的地图平移控制方法 |
CN107560620B (zh) * | 2017-08-31 | 2019-12-20 | 珠海市一微半导体有限公司 | 一种路径导航方法和芯片及机器人 |
CN107478232B (zh) * | 2017-09-18 | 2020-02-21 | 珠海市一微半导体有限公司 | 机器人导航路径的搜索方法 |
-
2018
- 2018-03-12 CN CN201810198945.7A patent/CN108444484B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108444484A (zh) | 2018-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108444484B (zh) | 一种构建栅格地图的控制方法和芯片及机器人 | |
CN107065872B (zh) | 智能机器人的栅格地图创建方法 | |
WO2021135645A1 (zh) | 一种地图更新方法及装置 | |
CN111596662B (zh) | 一种沿全局工作区域一圈的判断方法、芯片及视觉机器人 | |
AU2019278049B2 (en) | Route planning method for mobile vehicle | |
CN111580525B (zh) | 沿边行走中返回起点的判断方法、芯片及视觉机器人 | |
CN110006430B (zh) | 一种航迹规划算法的优化方法 | |
EP3611590B1 (en) | Method for creating grid map of intelligent robot | |
CN107544507A (zh) | 可移动机器人移动控制方法及装置 | |
CN109828579B (zh) | 一种目标增量移动的移动机器人路径规划方法 | |
WO2022142858A9 (zh) | 机器人移动路径规划方法、确定规划的路径点偏离历史路径程度的方法、装置、机器人及计算机可读存储介质 | |
JP2023508662A (ja) | グローバルグリッドマップにおけるマップトラバースブロックの構築方法、チップ、及び移動ロボット | |
CN114543815B (zh) | 基于基因调控网络的多智能体导航控制方法、设备及介质 | |
CN110477813B (zh) | 一种激光式清洁机器人及其控制方法 | |
CN111949017A (zh) | 一种机器人越障的沿边路径规划方法、芯片及机器人 | |
CN115423846A (zh) | 多目标轨迹跟踪方法以及装置 | |
WO2024193095A1 (zh) | 一种地图自动更新方法及系统、存储介质 | |
CN114035572A (zh) | 一种割草机器人的避障巡回方法及系统 | |
CN106873601B (zh) | 栅格地图构建中的地图平移控制方法 | |
WO2024179092A1 (zh) | 一种2d激光雷达定位与建图方法及系统 | |
CN117250957A (zh) | 路径跟踪控制关键参考点选取方法、装置、设备和介质 | |
CN114353814B (zh) | 基于Angle-Propagation Theta*算法改进的JPS路径优化方法 | |
CN116300876A (zh) | 一种多智能体未知环境自主协同探索方法、系统、装置及存储介质 | |
CN113625301B (zh) | 一种基于单扫描头激光雷达扩大建图视场的方法及系统 | |
Zhi et al. | Research on path planning of mobile robot based on A* algorithm |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP03 | Change of name, title or address | ||
CP03 | Change of name, title or address |
Address after: 519000 2706, No. 3000, Huandao East Road, Hengqin new area, Zhuhai, Guangdong Patentee after: Zhuhai Yiwei Semiconductor Co.,Ltd. Country or region after: China Address before: Room 105-514, No.6 Baohua Road, Hengqin New District, Zhuhai City, Guangdong Province Patentee before: AMICRO SEMICONDUCTOR Co.,Ltd. Country or region before: China |