CN104932494B - 一种概率式室内障碍物分布图的构建机制 - Google Patents
一种概率式室内障碍物分布图的构建机制 Download PDFInfo
- Publication number
- CN104932494B CN104932494B CN201510206078.3A CN201510206078A CN104932494B CN 104932494 B CN104932494 B CN 104932494B CN 201510206078 A CN201510206078 A CN 201510206078A CN 104932494 B CN104932494 B CN 104932494B
- Authority
- CN
- China
- Prior art keywords
- robot
- distribution
- obstacles
- barrier
- grid member
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出一种概率式室内障碍物分布图的构建机制,主要步骤如下:1)将室内区域看作由基本栅格元组成,所述栅格元为正方形,其大小为u;2)将机器人前进步长设为s,s=n*u,其中n≥1,n为整数;3)设定上次探索结果中最大未知区域的中心位置为出发点,机器人每前进一步探测前方是否有障碍物;如果有,将栅格元的属性设为有障碍物;否则,将栅格元的属性设为无障碍物。在探测过程中,为避免机器人在一个三面有障碍的地方转不出来,通过概率p来选择转向的方向,设p>0.5。同时,探索结束的步长数预设值可自适应于清扫区域大小。本发明的障碍物分布图构建机制可以快速探明室内边界,构建非规则室内障碍物分布图,可以从一个三面有障碍物的地方转出来。
Description
技术领域
本发明涉及障碍物分布图的构建,特别是指一种概率式室内障碍物分布图的构建机制。
背景技术
随着机器人的应用越来越广泛,人们对机器人的要求不断提高,服务机器人作为机器人应用中的重要分支,其在生产生活中的重要性也逐渐体现出来。机器人要在室内完成某项任务,首先要构建室内障碍物分布图,室内障碍物分布图的构建是机器人研究中最基础,同时也是最重要的问题,如何使得机器人快速探明室内边界,如何避免机器人在遇到障碍物时迅速转出来,如何在非规则的室内建立障碍物分布图是本领域的技术人员需要继续研究的问题。
目前,清洁机器人大都采用直行清扫方式,无法直行就随机转一角度继续直行,该方法算法简单,硬件结构简易,但效率比较低。相关资料表明:随机规划通常第一遍可覆盖清洁区域的65%,第二遍覆盖85%,第三遍覆盖92%,第四遍覆盖98%,不惜时间的话可以趋向100%。但实际上,由于清洁机器人自带电池,电量有限,结合能量消耗和清洁重置率等参数,这种盲目的随机清扫方式的清扫效率是很难令人满意的。
所以,本发明旨在机器人清扫之前探索障碍物的分布图,并且将该信息存储于云平台。机器人下次探索障碍物分布的时候,可以利用以前的信息,进而提高障碍物分布图的构建速度和精度。
发明内容
本发明提出一种概率式室内障碍物分布图的构建机制解决了现有技术中机器人很难快速探明边界,遇到障碍物不能从一个有三面障碍物的地方转出来,不能对非规则的室内建立障碍物分布图的问题。
本发明的技术方案是这样实现的:一种概率式室内障碍物分布图的构建机制,包括以下步骤:
步骤一:将室内区域看作由很多基本栅格元组成,所述栅格元为正方形,栅格元的大小为u;栅格元越小,分布图越精确,栅格单元大小大于等于机器人方向的误差,栅格单元大小可以设为5cm或10cm。
步骤二:将机器人前进步长设置为s,s=n*u,其中n≥1,n为整数;
步骤三:设定机器人的出发点,机器人每前进一步探测前方是否有障碍物;机器人遇到障碍物,将栅格元的属性状态设置为有障碍物;机器人没有遇到障碍物,将栅格元的属性状态设置为无障碍物。
由于机器人第一次无法获悉整个室内的边沿所在,所以,目标室内障碍物的整体分布是在不断地修正过程中,包括室内的边沿,即在探索过程中室内地图会变得完整。
进一步,所述概率式室内障碍物分布图的构建机制还包括步骤四,根据上一次的探测结果确定机器人下一次的出发点:选择上一次探索结果中的最大未知区域的中心位置作为出发点,重复步骤三。
进一步,所述概率式室内障碍物分布图的构建机制还包括步骤五:机器人回到原点或者机器人所走步长达到预设值,探索则结束。
进一步,将栅格元的属性状态设置为0或1,其中0表示无障碍物,其中1表示有障碍物。机器人不断地探索,每次探索的结果和之前的分布图进行比较,不断地刷新分布图中栅格元的属性,或添加带属性的栅格元,其属性可能是0也可能是1。那么,经过很多次探索过程后,室内的边沿,以及障碍物分布情况会得到确认,从而构建完整的室内障碍物分布图。
进一步,控制***控制机器人的行进路线为折线,设置机器人的出发点为原点,将机器人的位置坐标设定为D=(x,y),x、y的单位均为u,机器人往正前方前进一个步长,则x加1,y保持不变;往正后方前进一个步长,则x减1,y保持不变;往正左方前进一个步长,则x保持不变,y加1;往正右方前进一个步长,则x保持不变,y减1,机器人在行进过程中记录的信息为I={(x,y)=0∪(x,y)=1},I存储在云平台,然后根据I计算出障碍物分布图;同时,该分布图也存储于云平台,后续的探索可以从中学习到知识,进而提高障碍物分布图构建的速度和精度。
进一步,所述机器人由四轮驱动,通过控制***控制机器人朝四个方向前进或者转动。
进一步,控制***控制机器人每转动一次转动90°。
进一步,设定n=1,机器人前进距离大于0.5u,栅格元的属性状态设置为无障碍物。
进一步,设置控制***控制机器人遇到障碍物时顺时针旋转90°的概率为p,其中p>0.5。
进一步,控制***控制机器人朝一个方向行进,直到遇到障碍物逆时针或顺时针旋转90°。
本发明的有益效果为:本发明的概率式室内障碍物分布图的构建机制适用于实际的工作环境,构建方法简单宜行。通过控制***控制机器人朝四个方向前进或者转动,每次朝一个方向,直到不能走为止。在此种模式下,机器人遇到障碍物后,改变90度,然后,沿着此方向继续前进。周而复始地进行这个过程,可以快速地探明室内的边沿。为了避免机器人在一个三面有障碍物的地方转圈而出不来,我们通过概率p来选择转向的方向。为了避免原地不动,我们设p>0.5。对于非规则的室内,采用类似于积分的思想,机器人前进距离超过0.5u,即可认为该栅格元无障碍物。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明一种概率式室内障碍物分布图的构建机制一个实施例的方法流程图;
图2为本发明一种概率式室内障碍物分布图的构建机制构建的一个实施例的室内障碍物分布图;
图3为发明一种概率式室内障碍物分布图的构建机制中机器人方向向量的状态转移图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
一种概率式室内障碍物分布图的构建机制,包括以下步骤:
步骤一:将室内区域看作由很多基本栅格元组成,所述栅格元为正方形,栅格元的大小为u;栅格元越小,分布图越精确,栅格单元大小大于等于机器人方向的误差,栅格单元大小可以设为5cm或10cm;
步骤二:将机器人前进步长设置为s,s=n*u,其中n≥1,n为整数;
步骤三:机器人每前进一步探测前方是否有障碍物;机器人遇到障碍物,将栅格元的属性状态设置为有障碍物;机器人没有遇到障碍物,将栅格元的属性状态设置为无障碍物。本实施例中,设定n=1,机器人前进距离大于0.5u,栅格元的属性状态设置为无障碍物。
由于机器人第一次无法获悉整个室内的边沿所在,所以,目标室内障碍物的整体分布是在不断地修正过程中,包括室内的边沿,即在探索过程中室内地图会变得完整。
步骤四,根据上一次的探测结果确定机器人下一次的出发点:选择上一次探索结果中的最大未知区域的中心位置作为出发点,重复步骤三。
步骤五:机器人回到原点或者机器人所走步长达到预设值探索结束。
按下列方法确定第i次探索结束的步长数Li,Li由如下公式确定:
Li=(1-δ)×(Li-1)+δ×(Qi-1*1.1)(i=2,3,4……)
当i=1时,即第一次探索时,L1等于A,A是与探索区域大小相关的一个常数,100≥A≥10。Qi表示第i次探索结束后分布图的栅格数量总和。δ是更新调节因子,1>δ>0,本实施例δ设为0.7。
将栅格元的属性状态设置为0或1,其中0表示无障碍物,其中1表示有障碍物。机器人不断地探索,每次探索的结果和之前的分布图进行比较,不断地刷新分布图中栅格元的属性,或添加带属性的栅格元,其属性可能是0也可能是1。那么,经过很多次探索过程后,室内的边沿,以及障碍物分布情况会得到确认,从而构建完整的室内障碍物分布图。所述机器人由四轮驱动,通过控制***控制机器人朝四个方向前进或者转动。
控制***控制机器人的行进路线为折线,设置机器人的出发点为原点,将机器人的位置坐标设定为D=(x,y),x、y的单位均为u,机器人往正前方前进一个步长,即设定方向矢量(E=1,N=0),则x加1,y保持不变;往正后方前进一个步长,即设定方向矢量(E=-1,N=0),则x减1,y保持不变;往正左方前进一个步长,即设定方向矢量(E=0,N=1),则x保持不变,y加1;往正右方前进一个步长,即设定方向矢量(E=0,N=-1),则x保持不变,y减1,机器人在行进过程中记录的信息为I={(x,y)=0∪(x,y)=1},I存储在云平台,然后根据I计算出障碍物分布图。同时,该分布图也存储于云平台,后续的探索可以从中学习到知识,进而提高障碍物分布图构建的速度和精度。
如图1所示,概率式室内障碍物分布图的构建机制方法流程图:
开始后,设置机器人的出发点为原点,机器人朝一个方向行进,直到遇到障碍物不能走,将方向矢量初始化:(E=0,N=1),机器人不转向,前进一个步长;设置方向矢量(E,N),如图3所示,方向矢量(E,N)的状态转移图,遇到障碍物,设定(x,y)=1,栅格元的属性状态设置为1;未遇到障碍物,设定(x,y)=0,栅格元的属性状态设置为0;遇到障碍物时判断是否到达原点,达到原点,即x=0and y=0,结束任务,或者第i次探索时,步长数LS到达设定值Li,结束任务;未达到原点并且LS未到设定值,即(x≠0ory≠0)and LS<Li,控制***控制机器人顺时针转向90°或者逆时针转向90°,其中控制***控制机器人顺时针转向90°的概率大于0.5,然后继续不转向前进一个步长,设置方向矢量并判断是否遇到障碍物;未遇到障碍物时,判断是否达到原点,到达原点则结束任务,或者第i次探索时,步长数LS到达设定值Li,达到设定值结束任务,未达到原点并且LS未到设定值,即(x≠0ory≠0)and LS<Li,则不转向,前进一个步长,重复上述步骤,最后得到如图2所示的室内障碍物分布图,黑色的正方形表示遇到障碍物,栅格元的属性状态设置为1,白色的正方形表示未遇到障碍物,栅格元的属性状态设置为0。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种概率式室内障碍物分布图的构建机制,其特征在于,包括以下步骤:
步骤一:将室内区域看作由很多基本栅格元组成,所述栅格元为正方形,栅格元的大小为u;
步骤二:将机器人前进步长设置为s,s=n*u,其中n≥1,n为整数;
步骤三:设定机器人的出发点,机器人每前进一步探测前方是否有障碍物;机器人遇到障碍物,将栅格元的属性状态设置为有障碍物;机器人没有遇到障碍物,将栅格元的属性状态设置为无障碍物;
控制***控制机器人的行进路线为折线,机器人每转动一次转动90°;设置控制***控制机器人遇到障碍物时顺时针旋转90°的概率为p,其中p>0.5;
设置机器人的出发点为原点,将机器人的位置坐标设定为D=(x,y),x、y的单位均为u,机器人往正前方前进一个步长,则x加1,y保持不变;往正后方前进一个步长,则x减1,y保持不变;往正左方前进一个步长,则x保持不变,y加1;往正右方前进一个步长,则x保持不变,y减1;
机器人在行进过程中记录的信息为I={(x,y)=0∪(x,y)=1},I存储在云平台,然后根据I计算出障碍物分布图;同时,该分布图也存储于云平台,后续的探索可以从中学习到知识,进而提高障碍物分布图构建的速度和精度;
步骤四:根据上一次的探测结果确定机器人下一次的出发点:选择上一次探索结果中的最大未知区域的中心位置作为出发点,重复步骤三。
2.如权利要求1所述的概率式室内障碍物分布图的构建机制,其特征在于:所述概率式室内障碍物分布图的构建机制还包括步骤五:机器人回到原点或者机器人所走步长达到预设值探索结束。
3.如权利要求1或2所述的概率式室内障碍物分布图的构建机制,其特征在于:将栅格元的属性状态设置为0或1,其中0表示无障碍物,其中1表示有障碍物。
4.如权利要求3所述的概率式室内障碍物分布图的构建机制,其特征在于:所述机器人由四轮驱动,通过控制***控制机器人朝四个方向前进或者转动。
5.如权利要求4所述的概率式室内障碍物分布图的构建机制,其特征在于:
设定n=1,机器人前进距离大于0.5u,栅格元的属性状态设置为无障碍物。
6.如权利要求1所述的概率式室内障碍物分布图的构建机制,其特征在于:控制***控制机器人朝一个方向行进,直到遇到障碍物逆时针或顺时针旋转90°。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510206078.3A CN104932494B (zh) | 2015-04-27 | 2015-04-27 | 一种概率式室内障碍物分布图的构建机制 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510206078.3A CN104932494B (zh) | 2015-04-27 | 2015-04-27 | 一种概率式室内障碍物分布图的构建机制 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104932494A CN104932494A (zh) | 2015-09-23 |
CN104932494B true CN104932494B (zh) | 2018-04-13 |
Family
ID=54119698
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510206078.3A Active CN104932494B (zh) | 2015-04-27 | 2015-04-27 | 一种概率式室内障碍物分布图的构建机制 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104932494B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105136155B (zh) * | 2015-09-24 | 2018-12-14 | 联想(北京)有限公司 | 一种导航方法及电子设备 |
CN107463168A (zh) * | 2016-06-06 | 2017-12-12 | 苏州宝时得电动工具有限公司 | 定位方法及***、地图构建方法和***、自动行走设备 |
CN108500977B (zh) * | 2017-01-09 | 2020-07-24 | 广东宝乐机器人股份有限公司 | 一种机器人的移动控制方法及机器人 |
US20220171399A1 (en) * | 2017-05-26 | 2022-06-02 | Hangzhou Hikrobot Technology Co., Ltd. | Method for detecting presence probability of obstacle in unknown position, terminal, and storage medium |
CN109917791B (zh) * | 2019-03-26 | 2022-12-06 | 深圳市锐曼智能装备有限公司 | 移动装置自动探索构建地图的方法 |
CN112180910B (zh) * | 2019-06-18 | 2024-07-19 | 北京京东乾石科技有限公司 | 一种移动机器人障碍物感知方法和装置 |
CN111813102B (zh) * | 2020-06-06 | 2023-11-21 | 浙江中力机械股份有限公司 | 一种分布式自主机器人环境地图构建方法 |
CN114148350B (zh) * | 2021-12-21 | 2024-07-23 | 北京三快在线科技有限公司 | 一种无人设备的控制方法及装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101619985A (zh) * | 2009-08-06 | 2010-01-06 | 上海交通大学 | 基于可变形拓扑地图的服务机器人自主导航方法 |
KR101207535B1 (ko) * | 2010-12-31 | 2012-12-03 | 한양대학교 산학협력단 | 이동 로봇의 이미지 기반 동시적 위치 인식 및 지도 작성 방법 |
CN103278170A (zh) * | 2013-05-16 | 2013-09-04 | 东南大学 | 基于显著场景点检测的移动机器人级联地图创建方法 |
CN103512579A (zh) * | 2013-10-22 | 2014-01-15 | 武汉科技大学 | 一种基于热红外摄像机和激光测距仪的地图构建方法 |
CN103809597A (zh) * | 2014-02-18 | 2014-05-21 | 清华大学 | 无人机的飞行路径规划方法及无人机 |
CN103914068A (zh) * | 2013-01-07 | 2014-07-09 | 中国人民解放军第二炮兵工程大学 | 一种基于栅格地图的服务机器人自主导航方法 |
CN104199428A (zh) * | 2014-09-17 | 2014-12-10 | 上海畔慧信息技术有限公司 | 群体机器人管理服务器及其方法 |
-
2015
- 2015-04-27 CN CN201510206078.3A patent/CN104932494B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101619985A (zh) * | 2009-08-06 | 2010-01-06 | 上海交通大学 | 基于可变形拓扑地图的服务机器人自主导航方法 |
KR101207535B1 (ko) * | 2010-12-31 | 2012-12-03 | 한양대학교 산학협력단 | 이동 로봇의 이미지 기반 동시적 위치 인식 및 지도 작성 방법 |
CN103914068A (zh) * | 2013-01-07 | 2014-07-09 | 中国人民解放军第二炮兵工程大学 | 一种基于栅格地图的服务机器人自主导航方法 |
CN103278170A (zh) * | 2013-05-16 | 2013-09-04 | 东南大学 | 基于显著场景点检测的移动机器人级联地图创建方法 |
CN103512579A (zh) * | 2013-10-22 | 2014-01-15 | 武汉科技大学 | 一种基于热红外摄像机和激光测距仪的地图构建方法 |
CN103809597A (zh) * | 2014-02-18 | 2014-05-21 | 清华大学 | 无人机的飞行路径规划方法及无人机 |
CN104199428A (zh) * | 2014-09-17 | 2014-12-10 | 上海畔慧信息技术有限公司 | 群体机器人管理服务器及其方法 |
Non-Patent Citations (1)
Title |
---|
智能移动机器人路径规划方法研究;隋岩;《中国优秀硕士学位论文全文数据库信息科技辑》;20110515;论文第14-23页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104932494A (zh) | 2015-09-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104932494B (zh) | 一种概率式室内障碍物分布图的构建机制 | |
CN109144102A (zh) | 一种基于改进蝙蝠算法的无人机航路规划方法 | |
CN106228819B (zh) | 一种多交叉口的交通信号优化控制方法及装置 | |
CN109254588B (zh) | 一种基于交叉变异鸽群优化的无人机集群协同侦察方法 | |
CN109974737B (zh) | 基于安全疏散标志和强化学习结合的路径规划方法及*** | |
CN108762264A (zh) | 基于人工势场与滚动窗口的机器人的动态避障方法 | |
CN110332943A (zh) | 一种快速遍历的机器人全覆盖路径规划方法 | |
CN111290398B (zh) | 基于生物启发神经网络和强化学习的无人艇路径规划方法 | |
CN107885209A (zh) | 一种基于动态窗口与虚拟目标点的避障方法 | |
CN111562785B (zh) | 一种群集机器人协同覆盖的路径规划方法及*** | |
CN109521794A (zh) | 一种多无人机航路规划及动态避障方法 | |
CN110471444A (zh) | 基于自主学习的无人机智能避障方法 | |
CN107037809A (zh) | 一种基于改进蚁群算法的无人艇避碰方法 | |
CN109945873A (zh) | 一种用于室内移动机器人运动控制的混合路径规划方法 | |
CN109407705A (zh) | 一种无人机躲避障碍物的方法、装置、设备和存储介质 | |
CN104757911B (zh) | 智能扫地机器人的清扫方法及智能扫地机器人 | |
CN110991972A (zh) | 一种基于多智能体强化学习的货物运输*** | |
CN109318890A (zh) | 一种基于动态窗口及障碍物势能场的无人车动态避障方法 | |
CN106873599A (zh) | 基于蚁群算法和极坐标变换的无人自行车路径规划方法 | |
CN105717929A (zh) | 一种多分辨率障碍物环境下移动机器人混合路径规划方法 | |
CN113341984A (zh) | 基于改进rrt算法的机器人路径规划方法和装置 | |
Nishimura et al. | L2b: Learning to balance the safety-efficiency trade-off in interactive crowd-aware robot navigation | |
CN110345948A (zh) | 基于神经网络与q学习算法结合的动态避障方法 | |
CN109300144A (zh) | 一种融合社会力模型和卡尔曼滤波的行人轨迹预测方法 | |
CN107992040A (zh) | 基于地图栅格与qpso算法结合的机器人路径规划方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |