基于势函数的机器人路径规划方法

摘要

本发明公开了一种基于势函数的机器人路径规划方法，其特征在于:首先采用基于势函数的随机采样方式；其次基于概率，采用与随机采样点欧式距离最近和代价函数值最小的方式选择最近邻节点，并在新节点拓展上采用两次拓展的方法加快算法的搜索效率，第一次拓展采用目标偏向的拓展策略、第二次拓展采用矩形区域随机采样的策略；然后对新节点做重新选择父节点操作和对路径做重新布线操作，得到一条从起始点到目标点的无碰撞的路径，利用删除冗余节点和最大曲率约束对生成的路径进行去除冗余节点和最大曲率约束操作，提高路径的平滑度。本发明具有能够有效地减少了搜索时间和路径的长度，同时平均采样节点数也有了明显的减少的特点。