Timus OJ 1056. Computer Net

http://acm.timus.ru/problem.aspx?space=1&num=1056
时隔大半年没刷题，纪念一下，为我校即将到来的第四届校赛做准备。
题意：
给你一棵树，求树的重心。
思路：
求出树的直径，然后找中间一点或两点就行。
网上应该有求树的重心模板，但只知道求树的直径，于是自己在找直径的基础上记录了一下路径再找这条路径的中点。
代码奇丑预警：
#include<bits/stdc++.h>
using namespace std;
const int INF=1e9+10;
const int N=1e4+10;
int n,a[N],vis[N];
int key1,key2,len;
int pre[N];
vectorg[N];
void dfs(int u,int dep,int flag)
{
vis[u]=1;
if(dep>len)
{
len=dep;
if(!flag) key1=u;
else key2=u;
}
int Size=g[u].size();
for(int i=0;i<Size;i++)
{
int v=g[u][i];
if(vis[v]) continue;
dfs(v,dep+1,flag);
if(flag) pre[v]=u;
}
}
int main()
{
int x;
while(~scanf("%d",&n))
{
memset(vis,0,sizeof(vis));
for(int i=1;i<=n;i++) g[i].clear();
for(int i=2;i<=n;i++)
{
scanf("%d",&x);
g[x].push_back(i);
g[i].push_back(x);
}
len=0;
dfs(1,1,0);
len=0;
memset(vis,0,sizeof(vis));
dfs(key1,1,1);
// printf(“key1=%d key2=%d len=%d\n”,key1,key2,len);
int id=1;
int ans1=-1,ans2=-1;
while(id<(len+1)/2)
{
key2=pre[key2];
id++;
}
ans1=key2;
if(len%2== 0)
{
ans2=pre[key2];
if(ans1>ans2) swap(ans1,ans2);
}
printf("%d",ans1);
if(len%2==0) printf(" %d",ans2);
puts("");
}
return 0;
}