使用matlab应用动态规划算法走迷宫

使用matlab应用动态规划算法走迷宫，并回溯出最短路径。
生成迷宫的方法见：使用matlab生成迷宫.

clc
clear
close
% 读取迷宫数据
load('puzzle.mat');
% 设置起点
start_p = [2,1];
queue = start_p;
range = 0;
result = nan(size(puzz));
result(puzz == 0) = -1;
direction = nan(size(puzz));
% 遍历迷宫的所有点
while size(queue ,1) > 0
    new_queue = [];
    for i = 1: size(queue ,1)
       p_now = queue(i,:);
       result(p_now(1), p_now(2)) = range;
       % 判断上下左右的有效点是否没有经过
       % 上1下2左3右4
       try
           if isnan(result(p_now(1)-1, p_now(2))) && ~max(ismember(queue(:,1:2)