广度优先搜索 找到迷宫中的最短路径

2744557306

clear all
* ?1 m% h8 D6 c- sclc
  n4 j' E/ U: y, l- C1 ]maze=[0,0,0,0,0,0,0,0;
      0,1,1,1,1,0,1,0;
+ n9 S( e5 v3 }/ F* ^      0,0,0,0,1,0,1,0;
3 ~* K8 S) ?3 c4 Q% Y/ N1 c8 B' _      0,1,0,0,0,0,1,0;
+ i  a$ w0 {8 h8 W9 p, d      0,1,0,1,1,0,1,0;
      0,1,0,0,0,0,1,1;
: u! R1 W6 B& r% K" x( g3 {2 j      0,1,0,0,1,0,0,0;
9 ?# w- h* V, r4 w, o' t      0,1,1,1,1,1,1,0];%迷宫:0为路,1为墙,-1为遍历过
fx(1:4)=[1,-1,0,0];
, |0 D- H+ X# mfy(1:4)=[0,0,-1,1];
9 n+ g3 ~0 l2 n; J0 L4 V, fsq.pre=zeros(1,100);sq.x=zeros(1,100);sq.y=zeros(1,100);
qh=0;%队头指针
qe=1;%队尾指针
maze(1,1)=-1;
+ f7 \: D1 `: X& b7 A8 H%第一个元素入队
* t2 V: G7 m+ _' y& A& H. m( Tsq.pre(1)=0;sq.x(1)=1;sq.y(1)=1;
/ K: j. y8 U6 j6 K, N
while qh-qe~=0
+ k% L8 i  }0 ^; @7 G  x8 }: Vqh=qh+1;
bb=0;
2 G$ O' O( H8 I: X% m' |for k=1:4
i=sq.x(qh)+fx(k);
j=sq.y(qh)+fy(k);
if check(i,j,maze)==1
8 G* n# @6 m' [* S. ]qe=qe+1;%入队
& P" N0 n+ n% H1 Gsq.x(qe)=i;sq.y(qe)=j;sq.pre(qe)=qh;
maze(i,j)=-1;
2 ]' C/ R7 g) h, a0 u# q) f
  I( T( D: ]/ K  i0 m# A) Jif i==8&j==8%如果为图最后一个点
9 Z: L7 E' C# p# z0 vwhile qe~=0
sq.x(qe)
! R7 M5 n) ]. {) |, V/ }5 \) N4 osq.y(qe)   
& @- }/ R/ @5 _qe=sq.pre(qe);
end
: Q+ c" E6 o+ ~4 g) rbb=1;
3 k" A% a! L' e, l. }) o  Y; Gbreak;
end %if
end %if
end
6 [1 @# V9 x( X  iif bb==1
break
end
end%while

# b1 [8 ^+ H5 }; A7 }
4 Z4 F' L! g' \这段代码实现了一个广度优先搜索（BFS）算法，用于找到迷宫中从起点 (1,1) 到终点 (8,8) 的最短路径。
2 }/ h1 Y* {5 I" M2 S5 q& z  F以下是代码的详细解释：

1.迷宫定义：
+ ]6 t1 O2 I( }" m6 s2.maze 是一个8x8的矩阵，其中 0 表示可通行的路径，1 表示墙，-1 表示已经遍历过的路径。
- Q( k6 L) E  G+ \: L1 w9 G3.方向定义：
4 T! a! Q2 B. [; _# ^4.fx 和 fy 定义了四个方向，即上、下、左、右的偏移量。
5.队列定义：
6.sq.pre, sq.x, sq.y 分别用于存储每个点的前一个点、x坐标和y坐标。
7.qh 和 qe 分别是队列的头和尾的指针。
3 q' m, N6 ?7 m7 E6 t5 Z8.初始设置
9.起点 (1,1) 被标记为 -1（已遍历），并加入队列。
10.广度优先搜索：
11.使用一个 while 循环来进行搜索，直到队列为空。
12.在每一轮中，取出队头的点 (sq.x(qh), sq.y(qh))，然后尝试向四个方向移动。
13.对于每个方向，如果新的坐标 (i, j) 是有效的（即在迷宫范围内且没有被遍历过），则将其标记为 -1（已遍历）并加入队列。
  x( L, g; w# D4 q  |! Z14.如果新的坐标是终点 (8,8)，则从队列的尾部开始，回溯找到从终点到起点的路径。
15.回溯路径：
16.如果找到终点，那么从 qe 开始，通过 sq.pre 数组回溯每个点的前一个点，直到回到起点。
$ c1 w9 D: @. F& s2 Z4 Q& l  G这样，当代码执行完成后，sq.x 和 sq.y 的值将表示从起点到终点的最短路径。
/ M5 ]" k# q5 k6 }- X

- ^: z. Q( Q& b$ R