UVA11817计算几何+经纬度坐标转化

/*UVA11817

计算几何：

总结一下公式：

1、给定圆上两点坐标

设直线距离=d

圆弧距离=2*asin(d/2/r)*r

2、拓展到球体上

设直线距离=d

最短圆弧距离=和上面相同

这里有个弯要转一下，最短弧的切面必过圆心

3、地球上坐标点用经纬度表示

from：摘录

设第一点A的经纬度为(LonA, LatA)，第二点B的经纬度为(LonB, LatB)，

按照0度经线的基准，东经北纬取经度的正值(Longitude)，西经南纬取经度负值(-Longitude)，

由（lng，lat)求的的相对三维坐标

x = R*cos(lat)*cos(lng);

y = R*cos(lat)*sin(lng);

z = R*sin(lat);

//lat维度，lng经度

 

ps：通过邮政编码查询经纬度...这也可以

 

*/

#include <stdio.h>

#include <stdlib.h>

#include <string.h>

#include <math.h>

#include <ctype.h>

#include <string>

#include <iostream>

#include <sstream>

#include <vector>

#include <queue>

#include <stack>

#include <map>

#include <list>

#include <set>

#include <algorithm>

 

using namespace std;

 

int main()

{

    int t;

    double r=6371009;

    double lat1,lng1,lat2,lng2,x1,x2,y1,y2,z1,z2,d,d2;

    cin>>t;

    while(t--)

    {//lat纬度，lng经度

        cin>>lat1>>lng1>>lat2>>lng2;

 

        lat1=lat1/180 * M_PI;

        lat2=lat2/180 * M_PI;

        lng1=lng1/180 * M_PI;

        lng2=lng2/180 * M_PI;

 

        x1 = r*cos(lat1)*cos(lng1);

        y1 = r*cos(lat1)*sin(lng1);

        z1 = r*sin(lat1);

        x2 = r*cos(lat2)*cos(lng2);

        y2 = r*cos(lat2)*sin(lng2);

        z2 = r*sin(lat2);

 

        d=sqrt((x1-x2)*(x1-x2)+(y1-y2)*(y1-y2)+(z1-z2)*(z1-z2));

        d2 = 2*asin(d/2/r)*r;

 

        cout<<(long long)(d2-d+0.5)<<endl;

    }

}