POJ 2049 广搜

//11058973	c00h00g	2049	Accepted	1436K	63MS	G++	2671B	2012-11-28 15:18:51
//使用c++提交会WA，是double转化为整形的时候出错了
//原因：直接强制转换时不准确的，需要这样转化 dx=(int)(tmpa+0.0001);加上一个偏移量，不然的话
//如果题目中给定的是1，但在计算机中可能是0.9999999，然后强制转化就可能变成0，会导致错误
//题目思路：将每个正方形用左下角坐标来表示，主要有三种状态，墙，门，空气，初始化的时候将
//pos数组初始化为0，表示开始都是空气；不断加入墙和门，修改pos的状态
//pos主要有四个方向，右->上->左->下四个方向，用pos标记某个点（x，y）四个方向的值，0表示是空气，1表示是门，INF表示是墙
//然后使用广搜进行搜索
//错误原因：使用INT_MAX作为最大值，这会出错，因为加上1的话就会变成负值 
#include<stdio.h>
#include<limits.h>
#include<stdlib.h>
#include<queue>
#define INF 9999999
using namespace std;

int M,N;
//方向按照逆时针计算 
int pos[205][205][4];
int dis[205][205];
int dir[4][2]={{1,0},{0,1},{-1,0},{0,-1}};
int x,y,d,t;
int dx,dy;
int i,j;
int mX,mY;

bool isTrue(int x,int y){
    if(x>=0&&y>=0&&x<=mX&&y<=mY)
        return true;
    return false;     
}

void init(){
    mX=mY=-INF;
    for(i=0;i<205;i++)
        for(j=0;j<205;j++){
            dis[i][j]=INF;
            for(int k=0;k<4;k++)
                //全部初始化为空气
                pos[i][j][k]=0;
        }
}

int main(){
    while(scanf("%d%d",&M,&N)!=EOF){
        if(M==-1&&N==-1)
            break;
        init();
        //处理墙 
        for(i=0;i<M;i++){
            scanf("%d%d%d%d",&x,&y,&d,&t);
            if(d==1){
                for(j=0;j<t;j++){
                    pos[x][y+j][2]=INF;//表示当前节点左方是墙
                    pos[x-1][y+j][0]=INF;//表示当前节点左方节点的右方是墙 
                }
                mX=max(mX,x);
                mY=max(mY,y+t);
            }
            if(d==0){
                for(j=0;j<t;j++){
                    pos[x+j][y][3]=INF;
                    pos[x+j][y-1][1]=INF;
                }
                mX=max(mX,x+t);
                mY=max(mY,y);
            } 
        }
        //处理门
        for(i=0;i<N;i++){
            scanf("%d%d%d",&x,&y,&d);
            if(d==1){
                pos[x][y][2]=1;
                pos[x-1][y][0]=1;
            }
            if(d==0){
                pos[x][y][3]=1;
                pos[x][y-1][1]=1;
            }
        } 
        double tmpa,tmpb;
        scanf("%lf%lf",&tmpa,&tmpb);
        dx=(int)(tmpa+0.0001);
        dy=(int)(tmpb+0.0001);
        //广搜
        queue<int> q;
        while(!q.empty())
            q.pop();
        q.push(0);
        q.push(0);
        dis[0][0]=0;
        
        while(!q.empty()){
            int x=q.front();q.pop();
            int y=q.front();q.pop();
            for(int k=0;k<4;k++){
                int xx=x+dir[k][0];
                int yy=y+dir[k][1];
                if(isTrue(xx,yy)&&dis[xx][yy]>dis[x][y]+pos[x][y][k]){
                    dis[xx][yy]=dis[x][y]+pos[x][y][k];
                    q.push(xx);
                    q.push(yy);
                }
            }
        }
        if(M==0&&N==0)
            printf("0\n");
        else if(!(dx>=1&&dy>=1&&dx<=199&&dy<=199))
            printf("0\n");
        else if(dis[dx][dy]==INF)
            printf("-1\n");
        else
            printf("%d\n",dis[dx][dy]);
        //system("pause");
    }
    return 0;
}