noip2014寻找道路

寻找道路
(road.cpp/c/pas)
【问题描述】
在有向图 G 中，每条边的长度均为 1，现给定起点和终点，请你在图中找一条从起点到
终点的路径，该路径满足以下条件：
1．路径上的所有点的出边所指向的点都直接或间接与终点连通。
2．在满足条件 1 的情况下使路径最短。
注意：图 G 中可能存在重边和自环，题目保证终点没有出边。
请你输出符合条件的路径的长度。
【输入】
输入文件名为 road.in。
第一行有两个用一个空格隔开的整数 n 和 m，表示图有n 个点和 m 条边。
接下来的 m 行每行 2 个整数 x、 y， 之间用一个空格隔开， 表示有一条边从点 x指向点 y。
最后一行有两个用一个空格隔开的整数 s、t，表示起点为s，终点为 t。
【输出】
输出文件名为 road.out。
输出只有一行，包含一个整数，表示满足题目描述的最短路径的长度。如果这样的路径
不存在，输出-1。
【输入输出样例 1】
road.in
3 2
1 2
2 1
1 3
road.out
－1

#include<cstdio>
#include<cstring>
using namespace std;
const int maxn=10005,maxm=20005,inf=1<<30;
int head1[maxn],head2[maxn];
struct edge{
    int to,next;
}g1[maxm],g2[maxm];
int que[maxn];
int n,m,s,t;
int num1,num2;
bool used[maxn];
int d[maxn];
bool sign[maxn];
void add1(int u,int v){
    num1++;
    g1[num1].to=v;
    g1[num1].next=head1[u];
    head1[u]=num1;
}
void add2(int u,int v){
    num2++;
    g2[num2].to=v;
    g2[num2].next=head2[u];
    head2[u]=num2;
}
void spfa1(){
    int head=1,tail=1;
    que[1]=t;
    used[t]=true;
    d[t]=0;
    while (head<=tail){
        int p=que[head];
        head++;
        for(int i=head1[p];i!=-1;i=g1[i].next){
            if(d[g1[i].to]>d[p]+1){
                d[g1[i].to]=d[p]+1;
                if(used[g1[i].to]==false){
                    que[++tail]=g1[i].to;
                    used[g1[i].to]=true;
                }
            }
        }
        used[p]=false;
    }
}
void spfa2(){
    int head=1,tail=1;
    que[1]=s;
    used[s]=true;
    d[s]=0;
    while (head<=tail){
        int p=que[head];
        head++;
        for(int i=head2[p];i!=-1;i=g2[i].next){
            if(d[g2[i].to]>d[p]+1&&sign[g2[i].to]==false){
                d[g2[i].to]=d[p]+1;
                if(used[g2[i].to]==false){
                    que[++tail]=g2[i].to;
                    used[g2[i].to]=true;
                }
            }
        }
        used[p]=false;
    }
}
int main(){
    freopen("road.in","r",stdin);
    freopen("road.out","w",stdout);
    scanf("%d%d",&n,&m);
    memset(head1,-1,sizeof(head1));
    memset(head2,-1,sizeof(head2));
    num1=0,num2=0;
    for(int i=1;i<=m;i++){
        int u,v;
        scanf("%d%d",&u,&v);
        add1(v,u);
        add2(u,v);
    }
    scanf("%d%d",&s,&t);
    for(int i=1;i<=n;i++) d[i]=inf;
    memset(used,0,sizeof(used));
    spfa1();
    //for(int i=1;i<=n;i++) printf("%d %d\n",i,d[i]);
    memset(sign,0,sizeof(sign));
    if(d[s]==inf){
        printf("-1");
        return 0;
    }
    for(int i=1;i<=n;i++){
        if(d[i]==inf) {
            sign[i]=true;
            for(int j=head1[i];j!=-1;j=g1[j].next) sign[g1[j].to]=true;
        }
    }
    memset(used,0,sizeof(used));
    for(int i=1;i<=n;i++) d[i]=inf;
    spfa2();
    if(d[t]==inf) printf("-1");
    else printf("%d",d[t]); 
    return 0;
}