POJ 1847 Tram --set实现最短路SPFA

题意很好懂，但是不好下手。这里可以把每个点编个号（1-25），看做一个点，然后能够到达即为其两个点的编号之间有边，形成一幅图，然后求最短路的问题。并且pre数组记录前驱节点，print_path()方法可用算法导论上的。

代码：

#include <iostream>
#include <cstdio>
#include <cstring>
#include <cmath>
#include <algorithm>
#include <vector>
#include <set>
#define Mod 1000000007
#define INT 2147483647
#define pi acos(-1.0)
#define eps 1e-3
#define lll __int64
#define ll long long
using namespace std;
#define N 100007

const int INF = Mod;
vector<pair<int,int> > edge[N];
set<pair<int,int> > que;
int a[][],n;
int d[N],pre[N];

void print_path(int s,int v)
{
    if(v == s)
        printf("(%d, %d)\n",(s-)/,(s%+-)%);
    else
    {
        print_path(s,pre[v]);
        printf("(%d, %d)\n",(v-)/,(v%+-)%);
    }
}

int ok(int x,int y)
{
    if(x >=  && x <  && y >=  && y < )
        return ;
    return ;
}

void SPFA()
{
    int i;
    for(i=;i<=n;i++)
        d[i] = INF;
    d[] = ;
    que.insert(make_pair(d[],));
    while(!que.empty())
    {
        int v = que.begin()->second;
        que.erase(que.begin());
        for(i=;i<edge[v].size();i++)
        {
            int to = edge[v][i].first;
            int cost = edge[v][i].second;
            if(d[v] + cost < d[to])
            {
                que.erase(make_pair(d[to],to));
                d[to] = d[v] + cost;
                pre[to] = v;
                que.insert(make_pair(d[to],to));
            }
        }
    }
    print_path(,n);
}

int main()
{
    int i,j;
    for(i=;i<;i++)
        for(j=;j<;j++)
            scanf("%d",&a[i][j]);
    for(i=;i<;i++)
    {
        for(j=;j<;j++)
        {
            if(a[i][j] == )
            {
                int ka = i* + j + ,kb;
                if(ok(i+,j) && a[i+][j] == )
                {
                    kb = ka + ;
                    edge[ka].push_back(make_pair(kb,));
                }
                if(ok(i,j+) && a[i][j+] == )
                {
                    kb = ka+;
                    edge[ka].push_back(make_pair(kb,));
                }
                if(ok(i-,j) && a[i-][j] == )
                {
                    kb = ka-;
                    edge[ka].push_back(make_pair(kb,));
                }
                if(ok(i,j-) && a[i][j-] == )
                {
                    kb = ka-;
                    edge[ka].push_back(make_pair(kb,));
                }
            }
        }
    }
    n = ;
    SPFA();
    return ;
}