20分求助

#include<bits/stdc++.h>
using namespace std;
int mp[105][105];
bool vis[105][105];
struct Node
{
	int x,y;
	int gold;
	bool f;
	int color;
};
int m,n;
struct cmp
{
	bool operator()(Node a,Node b)
	{
		return a.gold>b.gold;
	}
};
int dir[4][2]={{1,0},{0,1},{-1,0},{0,-1}};

bool check(int x,int y)
{
	return x>=1 && y>=1 && x<=m && y<=m && !vis[x][y];
}

int bfs()
{
	priority_queue<Node ,vector<Node> ,cmp> q;
	q.push({1,1,0,true,mp[1][1]});
	vis[1][1]=true;
	while(!q.empty())
	{
		Node fr=q.top();
		q.pop();
		if(fr.x==m && fr.y==m)
		{
			return fr.gold;
		}
		for(int i=0;i<4;i++)
		{
			int tx=fr.x+dir[i][0];
			int ty=fr.y+dir[i][1];
			if(check(tx,ty))
			{
				if(!fr.f && mp[tx][ty]==-1)
				{
					continue;
				}
				if(mp[tx][ty]==-1)
				{
					q.push({tx,ty,fr.gold+2,false,fr.color});
				}
				else if(mp[tx][ty]==fr.color)
				{
					q.push({tx,ty,fr.gold,true,fr.color});
				}
				else if(mp[tx][ty]!=fr.color)
				{
					q.push({tx,ty,fr.gold+1,true,fr.color});
				}
				vis[tx][ty]=true;
			}
		}
	}
	return -1;
}

int main()
{
	for(int i=0;i<105;i++)
	{
		for(int j=0;j<105;j++)
		{
			mp[i][j]=-1;
		}
	}
	cin>>m>>n;
	while(n--)
	{
		int x,y;
		cin>>x>>y;
		cin>>mp[x][y];
	}
	cout<<bfs()<<endl; 
	return 0;
}