求助

P1207 -- 迷宫（最少步数） {SpecialJudge}
时间限制：1000MS      内存限制：131072KB      通过/提交人数：106/504
状态：      标签：    搜索-广搜   无   无 
题目描述
给定一个N*M方格的迷宫，迷宫里有T处障碍，障碍处不可通过。给定起点坐标和终点坐标，问每个方格最多经过1次。在迷宫中移动有上下左右四种方式。保证起点上没有障碍。问从起点到终点的最短路径长度以及输出一条长度最短的路径经过的点的坐标。
如果不存在起点到终点的路径则就输出-1。
输入格式
第一行N、M和T，N为行，M为列，T为障碍总数。
第二行起点坐标SX,SY，终点坐标FX,FY。
接下来T行，每行为障碍的坐标。
输出格式
如果存在解答则：
第一行 输出最短路径的长度K（起点终点也算在步数内）
以下K行，每行包含两个整数I,J，意为经过第I行第J列的点
否则输出-1
输入样例
2 2 1
1 1 2 2
1 2
输出样例
3
1 1
2 1
2 2
数据规模与约定
对于 45% 的数据，1<=N, M<=3；
对于 90% 的数据，1<=N, M<=5；
对于 100% 的数据，1<=N, M<=1000。

#include <iostream>
using namespace std;
int xx[4]={1,-1,0,0},yy[4]={0,0,1,-1};
int n,m,T,sx,sy,fx,fy;//N为行，M为列,T为障碍总数,sx,sy为起点坐标，fx,fy为终点；
int map[1005][1005],p[100000][3];//map为地图；
int main()
{
    int x,y;
    cin>>n>>m>>T;
    cin>>sx>>sy>>fx>>fy;//输入
    for(int i=1;i<=T;i++)//输入
    {
        int za,zb;
        cin>>za>>zb;
        map[za][zb]=1;
    }
    int h=0,t=1;
    map[sx][sy]=1;
    p[1][1]=sx;
    p[1][2]=sy;
    p[1][3]=1;
   while(h<t)
   {
       h++;
       for(int i=0;i<4;i++)
       {
           x=p[h][1]+xx[i];
           y=p[h][2]+yy[i];
           if(x>=0&&x<sx&&y>=0&&y<sy&&map[x][y]==0)
           {
               t++;
               p[t][1]=x;
               p[t][2]=y;
               p[t][3]=p[h][3]+1;
               map[x][y]=1;
            if(x==fx&&y==fy)
            {
                cout<<p[t][3];
            }
           }
       }
       
   }
   return 0;
}