定义一个二维数组：
int maze[5][5] = {
0, 1, 0, 0, 0,
0, 1, 0, 1, 0,
0, 0, 0, 0, 0,
0, 1, 1, 1, 0,
0, 0, 0, 1, 0,
};
它表示一个迷宫，其中的1表示墙壁，0表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。
Input
一个5 × 5的二维数组，表示一个迷宫。数据保证有唯一解。
Output
左上角到右下角的最短路径，格式如样例所示。
Sample Input
0 1 0 0 0
0 1 0 1 0
0 0 0 0 0
0 1 1 1 0
0 0 0 1 0
Sample Output
(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)

搜索加上路径记忆一般就是开个结构体数组，其中有有个变量就是这个点的上一个点的标号。

#include <iostream>
#include <cstdio>
#include <algorithm>
using namespace std;

int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};
typedef struct{
  int x, y;
  int pre;
}node;
node q[105], s[105];
int maze[5][5], book[5][5];
int head=1, tail=1, flag=0;
int main()
{
  for (int i=0; i<5; i++){
    for (int j=0; j<5; j++){
      scanf("%d", &maze[i][j]);
    }
  }
  q[tail].x=0;
  q[tail].y=0;
  q[tail].pre=-1;
  book[0][0]=1;
  tail++;
  while (head<tail){
    for (int k=0; k<4; k++){
      int tx=q[head].x+next[k][0];
      int ty=q[head].y+next[k][1];
      if (tx<0||tx>=5||ty<0||ty>=5)
        continue;
      if (book[tx][ty]==0 && maze[tx][ty]==0){
        book[tx][ty]=1;
        q[tail].x=tx;
        q[tail].y=ty;
        q[tail].pre=head;
        tail++;
      }
      if (tx==4 && ty==4){
        flag=1;
        break;
      }
    }
    if (flag==1)
      break;
    head++;
  }
  tail--;
  int t=1;
  while (q[tail].pre!=-1){
    s[t++]=q[tail];
    tail=q[tail].pre;
  }
  s[t].x=0;
  s[t].y=0;
  for (; t>=1; t--){
    printf("(%d, %d)\n", s[t].x, s[t].y);
  }
  return 0;
}

回溯版

#include <iostream>
#include <cstdio>
#include <cstring>
#include <algorithm>
using namespace std;

int nextt[4][2]={{1,0},{0,1},{-1,0},{0,-1}};
struct node{
  int x, y;
  int pre;
};
struct node q[105];
int maze[5][5], book[5][5];

void getpath(int t)
{
  if (t==1){
    printf("(%d, %d)\n", q[t].x, q[t].y);
    return;
  }
  getpath(q[t].pre);
  printf("(%d, %d)\n", q[t].x, q[t].y);
}
int main()
{
  for (int i=0; i<5; i++)
    for (int j=0; j<5; j++)
      cin>>maze[i][j];
  
  int head=1, tail=1;
  q[tail].x=0;
  q[tail].y=0;
  q[tail].pre=-1;
  book[0][0]=1;
  tail++;
  int flag=0;
  while (head<tail){
    for (int k=0; k<4; k++){
      int tx=q[head].x+nextt[k][0];
      int ty=q[head].y+nextt[k][1];
      if (tx<0||tx>=5||ty<0||ty>=5)
        continue;
      if (maze[tx][ty]==0&&book[tx][ty]==0){
        book[tx][ty]=1;
        q[tail].x=tx;
        q[tail].y=ty;
        q[tail].pre=head;
        tail++;
      }
      if (tx==4 && ty==4){
        flag=1;
        break;
      }
    }
    if (flag==1)
      break;
    head++;
  }
  getpath(tail-1);
  return 0;
}