题目描述
给定地球的两个经纬度坐标,问这两个点的直线距离。假设地球为球体,半径为6371009米。
输入描述:
第一行一个整数T表示数据组数。
接下来n行,每行四个数lat1, lng1, lat2, lng2分别表示两个点的经纬度。
正数表示北纬和东经。
负数表示南纬和西经。
数据保证合法。
输出描述:
n行表示答案。
答案保留到米。
示例1
输入
1
43.466667 -80.516667 30.058056 31.228889
输出
802333
代码如下:
#include < algorithm>
#include < iostream>
#include < cstring>
#include < cstdlib>
#include < climits>
#include < cstdio>
#include < string>
#include < vector>
#include < queue>
#include < cmath>
#include < stack>
#include < map>
#include < set>
using namespace std;
typedef unsigned int u32;
typedef long long i64;
typedef unsigned long long u64;
typedef vector<int> IV;
typedef vector<bool> BV;
typedef pair< int,int> II;
typedef vector<II> IIV;
#define For(t,v,c) for(t::const_iterator v=c.begin(); v!=c.end(); ++v)
const int INF = 0x7FFFFFFF;
const double eps = 1E-10;
const double PI = acos(-1);
const double R = 6371009;
double torad(double deg) {
return deg / 180 * M_PI;
}
void get_coord(double lat, double lng, double& x, double& y, double& z) {
lat = torad(lat);
lng = torad(lng);
x = R * cos(lat) * cos(lng);
y = R * cos(lat) * sin(lng);
z = R * sin(lat);
}
double sqr(double x) { return x * x; }
double dist(double x1, double y1, double z1, double x2, double y2, double z2) {
return sqrt(sqr(x1 - x2) + sqr(y1 - y2) + sqr(z1 - z2));
}
int main() {
int Case;
double lat1, lng1, lat2, lng2, d1, d2;
double x1, y1, z1, x2, y2, z2;
scanf("%d", &Case);
while(Case--) {
scanf("%lf%lf%lf%lf", &lat1, &lng1, &lat2, &lng2);
get_coord(lat1, lng1, x1, y1, z1);
get_coord(lat2, lng2, x2, y2, z2);
d1 = dist(x1, y1, z1, x2, y2, z2);
d2 = 2 * asin(d1 / (2 * R)) * R;
printf("%.0lf\n", d2 - d1);
}
return 0;
}