[发明专利]一种综合考虑距离与方向两因素的移动机器人避障方法

说明书

本发明公开一种综合考虑距离与方向两个因素的移动机器人避障方法。该方法将障碍物的距离和方向之间的融合问题数值化，获得一个统一的衡量标准，称为障碍物危险度值。最大危险度值的障碍物获得优先避障，该方法能使移动机器人根据实时的环境信息自然平滑地调整运动的角速度和线速度，为机器人提供了距离和方向两方面的安全保障，对于机器人的安全导航具有实用意义。

技术领域

本发明属于移动机器人障碍物避让控制系统领域，特别的，涉及一种基于激光测距传感器的移动机器人避障方法。

背景技术

近年来,机器人及智能车辆在战场攻防、抢险救灾、科学探索等人类不能到达或高度危险性的环境中体现出越来越重要的应用。随着机器人技术的发展，促进了机器人应用领域的不断扩展，机器人的工作环境也随之越来越复杂。机器人在运动过程中会遇到各种各样的障碍物，这就导致机器人在其导航运动过程中存在着极大的安全危险。因此是否具备快速有效的规避障碍物能力是机器人实现安全导航的关键。目前在大部分避障方法中，通常主要考虑障碍物与机器人之间的距离来进行避障运算。这种方法减弱了障碍物的方位信息对机器人避障的影响。距离和方向是机器人对障碍物进行避障评判的两个主要评价指标，距离近的应优先避障，前方的障碍物也应该优先避障。为此，提出了一种融合了距离和方向的基于激光雷达传感器的移动机器人避障方法，对于机器人的安全导航提供了更多的安全保障，对于机器人的安全导航具有实用意义。

发明内容

本发明针对现有方法的不足，提出一种综合考虑距离和方位两因素的基于激光测距传感器的移动机器人避障方法。

为了达到上述目的，本发明分成三个部分：第一部分为移动机器人自身周围局部环境信息的获取部分；第二部分为综合考虑距离和方位两个因素的危险障碍物提取，第三部分为基于障碍物危险度的移动机器人避障。

避障方法的运行步骤如下：

一：局部环境信息的获取

步骤1：通过背靠背安装两部激光测距仪来扫描机器人的周围环境，形成一个360°的圆形扫描面。每一次扫描可获得一帧扫描数据，表示为数组A_k

其中k表示第k次扫描周围环境；为激光扫描角度分辨率；N为每一次扫描可获得的激光测距数据的个数，也即共有N个测距值；d_i表示第i个测量值，1≤i≤N。那么A_k即为一次扫描环境所获得的局部环境信息。

二：计算综合考虑距离和方位两个因素的障碍物危险度

步骤2：令i从1开始，按公式(2)(3)分别计算第i个测距值在机器人自身坐标系中的坐标(x_i,y_i)，其中为第i个测距值的偏向角。

步骤3：计算临时变量S

S＝max(0.56y_i+2.56,0) (4)

步骤4：计算临时变量K

K＝max(y_i+0.56,eps)，其中eps＝0.00001 (5)

步骤5：计算r_i

r_i＝max(1-(y_i²+Sx_i²)/K,0) 1≤i≤N (6)