洛谷P1649 [USACO07OCT]Obstacle Course S（bfs）

原题链接

纯bfs就行

#include <iostream>
#include <cstring>
#include <string.h>
#include <stdlib.h>
#include <algorithm>
#include <cstdio>
#include <stdio.h>
#include<queue>
#include<math.h>
#include<map>
using namespace std;
#define ll long long
#define inf 0x3f3f3f3f
struct node
{
	int x,y;
	int dir;
	int ans;
};
char a[105][105];
queue<node>q;
int vis[105][105];
int main()
{
	ios::sync_with_stdio(false);
	cin.tie(0);
	int n;
	cin>>n;
	int sx,sy,ex,ey;
	for(int i=1;i<=n;i++)
	{
		for(int j=1;j<=n;j++)
		{
			cin>>a[i][j];
			if(a[i][j]=='A')
			{
				sx=i;
				sy=j;
			}
			if(a[i][j]=='B')
			{
				ex=i;
				ey=j;
			}
		}
	}
	vis[sx][sy]=1;
	q.push({sx,sy,0,0});
	int ans=inf;
	while(!q.empty())
	{
		int nowx=q.front().x;
		int nowy=q.front().y;
		int nowdir=q.front().dir;
		int nowans=q.front().ans;
		q.pop();
		if(nowx!=ex||nowy!=ey)vis[nowx][nowy]=1;
		if(nowdir==0)
		{
			if(nowx-1>=1&&a[nowx-1][nowy]!='x')q.push({nowx-1,nowy,1,0});
			if(nowy+1<=n&&a[nowx][nowy+1]!='x')q.push({nowx,nowy+1,2,0});
			if(nowx+1<=n&&a[nowx+1][nowy]!='x')q.push({nowx+1,nowy,3,0});
			if(nowy-1>=1&&a[nowx][nowy-1]!='x')q.push({nowx,nowy-1,4,0});
		}
		else
		{
			if(nowx==ex&&nowy==ey)ans=min(ans,nowans);
			else
			{
				if(nowx-1>=1&&!vis[nowx-1][nowy]&&a[nowx-1][nowy]!='x')
				{
					if(nowdir!=1)
					{
						q.push({nowx-1,nowy,1,nowans+1});
					}
					else
					{
						q.push({nowx-1,nowy,1,nowans});
					}
					
				}
			    if(nowy+1<=n&&!vis[nowx][nowy+1]&&a[nowx][nowy+1]!='x')
				{
					if(nowdir!=2)
					{
						q.push({nowx,nowy+1,2,nowans+1});
					}
					else
					{
						q.push({nowx,nowy+1,2,nowans});
					}
				}
			    if(nowx+1<=n&&!vis[nowx+1][nowy]&&a[nowx+1][nowy]!='x')
				{
					if(nowdir!=3)
					{
						q.push({nowx+1,nowy,3,nowans+1});
					}
					else
					{
						q.push({nowx+1,nowy,3,nowans});
					}
				}
			    if(nowy-1>=1&&!vis[nowx][nowy-1]&&a[nowx][nowy-1]!='x')
				{
					if(nowdir!=4)
					{
						q.push({nowx,nowy-1,4,nowans+1});
					}
					else
					{
						q.push({nowx,nowy-1,4,nowans});
					}
				}
			}
		}
	}
	if(ans==inf)cout<<-1<<'\n';
	else cout<<ans<<'\n';
}