[发明专利]一种机器人避障轨迹规划方法

摘要

本发明公开了一种机器人避障轨迹规划方法，基于速度驱动获取机器人无碰轨迹的速度向量场是通过控制机器人的运行速度实现无碰运动的，主要包括吸引速度向量场，排斥速度向量场和环绕速度向量场在有障碍物的环境下，机器人按照一定的算法获取从初始点到目标点的无碰撞运动轨迹。本发明使用扫掠球法对机器人与障碍物进行简化，计算二者的最短距离，通过建立基于人工势场的速度向量场算法得到无碰轨迹，并用指数速度场对其速度进行优化。

主权项

一种机器人避障轨迹规划方法，其特征在于：包括如下步骤：步骤一：计算吸引速度向量场，吸引速度向量场保证机器人始终朝向目标点运动，吸引速度的设定通常与机器人、障碍物间的最小距离相关；在机器人进行一般避碰任务时，将吸引速度设定为恒定速度Vs，吸引速度的方向为：其中，为始终由机器人当前位置PR指向目标点PG的向量；步骤二：计算排斥速度向量场，排斥速度向量场保证机器人不与障碍物发生碰撞；其中，α、β为排斥系数，e为自然底数，do为机器人与障碍物的最近距离，θrep为其方向角，使用指数规律变化的排斥速度向量场，机器人进入排斥场时可避免速度突变，接近障碍物时能以排斥速度避开障碍物；步骤三：当机器人、障碍物、目标点在一条直线上时，吸引速度和排斥速度可能相互抵消，机器人会停滞在某个中间点；为避免这种局部最小问题，同时提高机器人的避障速度，提出环绕速度向量场如下：Δxrep=-sign(cos(θrep))·∞Δyrep=-sign(sin(θrep))·∞,do<robsΔxrep=-β·[e[(R-do)/10-1]+e[a·(R-do)′/10-1]]·cos(θT)Δyrep=-β·[e[(R-do)/10-1]+e[a·(R-do)′/10-1]]·sin(θT),robs≤do≤RΔxrep=Δyrep=0,do>R]]>其中，θT＝θrep±90°。