欢迎来到 < Haoh-Smile > 的博客,觉得受用客官就点个赞评论一下呗!
你已经读过前篇文章的讲解了吧!Dijkstra算法结合时间窗规划无冲突路径
function [P]=GetPath(L,spcost,R)主要功能是在转弯次数递增顺序的路径集合中获取 L 数量的路径(两栅格点之间的最短路径或许有很多条,为减少路径选择复杂度,将预规划路径集合中的一部分路径进行选择)。代码中的function为方法关键字,表明该功能代码需要建立一个.m文件存放,文件名为函数方法名,该功能文件名为GetPath.m,代码实现如下:
%%%%%%%%%%%%%%%%%%%%%%%%%得到路径索引矩阵P%%%%%%%%%%%%%%%%%%%%%%%%
function [P]=GetPath(L,spcost,R)
% L 路径条数约束
%spcost 路径距离
% R 转弯次数递增索引矩阵
% P 路径条数约束条件下选择的路径索引向量
if(spcost<