[Usaco2008 Mar]The Loathesome Hay Baler麻烦的干草打包机

Description
Farmer John新买的干草打包机的内部结构大概算世界上最混乱的了，它不象普通的机器一样有明确的内部传动装置，而是，N(2<=N<=1050)个齿轮互相作用，每个齿轮都可能驱动着多个齿轮。 FJ记录了对于每个齿轮i，记录了它的3个参数：Xi，Yi表示齿轮中心的位置坐标(−5000<=Xi<=5000; −5000<=Yi<=5000)；Ri表示该齿轮的半径(3<=Ri<=800)。驱动齿轮的位置为0,0，并且FJ也知道最终的工作齿轮位于Xt,Yt。 驱动齿轮顺时针转动，转速为10,000转/小时。你的任务是，确定传动序列中所有齿轮的转速。传动序列的定义为，能量由驱动齿轮传送到工作齿轮的过程中用到的所有齿轮的集合。对能量传送无意义的齿轮都应当被忽略。在一个半径为Rd，转速为S转/每小时的齿轮的带动下，与它相接的半径为Rx的齿轮的转速将为−S∗Rd/Rx转/小时。S前的负号的意思是，一个齿轮带动的另一个齿轮的转向会与它的转向相反。 FJ只对整个传动序列中所有齿轮速度的绝对值之和感兴趣，你的任务也就相应转化成求这个值。机器中除了驱动齿轮以外的所有齿轮都被另外某个齿轮带动，并且不会出现2个不同的齿轮带动同一个齿轮的情况。 相信你能轻易地写个程序来完成这些计算:)

Input
第1行: 3个用空格隔开的整数：N，Xt，Yt
第2..N+1行: 第i+1描述了齿轮i的位置及半径：Xi，Yi，以及Ri

Output
第1行: 输出所有在传动中起到作用的齿轮转速的绝对值，包括驱动齿轮和 工作齿轮。只需要输出答案的整数部分

Sample Input
4 32 54
0 0 10
0 30 20
32 54 20
-40 30 20

输入说明
机器里一共有4个齿轮，位于0,0的是半径为10的驱动齿轮，它带动了位于0,30的，半径为20的某个齿轮。这个齿轮又间接带动了位于32,54，半径为20的工作齿轮，以及一个位于-40,30，半径同样为20的冗余的齿轮。

Sample Output
20000

HINT

输出说明

齿轮 位置 半径 转速 1 (0,0) 10 10,000 2 (0,30) 20 -5,000 3 (32,54) 20 5,000

齿轮转速绝对值之和:20,000

Source
Silver

题解
bfs，首先找到起点s到终点t，由于每个齿轮只被一个齿轮带动，所以可以记录一个ans[i]表示搜到i点总计的转速的绝对值。

v[i]=v[u]*r[u]/r[i]ans[i]=ans[u]+v[i]

最后输出ans[t]即可

代码

#include <cstdio>#include <cmath>const int maxn=1050;const double eps=0.000001;//浮点数精度误差struct data{    double x,y,r,v,ans;};int n,s,t,head,tail,q[maxn*maxn+10],b[maxn+10];data d[maxn+10];double tx,ty;int sqr(int a){    return a*a;}int compare(double x,double y){    return (x<y+eps)&&(x>y-eps);//浮点数比较大小}double bfs(){    head=0;    tail=1;    q[1]=s;    b[s]=1;    d[s].v=10000;    d[s].ans=10000;    while(head!=tail)    {        head++;        int u=q[head];        for(int i=1; i<=n; i++)        {            if((!b[i])&&compare(sqrt(sqr(d[i].x-d[u].x)+sqr(d[i].y-d[u].y)),d[i].r+d[u].r))//如果i能从u转移过来            {                d[i].v=d[u].v*d[u].r/d[i].r;//更新v值                d[i].ans=d[u].ans+d[i].v;//更新ans值                b[i]=1;//入队                tail++;                q[tail]=i;            }        }    }    return d[t].ans;}int main(){    scanf("%d%lf%lf",&n,&tx,&ty);    for(int i=1; i<=n; i++)    {        scanf("%lf%lf%lf",&d[i].x,&d[i].y,&d[i].r);        if(compare(d[i].x,tx)&&compare(d[i].y,ty))        {            t=i;//找终点        }        if(compare(d[i].x,0)&&compare(d[i].y,0))        {            s=i;//找起点        }    }    printf("%d\n",(int)bfs());    return 0;}