matlab栅格化地图代码

以下是一个基本的MATLAB代码来生成和显示栅格化地图：

clc
clear
close all

%% 构建颜色MAP图
cmap = [1 1 1; ...       % 1-白色-空地
    0 0 0; ...           % 2-黑色-障碍
    1 0 0; ...           % 3-红色-起始点
    0 1 0];              % 4-绿色-目标点

% 构建颜色MAP图
colormap(cmap);

%% 构建栅格地图场景
% 栅格界面大小：行数和列数
rows = 10;
cols = 10;

% 定义栅格地图全域，并初始化空白区域
field = ones(rows, cols);

% 设置障碍物位置
field(2:4, 2:4) = 0;

% 设置起始点和目标点位置
startRow = 1;
startCol = 1;
goalRow = rows;
goalCol = cols;

% 在栅格地图上显示不同类型的格子
imagesc(field);
hold on;
plot(startCol, startRow, 'ro', 'MarkerSize', 10, 'LineWidth', 2);
plot(goalCol, goalRow, 'go', 'MarkerSize', 10, 'LineWidth', 2);
axis equal
axis tight
hold off;

这段代码生成了一个10x10的栅格地图，障碍物被设置在(2,2)到(4,4)的位置。