欢迎来到 < Haoh-Smile > 的博客,觉得受用客官就点个赞评论一下呗!
你已经读过前篇文章的讲解了吧!Dijkstra算法结合时间窗规划无冲突路径
function [TW2,OUT,sp,P,spcos2,X2,Y2] = Detection_TW (map,SD2,P1,P2,sp1, sp2,spcos,X,Y,TW1,TW2)主要功能是当前路径时间窗与已完成规划路径进行冲突类型检测及若存在冲突给出等待或更换路径策略。代码中的function为方法关键字,表明该功能代码需要建立一个.m文件存放,文件名为函数方法名,该功能文件名为Detection_TW.m,代码实现如下:
%%%%%%%%%%%%%%%%%%%%%%%%时间窗路径类型以及冲突检测%%%%%%%%%%%%%%%%%%%%%%%%
function [TW2,OUT,sp,P,spcos2,X2,Y2] = Detection_TW