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

Description

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

• 第1行: 3个用空格隔开的整数：N，X_t，Y_t

• 第2..N+1行: 第i+1描述了齿轮i的位置及半径：X_i，Y_i，以及R_i
  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

题解：
先两两判断是否相连，然后从驱动轮开始BFS一次并保留路径，最后遍历一次路径求出解。

#include <iostream>
#include <cstdio>
#include <cstdlib>
#include <cstring>
#include <cmath>
#include <algorithm>
#include <vector>
#include <queue>
#include <set>
const int fix=5000;
using namespace std;
int n,x,y,start,end;
typedef struct Node
{
    int x,y,r,num;
}Node;
Node node[1100];
vector<int>join[1100];
int father[1100];
bool vis[1100];
void BFS()
{
    Node tmp;
    tmp=node[start];
    queue<Node>q;
    q.push(tmp);
    while(!q.empty())
    {
        tmp=q.front();
        q.pop();
        if(tmp.num==end)
            break;
        for(int i=0;i<join[tmp.num].size();i++)
        {
            if(!vis[join[tmp.num][i]])
            {
                vis[join[tmp.num][i]]=1;
                father[join[tmp.num][i]]=tmp.num;
                q.push(node[join[tmp.num][i]]);
            }
        }
    }
}
vector<int>way;
bool if_join(Node a,Node b)
{
    if((a.x-b.x)*(a.x-b.x)+(a.y-b.y)*(a.y-b.y)==(a.r+b.r)*(a.r+b.r))
        return 1;
    return 0;
}
int main()
{
    cin >> n >> x >> y;
    for(int i=0;i<n;i++)
    {
        node[i].num=i;
        scanf("%d%d%d",&node[i].x,&node[i].y,&node[i].r);
        if(node[i].x==0 && node[i].y==0)
            start=i;
        if(node[i].x==x && node[i].y==y)
            end=i;
    }
    for(int i=0;i<n;i++)
    {
        for(int j=i+1;j<n;j++)
        {
            if(if_join(node[i],node[j]))
            {
                join[i].push_back(j);
                join[j].push_back(i);
            }
        }
    }
    BFS();
    int now=end;
    while(now!=start)
    {
        way.push_back(now);
        now=father[now];
    }
    way.push_back(start);
    double total=10000,now1=10000;
    for(int i=way.size()-1;i>=1;i--)
    {
        now1=-now1*((double)node[way[i]].r/node[way[i-1]].r);
        total+=fabs(now1);
    }
    cout << (int)total << endl;
    return 0;
}