标题欢迎来到 < Haoh-Smile > 的博客,觉得受用客官就点个赞评论一下呗!
你已经读过前篇文章的讲解了吧!Dijkstra算法结合时间窗规划无冲突路径
function [DT]=DetermineType(P1,P2,sp1,sp2,TW1,TW2)主要功能是判断冲突类型。代码中的function为方法关键字,表明该功能代码需要建立一个.m文件存放,文件名为函数方法名,该功能文件名为DetermineType.m,代码实现如下:
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%冲突类型判断%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
function [DT]=DetermineType(P1,P2,sp1,sp2,TW1,TW2)
% DT 冲突类型记录矩阵
% 第一列 0:节点冲突 1:相遇冲突
% 第二列 冲突栅格在AGV1路径中的位置
% 第三列 冲突栅格在AGV2路径中的位置
% P1 AGV1路径索引矩阵
% P2 AGV2路径索