1.一种移动机器人路径规划方法,其特征在于,包括以下步骤:S1、构建RRT*算法,并剔除RRT*算法生成的危险节点,生成改进RRT*算法;
S2、采用贪婪算法对步骤1改进的RRT*算法进行路径缩短处理;
S3、利用DWA算法跟踪步骤2缩短处理后的RRT*算法规划的最优路径;
S4、设计一种二次调权和路径回正机制,以确保机器人在静态未知障碍物区域能及时避开障碍物并回归原路径;
S5、设计一种转向加速的安全驶离策略,以确保机器人安全避开动态障碍物;
S6、通过仿真实验验证可靠性与精确性;
步骤S1中构建RRT*算法具体指:在RRT算法的基础上重新选择父节点,以q步骤S1中剔除RRT*算法生成的危险节点具体指:设置一个安全距离safe_dis,safe_dis=0.5m,接着将扩展树中的最近点q步骤S3具体包括以下步骤:
移动机器人的速度空间中存在无穷多组速度(v,w),根据环境和机器人自身的约束控制采样速度,公式表达如下:V
式中,V
受电机的实际转矩影响,移动机器人存在最大的加速度和减速度,速度约束公式表达为:式中,V
考虑到机器人在行进过程中的安全性,在局部环境中避障时,在与障碍物碰撞前将速度降为0m/s,公式表达如下:式中,V
在V
G(v,w)=α·heading(v,w)+β·vel(v,w)+γ·dist(v,w)式中heading(v,w)为机器人方位角评价函数,表示当前模拟轨迹末端方向与目标方向之间的角度偏差;vel(v,w)为当前模拟速度大小的评价函数;dist(v,w)为轨迹末端与障碍物的最近距离;
在步骤S3中引入融合算法,引导DWA算法在保证局部动态避障的同时,实现路径的全局最优,公式表达为:式中Dist(v,w)为距离评价函数,其中dist步骤S4具体指:首先为障碍物设置一个检测距离dist步骤S5具体指:首先,设置一个潜在的碰撞距离,当动态障碍物与当前点的距离小于等于潜在的碰撞距离时,计算当前点的速度到达交叉点的时间t
2.根据权利要求1所述一种移动机器人路径规划方法,其特征在于,步骤S2中路径缩短处理具体指:首先将终点q
3.一种电子设备,其特征在于,包括:存储器和处理器,所述存储器存储由所述处理器可执行的计算机程序,所述处理器执行所述计算机程序时实现上述权利要求1-2任一项所述的移动机器人路径规划方法。
4.一种存储介质,其特征在于,所述存储介质上存储有计算机程序,所述计算机程序被读取并执行时,实现上述权利要求1-2任一项所述的移动机器人路径规划方法。