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