A*寻路算法实现MATLAB代码

本人经过学习A*寻路算法，使用MATLAB进行编程实现，现通过分享给大家进行交流学习。

%function  A_star（mapSize）
    clc;
    clear;
    mapSize = 10;
    mapstep = 10;
    figHW = [mapSize*mapstep mapSize*mapstep]; % 长；宽
    figXY = [650-figHW（1）/2 400-figHW（2）/2]; %x轴 ；y轴位置
    figHandle = figure（‘MenuBar‘ ‘none‘ ‘Position‘ [figXY（1） figXY（2） figHW（1） figHW（2）]）;
    %制作地图表格
    load M;%自制的地图 %若需要随机地图可下载我之前的随机地图代码
    map = ~map2;
    Origin = [1 1]; %起点设置
    Point  = [20 10];%终点设置
    cmap = [1 1 1; ...%白色
            0 0 0; ...%黑色
            1 0 0; ...红色
            0 0 1; ...蓝色
            0 1 0; ...绿色
            1 1 0; ...%黄色
            0.5 0.5 0.5];%灰色
    colormap（cmap）;%创建色图
    Input_Map = map;
    %得到地图的行列数
    [n_cols n_rows] = size（map）;
    map = zeros（n_cols n_rows）;
    %标记障碍物
    map（~Input_Map） = 1;
    map（Input_Map） 

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2018-10-14 10:34  A_star算法实现\
     文件        4762  2018-10-14 10:33  A_star算法实现\A_star.m
     文件       21752  2018-04-16 21:48  A_star算法实现\M.mat