bfs+STL cf242c

#include <iostream>
#include <map>
#include <cstdio>
#include <queue>

using namespace std;

map<int, map<int,int> >mp;
queue<int> q;

int main()
{
int x0,y0,x1,y1,n;
while(scanf("%d%d%d%d%d",&x0,&y0,&x1,&y1,&n)!=EOF)
{
int r,a,b;
for(int i=0;i<n;i++)
{
scanf("%d%d%d",&r,&a,&b);
for(int t=a;t<=b;t++)
{
mp[r][t]=-1;
}
}
q.push(x0);
q.push(y0);
q.push(0);
int ans=-1;
while(!q.empty())
{
int tx=q.front();
q.pop();
int ty=q.front();
q.pop();
int cnt=q.front();
q.pop();
if(tx==x1&&ty==y1)
{
ans=cnt;
break;
}
for(int i=-1;i<=1;i++)
{
for(int j=-1;j<=1;j++)
{
if(i==0&&j==0)
continue;
if(mp[tx+i][ty+j]==-1)
{
mp[tx+i][ty+j]=1;
q.push(tx+i);
q.push(ty+j);
q.push(cnt+1);
}
}
}
}
cout<<ans<<endl;
}
return 0;
}