image创建栅格地图

最新推荐文章于 2024-01-31 15:30:43 发布

aihuo7077

最新推荐文章于 2024-01-31 15:30:43 发布

阅读量474

点赞数

文章标签： c/c++

原文链接：http://www.cnblogs.com/yangmingustb/p/8711221.html

版权

 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;