[发明专利]机器人地图构建存储方法有效
| 申请号: | 201410305239.X | 申请日: | 2014-06-27 |
| 公开(公告)号: | CN104035444A | 公开(公告)日: | 2014-09-10 |
| 发明(设计)人: | 王兴松;郑鑫 | 申请(专利权)人: | 东南大学 |
| 主分类号: | G05D1/02 | 分类号: | G05D1/02 |
| 代理公司: | 江苏永衡昭辉律师事务所 32250 | 代理人: | 王斌 |
| 地址: | 210096*** | 国省代码: | 江苏;32 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 机器人 地图 构建 存储 方法 | ||
1.一种机器人地图构建存储方法,其特征在于,该方法包括以下步骤:
1)将基站坐标设为机器人起始坐标(x0,y0),并设定机器人从基站出发时,工作区域内x坐标的最大值xmax的初始值、最小值xmin的初始值,y坐标的最大值ymax的初始值、最小值ymin的初始值分别为xmax=x0,xmin=x0,ymax=y0,ymax=y0;
2)然后机器人从基站出发,沿着工作区域的边界线运行一周后返回基站,运行过程中,按照如下方式不断更新x坐标的最大值xmax、最小值xmin,y坐标的最大值ymax、最小值ymin:
在任意i时刻分别对比坐标(xi,yi)与上一次更新的xmax、xmin、ymax、ymin的大小关系,若xi<xmin则xmin=xi,否则xmin的值保持不变,若xi>xmax则xmax=xi,否则xmax的值保持不变,若yi<ymin则ymin=yi,否则ymin的值保持不变,若yi>ymax则ymax=yi,否则ymax的值保持不变,其中,(xi,yi)为i时刻时机器人的坐标;
3)根据机器人沿边界线运行一周后最终更新得到的xmax、xmin、ymax、ymin,确定表征边界线最大范围的四个坐标点分别为(xa,ymax)、(xb,ymin)、(xmax,ya)、(xmin,yb),其中xa为ymax对应的横坐标、xb为ymin对应的横坐标,ya为xmax对应的横坐标,yb为xmin对应的横坐标;
然后根据这四个表征边界线最大范围的坐标计算出工作区域内x坐标最大差值Xmax=xmax-xmin和y坐标最大差值Ymax=ymax-ymin;
同时计算出工作区域的中心坐标(xc,yc),其中,xc=[(xmax+xmin)2],yc=[(ymax+ymin)2];
4)根据下式计算出表征地图大小的参数n:
n=[X/2Δ]+1;
其中Δ为正方形地图栅格的边长,X为工作区域最大范围内x坐标最大差值Xmax和y坐标最大差值Ymax的较大值,即当Xmax≥Ymax时,X=Xmax,而Xmax<Ymax时,X=Ymax;
5)根据表征地图大小的参数n实现地图数据与存储单元地址的映射,具体方法为:
将所有地图栅格的数据按照{xi,yi,地图栅格属性}的格式存储在存储单元中,其中每个地图栅格数据占用存储单元空间大小为m字节,地图中心坐标(xc,yc)存储在存储单元的起始地址,该起始地址在存储单元中与最小地址的偏移量为k,k≥0,其他坐标(xi,yi)的存储位置根据下式求得的该坐标与最小地址的偏移量来确定:
M(2n+1)m+Nm+k;
其中,M、N由以下方法确定:
L1=(xi-xc)/Δ,L2=(yi-yc)/Δ;
当L1>0时,M=2|L1|,当L1<0时,M=2|L1|-1;
当L2>0时,N=2|L2|,当L2<0时,N=2|L2|-1。
2.根据权利要求1所述的机器人地图构建存储方法,其特征在于,所述步骤5)中的地图栅格属性由多种与机器人地图相关的元素组成,包括用于表征地图栅格内的环境的属性和表征机器人是否经过此地图栅格的属性。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于东南大学,未经东南大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201410305239.X/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种分区锅
- 下一篇:一种酱鸡及其生产工艺





