路径规划算法：基于减法平均优化的路径规划算法- 附代码