HDU 4308 Saving Princess claire_（简单BFS）

求出不使用P点时起点到终点的最短距离，求出起点到所有P点的最短距离，求出终点到所有P点的最短距离。

答案=min（ 不使用P点时起点到终点的最短距离， 起点到P的最短距离+终点到P的最短距离 ）

#include <cstdio>
#include <cstring>
#include <cstdlib>
#include <algorithm>
#include <queue>

using namespace std;

const int MAXN = ;
const int INF  =  << ;

const int dx[] = { -,  , ,  };
const int dy[] = {  , -, ,  };

struct node
{
    int x, y;
    int cost;
    int id;
    bool operator<( const node &rhs ) const
    {
        return cost < rhs.cost;
    }
};

int R, C, cost;
char mat[MAXN][MAXN];
bool vis[MAXN][MAXN];
int  index[MAXN][MAXN];
int G[][MAXN/];
node P[MAXN/], start, end;
int cntP;

void init( )
{
    cntP = ;
    for ( int i = ; i < R; ++i )
        for ( int j = ; j < C; ++j )
        {
            if ( mat[i][j] == 'P' )
            {
                P[cntP].x = i;
                P[cntP].y = j;
                P[cntP].cost = ;
                P[cntP].id = cntP;
                //printf( "cntP=%d [%d, %d]\n", cntP, i, j );
                ++cntP;
            }
            else if ( mat[i][j] == 'Y' )
            {
                start.x = i;
                start.y = j;
                start.cost = ;
            }
            else if ( mat[i][j] == 'C' )
            {
                end.x = i;
                end.y = j;
                end.cost = ;
            }
        }

    P[] = start;
    P[].id = ;

    P[cntP] = end;
    P[cntP].id = cntP;
    //printf( "cntP = %d\n", cntP );
    for ( int i = ; i <= cntP; ++i )
        index[ P[i].x ][ P[i].y ] = i;
    return;
}

bool check( int x, int y )
{
    if ( x >=  && x < R && y >=  && y < C ) return true;
    return false;
}

int BFS( int c, node st )
{
    for ( int i = ; i < R; ++i )
    for ( int j = ; j < C; ++j )
        vis[i][j] = false;

    queue<node> Q;

    st.cost = ;
    vis[ st.x ][ st.y ] = true;
    Q.push(st);

    while ( !Q.empty() )
    {
        node cur = Q.front();
        Q.pop();

        for ( int i = ; i < ; ++i )
        {
            int xx = cur.x + dx[i];
            int yy = cur.y + dy[i];
            if ( check( xx, yy ) && mat[xx][yy] != '#' && !vis[xx][yy] )
            {
                node next;
                next.x = xx;
                next.y = yy;
                next.cost = cur.cost;
                next.id = index[xx][yy];
                if ( mat[xx][yy] != '*' )
                {
                    int id = index[xx][yy];
                    G[c][id] = next.cost;
                }
                else
                    next.cost += cost;

                vis[xx][yy] = true;
                Q.push(next);
            }
        }
    }
    return INF;
}

int getG()
{
    //printf("***cntP=%d\n", cntP);
    for ( int i = ; i <= cntP; ++i )
    {
        G[][i] = INF;
        G[][i] = INF;
    }

    BFS( , P[] );
    BFS( , P[cntP] );

    int ans = G[][cntP];
    //printf("***ans=%d\n", ans );

    for ( int i = ; i < cntP; ++i )
        for ( int j = ; j < cntP; ++j )
        {
            if ( G[][i] < INF && G[][j] < INF )
                ans = min( ans, G[][i] + G[][j] );
            //printf( "ans = %d\n", ans );
        }

    return ans;
}

int main()
{
    while ( scanf( "%d%d%d", &R, &C, &cost ) ==  )
    {
        for ( int i = ; i < R; ++i )
            scanf( "%s", mat[i] );

        init();
        int ans = getG();

        if ( ans < INF ) printf( "%d\n", ans );
        else puts("Damn teoy!");
    }
    return ;
}