hdu 1245(最短路+bfs)

题目链接：http://acm.hdu.edu.cn/showproblem.php?pid=1245

思路：建图，0点为湖心，n+1点为湖外，然后bfs就可以了。。。具体见代码。

#include<iostream>
#include<cmath>
#include<queue>
#define p 1e-7
const int inf=1<<30;
const int MAXN=110;
using namespace std;
double dist[MAXN][MAXN];
double cost[MAXN];
int step[MAXN];
int n,d;
struct Node{
    double x,y;
}node[MAXN];


void bfs(int now){
    queue<int>Q;
    cost[0]=0.0;
    step[0]=0;
    for(int i=1;i<=n+1;i++){
        cost[i]=inf*1.0;
        step[i]=inf;
    }
    Q.push(now);
    while(!Q.empty()){
        now=Q.front();
        Q.pop();
        for(int next=1;next<=n+1;next++){
            //如果满足条件或者能使步数减少
            if(dist[now][next]<d+p
                &&(dist[now][next]+cost[now]<cost[next]
            ||(step[now]+1<step[next]))){
                Q.push(next);
                step[next]=step[now]+1;
                cost[next]=dist[now][next]+cost[now];
            }
        }
    }
}




int main(){
    while(~scanf("%d%d",&n,&d)){
        for(int i=1;i<=n;i++){
            scanf("%lf%lf",&node[i].x,&node[i].y);
        }
        if(d+p>42.5){
            printf("42.5 1\n");
            continue;
        }
        //建图1-n的点
        for(int i=1;i<=n;i++){
            for(int j=1;j<=n;j++){
                if(i==j)dist[i][j]=0;
                else dist[i][j]=sqrt(pow((node[i].x-node[j].x),2.0)+pow((node[i].y-node[j].y),2.0));
            }
        }
        //0点为湖心，n+1点为湖外
        for(int i=1;i<=n;i++){
            dist[i][0]=dist[n+1][i]=inf;
            dist[0][i]=fabs(sqrt(pow(node[i].x,2.0)+pow(node[i].y,2.0))-7.5);
            dist[i][n+1]=min(fabs(fabs(node[i].x)-50.0),fabs(fabs(node[i].y)-50.0));
        }
        dist[0][n+1]=inf*1.0;
        bfs(0);
        if(fabs(cost[n+1]-inf)<=p){
            printf("can't be saved\n");
        }else {
            printf("%.2lf %d\n",cost[n+1],step[n+1]);
        }
    }
    return 0;
}