GYM 100883 I.Teleportia（Floyd）

Description
n个传送站，每个传送站有一个传送半径，一个传送站可以花费两秒到其覆盖范围内的任一传送站，一个人从(xs,ys)出发到(xe,ye)，两点间距离定义为曼哈顿距离，人的速度是单位长度每秒，问最短用时
Input
第一行一整数T表示用例组数，每组用例首先输入一整数n表示传送站数量，之后n行每行三个整数xi,yi,ri表示第i个传送站的坐标和传送半径，最后四个整数xs,ys,xe,ye表示起点和终点的坐标(0<=n<=100,-1e9<=xi,yi,xs,ys,xe,ye<=1e9,0<=ri<=1e9)
Output
输出最短用时
Sample Input
1
3
5 5 5
9 5 3
11 7 2
4 6 11 8
Sample Output
7
Solution
求出任意两点距离（用时），对于可以传送的传送站用2更新最短距离，之后Floyd跑一遍最短路即可
Code

#include<cstdio>
#include<iostream>
#include<cstring>
#include<algorithm>
#include<cmath>
#include<vector>
#include<queue>
#include<map>
#include<set>
#include<ctime>
using namespace std;
typedef long long ll;
#define INF 0x3f3f3f3f
#define maxn 111
int T,n;
ll x[maxn],y[maxn],p[maxn],dis[maxn][maxn];
ll Dis(ll x1,ll y1,ll x2,ll y2)
{
    return (x1-x2)*(x1-x2)+(y1-y2)*(y1-y2);
}
int main()
{
    scanf("%d",&T);
    while(T--)
    {
        scanf("%d",&n);
        for(int i=1;i<=n;i++)scanf("%I64d%I64d%I64d",&x[i],&y[i],&p[i]);
        scanf("%I64d%I64d%I64d%I64d",&x[0],&y[0],&x[n+1],&y[n+1]);
        p[0]=p[n+1]=0;
        for(int i=1;i<=n;i++)
            for(int j=1;j<=n;j++)
                dis[i][j]=abs(x[i]-x[j])+abs(y[i]-y[j]);
        for(int i=1;i<=n;i++)
            dis[0][i]=abs(x[i]-x[0])+abs(y[i]-y[0]),
            dis[i][n+1]=abs(x[n+1]-x[i])+abs(y[n+1]-y[i]);
        dis[0][n+1]=abs(x[n+1]-x[0])+abs(y[n+1]-y[0]);
        for(int i=1;i<=n;i++)
            for(int j=1;j<=n;j++)
                if(Dis(x[i],y[i],x[j],y[j])<=1ll*p[i]*p[i])dis[i][j]=min(dis[i][j],2ll);
        for(int k=0;k<=n+1;k++)
            for(int i=0;i<=n+1;i++)
                for(int j=0;j<=n+1;j++)
                    dis[i][j]=min(dis[i][j],dis[i][k]+dis[k][j]);
        printf("%I64d\n",dis[0][n+1]);
    }
    return 0;
}