一种基于二进制指数统计高效角落避障方法

文档序号:9615862阅读:307来源:国知局
一种基于二进制指数统计高效角落避障方法
【技术领域】
[0001]本发明涉及一种基于统计方式的避障方法,尤其涉及一种降低机器人陷入困境概率的避障方法。
【背景技术】
[0002]随着计算机技术的发展,机器人研究成为一个热点,目前机器人已经被应用于社会多个领域。室内移动机器人是一种低速运行的机器人,在室内环境中进行各种活动,已经逐渐发展成机器人研究的一个重要方向。
[0003]自主导航和环境探索是移动机器人实现自主控制的关键技术,包括环境感知、定位和路径规划等。动态避障是自主移动机器人基本的安全运动要求,也是机器人实现自主作业的关键。尤其是在室内作业环境中,障碍物形状复杂、摆放零乱,当机器人运行到一个角落时,有可能被困在一个角落环境中。因此,为了保障机器的正常作业,快速、有效的实时避障方法非常重要。

【发明内容】

[0004]为了能够使机器人快速的离开角落,本发明提供了一种基于二进制指数统计高效角落避障方法。
[0005]本发明第一个方面提供一种基于二进制指数统计高效角落避障方法,所述方法包括:
[0006]机器人在前进方向扫描出扇形区域,扇形圆心为顶点的射线将扇形区域分为左半区和右半区;
[0007]步骤1,机器人对左半区和右半区进行扫描,发现障碍物时:
[0008]—一机器人判断出障碍物出现在其中一个半区时,机器人以第一预定角度向另一个半区方向转向;
[0009]一一机器人判断出障碍物同时出现在两个半区时,比较两个半区障碍物到机器人的平均距离,选择相对较大平均距离的障碍物所在半区方向,以第一预定角度转向;
[0010]其中,转向第一方向计录为1,转向第二方向计录为0 ;当机器人出现1010的循环统计数据后,则认为进入角落,并以第二预定角向第二方向转向;当机器人出现0101的循环统计数据后,则认为进入角落,并以第二预定角度向第一方向转向,其中第二预定角度大于第一预定角度;
[0011]步骤2,继续扫描障碍物并重新统计转向数据:
[0012]—一如果在扫描区域内未发现障碍物,则表示离开角落;
[0013]——如果仍然出现1010的循环统计数据,则以比前一次转向更大的角度向第二方向转向,如果仍然出现0101的循环统计数据,则以更大角度向第一方向转向;
[0014]重复步骤2,直至扫描区域内未发现障碍物。
[0015]本发明还提供了一种机器人,包括距离传感器,所述距离传感器在机器人正面扫描出一个扇形区域,并且通过以扇形区域圆心为顶点的射线将扇形区域分成左半区和右半区;其中:
[0016]所述距离传感器对左半区和右半区是否存在障碍物、以及障碍物距离进行判断:
[0017]—一机器人判断出障碍物出现在其中一个半区时,机器人以第一预定角度向另一个半区方向转向;
[0018]一一机器人判断出障碍物同时出现在两个半区时,比较两个半区障碍物到机器人的平均距离,选择相对较大平均距离的障碍物所在半区方向,以第一预定角度转向;
[0019]其中,转向第一方向计录为1,转向第二方向计录为0 ;当机器人出现1010的循环统计数据后,则认为进入角落,并以第二预定角向第二方向转向;当机器人出现0101的循环统计数据后,则认为进入角落,并以第二预定角度向第一方向转向,其中第二预定角度大于第一预定角度;
[0020]机器人继续扫描障碍物并重新统计转向数据:
[0021]—一如果在扫描区域内未发现障碍物,则表示离开角落;
[0022]——如果仍然出现1010的循环统计数据,则以比前一次转向更大的角度向第二方向转向,如果仍然出现0101的循环统计数据,则以比前一次转向更大的角度向第一方向转向;
[0023]机器人重复扫描和统计转向数据,直至扫描区域内未发现障碍物。
[0024]本发明上述内容中,所述“比前一次转向更大的角度”可以是连续多次向同一个方向转动来实现,比如连续两次转向,所述连续两次转向角度之和大于前一次转向角度。
[0025]在本发明的一种优选实施例中,所述循环统计数据统计至少为2次循环,更优选为至少5次循环,更优选为至少10次循环。
[0026]在本发明的一种优选实施例中,机器人离开角落后,重置之前统计的数据。
[0027]在本发明的一种优选实施例中,机器人运行距离多自身长度的1.5倍时,重置之前的统计的数据,更优选为运行距离多自身长度的2倍时,重置之前的统计的数据。
[0028]在本发明的一种优选实施例中,所述扇形区域角度优选为至少45°,更优选为至少60°,更优选为至少90°,更优选为90-120°。
[0029]本发明是一种基于统计方式的避障算法,能够帮助机器人判定当前的是否陷入一个死角中,并同过3-4次的探索就能够从角落中离开,降低了机器人陷入困境的概率。基于此,本发明所提供的方法和机器人,能够快速的从角落中离开,避免了复杂的计算过程和计算模块。
【附图说明】
[0030]图1为机器人扫描扇形区域示意图;
[0031]图2为一种优选实施例中机器人转向过程判断示意图。
[0032]
【具体实施方式】
[0033]下面结合附图1-2、通过实施例对本发明所述基于二进制指数统计高效角落避障方法和机器人进行详细的介绍和描述,以使本
【发明内容】
能够被更清楚的理解。但是,应当理解的是,下面实施例并不限制本发明范围。
[0034]实施例1
[0035]参照图1,机器人1从距离传感器2的扫描区域中选取出一个中心扇形区域作为有效避障区域。以中点C为分界线,L0C区域31作为机器人的左边障碍物扫描区域,R0C区域作32为机器人的右边扫描区域,根据机器人的扇形扫描区域,获取左半边和右半边两个区域中障碍物到机器人的平均距离left_avg和right_avg,通过比较左右两个区域中障碍物到机器人的平均距离来选择避障的转向。
[0036]参照图2,在前进的过程中当障碍物出现在有效扫描区域时:
[0037]当左边的障碍物到机器人的平均距离left_avg大于右边的障碍物到机器人的平均距离right_avg,表示机器人左边的障碍物距离较远,机器人会向左转向,并记录转向标识1。<
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1