基于等势线随机采样的路径规划方法及系统

本发明提供一种基于等势线随机采样的路径规划方法，根据障碍物位置构建采样势场函数，通过采样势场函数构建地图势场，在采样势场函数中设置了等势线分布系数k，通过调节等势线分布系数k以达到调节节点分布的目的；然后，在等势线上进行节点采样，并基于斥力场的节点优化方法，最后，使用图搜索算法，对构建完成的线路图R进行最优路径查询，规划起点与终点的较优路径。本发明针对PRM算法的节点采样部分进行改进，提出了一种基于等势线采样的节点采样策略和基于斥力场的节点位置优化方法，可以有效增大狭窄通道内的节点采样数量，优化节点采样的质量，提高路径规划成功率和路径规划质量。