gusucode.com > matlab编程A星算法的航迹规划3维源码程序 > code2/matlab编程A星算法的航迹规划3维源码程序/code/main_1.m

    %MAIN
tic
%   M为矩阵
%   A为起点
%   B为终点
%=========================
M=zeros(5,7,2);
M(:,:,1) = [0 0 0 1 0 0 0;
    0 0 0 1 0 0 0;
    0 -1 0 1 1 1 0;
    0 0 1 1 1 0 0;
    0 0 0 0 0 0 0;];
M(:,:,2) = [0 0 0 1 0 0 0;
    0 0 0 1 0 -1 0;
    0 0 0 0 1 1 0;
    0 0 1 1 1 0 0;
    0 0 0 0 0 0 0;];
A = [3,2,1];
B = [2,6,2];
notCross = 1; % M中不能通过的点的值
%% ==================================

main_2
toc