grid method.rar_act7u3_colonyxdf_栅格 路径规划_栅格路径规划_路径规划

clear all close all clc load environment.mat n = size(a,1); b = a; b(end+1,end+1) = 0; % figure; colormap([0 0 0;1 1 1]) pcolor(b); % 赋予栅格颜色 set(gca,'XTick',10:10:n,'YTick',10:10:n); % 设置坐标 axis image xy % displayNum(n);%显示栅格中的数值. % text(1,n+1.5,'START','Color','red','FontSize',10);%显示start字符 % text(n+1,1.5,'GOAL','Color','red','FontSize',10);%显示goal字符 % % hold on %pin strat goal positon % scatter(1+0.5,n+0.5,'MarkerEdgeColor',[1 0 0],'MarkerFaceColor',[1 0 0], 'LineWidth',1);%start point % scatter(n+0.5,1+0.5,'MarkerEdgeColor',[0 1 0],'MarkerFaceColor',[0 1 0], 'LineWidth',1);%goal point % % hold on