【杭电-oj】-2073-无限的路（看起来很吓人的数学，开始都不敢做的）

Problem Description

甜甜从小就喜欢画图画，最近他买了一支智能画笔，由于刚刚接触，所以甜甜只会用它来画直线，于是他就在平面直角坐标系中画出如下的图形：

甜甜的好朋友蜜蜜发现上面的图还是有点规则的，于是他问甜甜：在你画的图中，我给你两个点，请你算一算连接两点的折线长度（即沿折线走的路线长度）吧。

 

Input

第一个数是正整数N（≤100）。代表数据的组数。
每组数据由四个非负整数组成x1，y1，x2，y2；所有的数都不会大于100。

 

Output

对于每组数据，输出两点(x1,y1),(x2,y2)之间的折线距离。注意输出结果精确到小数点后3位。

 

Sample Input

  
  

   
   5
0 0 0 1
0 0 1 0
2 3 3 1
99 99 9 9
5 5 5 5
  
  

 

Sample Output

  
  

   
   1.000
2.414
10.646
54985.047
0.000
  
  

对的，这是数学题！！！！

#include<stdio.h>
#include<math.h>
int main()
{
	int n;
	scanf("%d",&n);
	while(n--)
	{
		double x1,y1,x2,y2;
		double ans=0;
		scanf("%lf%lf%lf%lf",&x1,&y1,&x2,&y2);
		double t1,t2;
		if((x1+y1)>(x2+y2))				//保证x2+y2>x1+y1 
		{
			t1=x1;
			x1=x2;
			x2=t1;
			t2=y1;
			y1=y2;
			y2=t2;
		}
		if((x1+y1)!=(x2+y2)) 				//两点不在一条直线上，分步如下 
		{	
			if(y1!=0)
				ans=ans+sqrt(2*y1*y1);			//先算第一个点到(x1+y1,0)的距离 
			for(int i=1;i<=(x2+y2-x1-y1);i++)
			{
				ans=ans+(x1+y1+i)*sqrt(2.0);	// 所有平行于更号2的直线长度和 
			}
			for(int i=0;i<(x2+y2-x1-y1);i++)
			{
				ans=ans+sqrt((x1+y1+i)*(x1+y1+i)+(x1+y1+i+1)*(x1+y1+i+1));	//所有倾斜的线段长度和 
			}
			ans=ans-sqrt(2*y2*y2);				//减去多加的距离，即第二个点到(x2+y2,0)的距离 
		}
		else							//两个点在一条线上 
		{
			ans=sqrt((x2-x1)*(x2-x1)+(y2-y1)*(y2-y1));
		}
		printf("%.3lf\n",ans);
	}
	return 0;
}