Description
假设排球场是个无限大的网格,即对于任意的整数
z
z
z,都有
x
=
z
x=z
x=z和
y
=
z
y=z
y=z的直线存在,同学
A
(
A
x
,
A
y
)
A(A_x,A_y)
A(Ax,Ay)和同学
B
(
B
x
,
B
y
)
B(B_x,B_y)
B(Bx,By)站在整点坐标(即
A
x
,
A
y
,
B
x
,
B
y
A_x,A_y,B_x,B_y
Ax,Ay,Bx,By都是整数)上,这个网格里面,还有另外一条直线
H
H
H,用
P
x
+
Q
y
=
R
Px+Qy=R
Px+Qy=R表示,现在
A
A
A要走到
B
B
B所在的位置,他只能沿着网格或者
H
H
H这条线走,且只能在交点处换路。
求
A
A
A走到
B
B
B的最短路长度。
Input
输入的第一行包含一个整数
T
T
T,表示测试组数。
每个测试用例前面都有一个空白行。
每个测试用例由包含整数
A
x
,
A
y
,
B
x
,
B
y
A_x,A_y,B_x,B_y
Ax,Ay,Bx,By和有理数
P
,
Q
,
R
P,Q,R
P,Q,R。
( T ≤ 30 , ∣ A x , A y , B x , B y ∣ ≤ 1000 , ∣ P , Q ∣ ≤ 25 , ∣ R ∣ ≤ 20000 ) (T\le 30,|A_x,A_y,B_x,B_y|\le 1000,|P,Q|\le 25,|R|\le 20000) (T≤30,∣Ax,Ay,Bx,By∣≤1000,∣P,Q∣≤25,∣R∣≤20000)
Output
对于每个测试用例输出一个数:表示求 A A A走到 B B B的最短路长度,结果保留三位小数。
Sample Input
2
2 0 -1 1 1.0 1.0 1.0
-2 3 4 -1 1.0 -0.1 0.47
Sample Output
3.414
10.000
Solution
方案有两种,要么直接沿网格走到 B B B,此时距离为两点间哈密顿距离,要么先横向或纵向走到 H H H处,在 H H H上走到与 B B B同一横坐标或纵坐标,第二种方案有四种情况,分别求出更新最优解即可
Code
#include<cstdio>
#include<algorithm>
#include<cmath>
using namespace std;
typedef long long ll;
int T;
double x[6],y[6],p,q,r;
double dis(int i,int j)
{
return sqrt(1.0*(x[i]-x[j])*(x[i]-x[j])+1.0*(y[i]-y[j])*(y[i]-y[j]));
}
int main()
{
scanf("%d",&T);
while(T--)
{
scanf("%lf%lf%lf%lf%lf%lf%lf",&x[0],&y[0],&x[1],&y[1],&p,&q,&r);
double ans=fabs(x[0]-x[1])+fabs(y[0]-y[1]);
if(p!=0&&q!=0)
{
x[2]=x[0],y[2]=(r-p*x[0])/q;
x[3]=(r-q*y[0])/p,y[3]=y[0];
x[4]=x[1],y[4]=(r-p*x[1])/q;
x[5]=(r-q*y[1])/p,y[5]=y[1];
for(int i=2;i<=3;i++)
for(int j=4;j<=5;j++)
ans=min(ans,dis(0,i)+dis(i,j)+dis(j,1));
}
printf("%.3f\n",ans);
}
return 0;
}