diff --git a/Astar/Astar.m b/Astar/Astar.m index a3fb10f..59da25e 100644 --- a/Astar/Astar.m +++ b/Astar/Astar.m @@ -61,5 +61,13 @@ while ~isequal(node(4:5),initial) path=[node(4:5); path]; node=closed(BinA(closed(:,1:2),node(4:5)),:); end -path +% 打印路径 + if ~isempty(path) + disp('路径为:'); + for i = 1:size(path, 1) + fprintf('(%d, %d)\n', path(i, 2), path(i, 1)); + end + else + disp('未找到路径。'); + end end \ No newline at end of file