路径规划算法：基于向量加权平均优化的路径规划算法- 附代码