hdu诡异的楼梯(BFS+优先队列）

http://acm.hdu.edu.cn/showproblem.php?pid=1180

这题交了7次 悲剧了 前几次 因为把+行想成是左右走了 一直WA 后来看出来了 又把走过的楼梯给标记了 这里的楼梯不能标记

因为可以在原地等着楼梯转变 加的时间有可能是2 这样普通队列满足不了最少的先搜 就用优先队列了

#include<stdio.h>
#include<string.h>
typedef struct node
{
 int x,y,num;
}st;
int f[22][22];
char c[22][22];
st q[10001],t;
int d,p;
void sort()//把用时少的优先放在队首
{
 int i;
 for(i = d ; i > p ; i--)
 {
  if(q[i].num<q[i-1].num)
  {
   t = q[i];
   q[i] = q[i-1];
   q[i-1] = t;
  }
  else
  break;
 }
}
void inque(int a,int b)
{
 d++;
 q[d].x = a;
 q[d].y = b;
}
int main()
{
 int n,m,i,j,x[2],y[2],dis[2] = {-1,1};
 while(scanf("%d%d%*c", &n,&m)!=EOF)
 {
  memset(f,0,sizeof(f));
  for(i = 1 ; i <= n ; i++)
  {
   for(j = 1 ; j <= m ; j++)
   {
    scanf("%c",&c[i][j]);
    if(c[i][j] == 'S')
    {
     x[0] = i;
     y[0] = j;
    }
    if(c[i][j] == 'T')
    {
     x[1] = i;
     y[1] = j;
    }
   }
   getchar();
  }
  d = 0;
  p = 0;
  q[1].num = 0;
  f[x[0]][y[0]] = 1;
  inque(x[0],y[0]);
  do
  {
   p++;
   int px = q[p].x;
   int py = q[p].y;
   if(px==x[1]&&py==y[1])
    break;
   int pf = q[p].num%2;
   for(i = 0 ; i < 2 ; i++)
   {
    int qx = px+dis[i];
    int qy = py+dis[i];
    if(!f[qx][py]&&qx>0&&qx<=n&&(c[qx][py]=='.'||c[qx][py]=='|'||c[qx][py]=='-'||c[qx][py]=='T'))
    {
     if(c[qx][py]=='|'||c[qx][py]=='-')
     {
      if(!f[qx+dis[i]][py]&&qx+dis[i]>0&&qx+dis[i]<=n&&(c[qx+dis[i]][py]=='.'||c[qx+dis[i]][py]=='T'))
      {
       inque(qx+dis[i],py);
       if((!pf&&c[qx][py]=='|')||(pf&&c[qx][py]=='-'))
       {
        q[d].num = q[p].num+1;
        sort();
       }
       else
       {
        q[d].num = q[p].num+2;
        sort();
       }
       f[qx+dis[i]][py] = 1;
      }
     }
     else
     {
      f[qx][py] = 1;
      inque(qx,py);
      {
       q[d].num = q[p].num+1;
       sort();
      }
      f[qx][py] = 1;
     }
    }
    if(!f[px][qy]&&qy>0&&qy<=m&&(c[px][qy]=='.'||c[px][qy]=='|'||c[px][qy]=='-'||c[px][qy]=='T'))
    {
     if(c[px][qy]=='|'||c[px][qy]=='-')
     {
      if(!f[px][qy+dis[i]]&&qy+dis[i]>0&&qy+dis[i]<=m&&(c[px][qy+dis[i]]=='.'||c[px][qy+dis[i]]=='T'))
      {
       inque(px,qy+dis[i]);
       if((!pf&&c[px][qy]=='|')||(pf&&c[px][qy]=='-'))
       {
        q[d].num = q[p].num+2;
        sort();
       }
       else
       {
        q[d].num = q[p].num+1;
        sort();
       }
       f[px][qy+dis[i]] = 1;
      }
     }
     else
     {
      f[px][qy] = 1;
      inque(px,qy);
      {
       q[d].num = q[p].num+1;
       sort();
      }
      f[px][qy] = 1;
     }
    }
   }
  }while(d!=p);
  printf("%d\n",q[p].num);
 }
 return 0;
}