欢迎来到 < Haoh-Smile > 的博客,觉得受用客官就点个赞评论一下呗!
function plotMap_Path(map,distance,X,Y)功能代码如下:
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%画出环境地图及路径%%%%%%%%%%%%%%%%%%%%%%%%%%
function plotMap_Path(map,distance,X,Y)
% map 地图矩阵
% distance 路径距离值
% X Y 路径坐标矩阵
n = size(map);
step = 1;
a = 0 : step :n(1)