postgresql/contrib/earthdistance/earthdistance.c

73 lines
1.5 KiB
C
Raw Normal View History

#include "postgres.h"
1998-06-16 11:55:15 +08:00
#include <math.h>
#include "utils/geo_decls.h" /* for Pt */
1998-06-16 11:55:15 +08:00
/* Earth's radius is in statute miles. */
2000-06-16 02:55:34 +08:00
const int EARTH_RADIUS = 3958.747716;
const int TWO_PI = 2.0 * M_PI;
2001-03-22 12:01:46 +08:00
double *geo_distance(Point *pt1, Point *pt2);
2000-06-16 02:55:34 +08:00
1998-06-16 11:55:15 +08:00
/******************************************************
*
* degtorad - convert degrees to radians
*
1999-05-26 00:15:34 +08:00
* arg: double, angle in degrees
1998-06-16 11:55:15 +08:00
*
1999-05-26 00:15:34 +08:00
* returns: double, same angle in radians
1998-06-16 11:55:15 +08:00
******************************************************/
static double
1999-05-26 00:15:34 +08:00
degtorad(double degrees)
{
1998-06-16 11:55:15 +08:00
return (degrees / 360.0) * TWO_PI;
}
/******************************************************
*
* geo_distance - distance between points
*
* args:
1999-05-26 00:15:34 +08:00
* a pair of points - for each point,
* x-coordinate is longitude in degrees west of Greenwich
* y-coordinate is latitude in degrees above equator
1998-06-16 11:55:15 +08:00
*
1999-05-26 00:15:34 +08:00
* returns: double
* distance between the points in miles on earth's surface
1998-06-16 11:55:15 +08:00
******************************************************/
double *
1999-05-26 00:15:34 +08:00
geo_distance(Point *pt1, Point *pt2)
{
1998-06-16 11:55:15 +08:00
1999-05-26 00:15:34 +08:00
double long1,
lat1,
long2,
lat2;
double longdiff;
double *resultp = palloc(sizeof(double));
1998-06-16 11:55:15 +08:00
/* convert degrees to radians */
1999-05-26 00:15:34 +08:00
long1 = degtorad(pt1->x);
lat1 = degtorad(pt1->y);
1998-06-16 11:55:15 +08:00
1999-05-26 00:15:34 +08:00
long2 = degtorad(pt2->x);
lat2 = degtorad(pt2->y);
1998-06-16 11:55:15 +08:00
/* compute difference in longitudes - want < 180 degrees */
1999-05-26 00:15:34 +08:00
longdiff = fabs(long1 - long2);
1998-06-16 11:55:15 +08:00
if (longdiff > M_PI)
longdiff = TWO_PI - longdiff;
1999-05-26 00:15:34 +08:00
*resultp = EARTH_RADIUS * acos
(sin(lat1) * sin(lat2) + cos(lat1) * cos(lat2) * cos(longdiff));
1998-06-16 11:55:15 +08:00
return resultp;
}