#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#define PI 3.1415926
#define rad(x) (x * PI / 180.0)
double gps2d(double lata, double lona, double latb, double lonb)
{
double d = 0;
double lta = lata * PI/180;
double lga = lona * PI/180;
double ltb = latb * PI/180;
double lgb = lonb * PI/180;
d = sin(lta)* sin(ltb) + cos(lta)*cos(ltb)*cos(lgb-lga);
d = sqrt(1-d*d);
d = cos(ltb)*sin(lgb-lga)/d;
d = asin(d)*180.0/PI;
printf("d = %lf\n",d);
return d;
}
double gps12d(double lata, double lona, double latb, double lonb)
{
double d = 0;
double radlta = rad(lata);
double radlna = rad(lona);
double radltb = rad(latb);
double radlnb = rad(lonb);
double dlon = radlnb - radlna;
double y = sin(dlon) * cos(radlta);
double x = cos(radlta) * sin(radltb) - sin(radlta) * cos(radltb) * cos(dlon);
//
2点GPS坐标求方位角
最新推荐文章于 2024-05-07 12:12:53 发布