dfs用遞迴一步步試探，在所有路徑中選出最短的一條路徑

程式碼：

//0是路，1是牆 
#include<iostream>
#include<algorithm>
using namespace std;
int x1,y1,x2,y2;//起點座標終點座標
int c=999999; //步數 
int dir[4][2]={-1,0,1,0,0,-1,0,1};
int mg[5][5]={0,0,1,1,1,
              0,0,1,1,1,
              0,1,0,1,1,
              1,0,1,1,1,
              0,0,0,0,0
			 };
void dfs(int x,int y,int t)
{
	int i,xx,yy;
	if (x==x2&&y==y2)//到達終點 
	{
		c=min(c,t);//取最小值 
		return ;
	}
	mg[x][y]=1;//將走過的路設1，以免下次又以為這是一條路，又走回來 
	for (i=0;i<4;i++)
	{
		xx=x+dir[i][0];
		yy=y+dir[i][1];//生成新的方向座標 
		if (xx<0||xx>=5||yy<0||yy>=5||mg[xx][yy]==1)//超出地圖，或者為牆,則要重新換個方向走 
		 continue;
		dfs(xx,yy,t+1);//步數+1，以xx,yy為新的座標，來進行對下次的方向進行選擇又生成新的xxyy 
		mg[xx][yy]=0;//這一步是當走到終點了，或者是有一個xxyy座標上下左右都不能走，則要將剛走過的路(之前設為牆了)恢復成路 
	}
}
int main()
{
	cin>>x1>>y1>>x2>>y2;
	dfs(x1,y1,0);
	cout<<c;
	return 0;
}
 

bfs用佇列一層一層的走，每次只取最短的

程式碼：

#include<iostream>
#include<algorithm>
#include<queue>
using namespace std;
struct st
{
   int x,y,c=0;//行列座標xy，c為步數	
};
queue<struct st> xz;//建立一個佇列xy 
int dir[4][2]={-1,0,1,0,0,-1,0,1};
int mg[5][5]={0,0,1,1,1,
              0,0,0,1,1,
              0,1,0,1,1,
              0,0,0,1,1,
              0,0,0,0,0
			 };
int bfs(struct st s,struct st e)
{
	struct st t;
	int i;
	xz.push(s);//先將起點座標的資訊入隊 
	mg[s.x][s.y]=1;
	while (!xz.empty())//佇列為空，說明到達終點，完畢 
	{
		s=xz.front(); //獲取隊頭元素 
		xz.pop();//刪除後佇列為空 
		if (s.x==e.x&&s.y==e.y)//到達終點，返回步數c 
		  return s.c;
		for (i=0;i<4;i++)
		{
			t.x=s.x+dir[i][0];
			t.y=s.y+dir[i][1];
			if (t.x<0||t.x>=5||t.y<0||t.y>=5||mg[t.x][t.y])//不能走 
			 continue;
			 t.c=s.c+1;  //步數加1 
			 mg[t.x][t.y]=1;//走過的路賦1 
			 xz.push(t);// 將新的座標和步數資訊t入隊 
		}
	}
}
int main()
{
	struct st s,e;
	cin>>s.x>>s.y>>e.x>>e.y;
	cout<<bfs(s,e)<<endl;
	return 0;
}
 

打印出路徑

//輸入0為路，1為牆，5*5地圖 
//從左上角 走到 右下角 
#include<iostream>
#include<algorithm>
#include<queue>
using namespace std;
int mg[5][5];
int dir[4][2]={-1,0,1,0,0,-1,0,1};
struct node
{
	int x,y,c;
}jl[5][5];//記錄路徑 
int bfs()
{
	int i;
	queue<struct node> Q;
	struct node s;
	struct node t;
	s.x=s.y=s.c=0;
	mg[s.x][s.y]=1;
	Q.push(s);
	while (!Q.empty())
	{
		s=Q.front();
		Q.pop();
		if(s.x==4&&s.y==4)//達到終點 
		{
			return s.c;
		}
		for (i=0;i<4;i++)
		{
			t.x=s.x+dir[i][0];
			t.y=s.y+dir[i][1];
			if (t.x>=0&&t.x<5&&t.y>=0&&t.y<5&&mg[t.x][t.y]==0)
			{
				t.c=s.c+1;
				jl[t.x][t.y].x=s.x;//這裡的jl是記錄路徑 
				jl[t.x][t.y].y=s.y;
				mg[t.x][t.y]=1;
				Q.push(t);
			}
		}
	}
	return 0;
}
void print(int xx,int yy)//遞迴列印路徑  
{
	if (xx==0&&yy==0)
	 {
	 	cout<<xx<<" "<<yy<<endl;
	 	return ;
	 }
	 print(jl[xx][yy].x,jl[xx][yy].y);
	 cout<<xx<<" "<<yy<<endl;
}
int main()
{
	int i,j;
	for (i=0;i<5;i++)
	for (j=0;j<5;j++)
	 cin>>mg[i][j];
	cout<<bfs()<<endl;
	print(4,4);
}