[发明专利]一种基于二元环境信息的移动机器人局部路径规划方法

权利要求书

1、一种基于二元环境信息的移动机器人局部路径规划方法，其特征在于步骤如下：

(1)计算目标点在局部路径规划坐标系下的坐标x₀、y₀；

(2)计算无障碍时的默认规划路径，包括默认输出曲率为S₀和默认输出弧长L₀；

(3)中间变量，即左右两侧避障弧段及局部路径规划参数初始化

定义左避障弧段为从左侧避过当前目标点方向上的障碍所需的最小曲率，即最靠右侧的弧段，右避障弧段为从右侧避过当前障碍所需的最大曲率，即最靠近左侧的弧段，左右避障弧段的弧长分别为L_l、L_r，左右避障弧段的曲率分别为S_l、S_r，初始条件下，两弧段均与步骤(2)中计算出的默认规划弧段重合，即有S_l＝S_r＝S₀、L_l＝L_r＝L₀；

局部路径规划的参数为：移动机器人的长度a、宽度b，移动机器人所能实现的最小转弯半径R_min或最大曲率S_max、局部路径规划有效距离D，R_min和S_max均为标量，且满足Smax=1/Rmin*,]]>局部路径规划的输出弧段曲率限制在[-S_max，S_max]区间内，D＝min(D_s，D_l)，其中D_s为环境感知有效距离，可根据敏感器配置情况和运动控制精度确定，D_l为目标点距离

(4)根据敏感器输出，获取二元环境信息描述，并对二元环境信息中的障碍信息进行初始分类

a.将二元环境中的障碍信息以x_fi，x_rl，y_h，y_ri的形式给出，分别对应每个障碍的前边界X坐标、后边界X坐标、左边界Y坐标、右边界Y坐标，i＝1，2，…，n，n为障碍总数；

b.根据障碍与左右避障弧段的相对位置关系，将障碍分为四类，即未知障碍、左侧障碍、右侧障碍、可忽略障碍；未知障碍即障碍与左右避障弧段的相对位置关系未知；左侧障碍即障碍位于右避障弧段左侧；右侧障碍即障碍位于左避障弧段右侧；可忽略障碍包括两类情况，其一为障碍位于左右避障弧段之间，则此时可认为该障碍已经被避过，可不予考虑，其二为障碍到移动机器人的距离大于有效距离，不会影响本次路径规划结果的执行，因此在当前局部路径规划过程中可不予考虑；