1 %创建具有障碍物的栅格地图 2 %矩阵中1代表黑色栅格 3 a = zeros(20); 4 a(3,3:7)=2; 5 a(3:10,7)=2; 6 a(10,3:7)=2; 7 a(17,13:17)=2; 8 a(10:17,13)=2; 9 a(10,13:17)=2; 10 a(5,2)=5; 11 a(15,15)=6; 12 13 14 15 16 % 白色，可行路径 17 % 黑色，障碍物 18 % 红色，visited 19 % 蓝色，on list 20 % green，start 21 % yellow,destination 22 map_color = [1 1 1; 23 0 0 0; 24 1 0 0; 25 0 0 1; 26 0 1 0; 27 1 1 0]; 28 % disp(map_color(1,:)); 29 30 colormap(map_color); % 创建颜色 31 %disp(size(a)); 32 33 image(1:size(a,2),1:size(a,1),a); % 赋予栅格颜色 34 set(gca,'XTick',1:size(a,1),'YTick',1:size(a,2)); % 设置坐标 35 axis image xy; % 沿每个坐标轴使用相同的数据单位，保持一致 36 grid on;
