12 - function plotMap_Path(map,spcost,OUT,P,X,Y,C,I)功能代码

欢迎来到 < Haoh-Smile > 的博客，觉得受用客官就点个赞评论一下呗！
各位读者大家好，专栏更新至此已全部更新完本专栏的全部功能代码，再次谢谢您的订阅，如有不足请大家指正！本专栏功能只是完成了两台AGV的无冲突路径规划，任意台AGV路径无冲突规划正在开发调试中，敬请期待。
你已经读过前篇文章的讲解了吧！Dijkstra算法结合时间窗规划无冲突路径
function plotMap_Path(map,spcost,OUT,P,X,Y,C,I)主要功能是画出地图及规划路径。代码中的function为方法关键字，表明该功能代码需要建立一个.m文件存放，文件名为函数方法名，该功能文件名为plotMap_Path.m，代码实现如下：

 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%画出环境地图及路径%%%%%%%%%%%%%%%%%%%%%%%%%%
 
function plotMap_Path(map,spcost,OUT,P,X,Y,C,I)
% map 地图矩阵
% P   路径索引矩阵
% spcost 路径距离值
% OUT 路径索引标识
% X Y 路径坐标矩阵
n = size(map)<