#!/usr/bin/env python
# -*- coding: utf-8 -*-
"""Handles geometry on the earth's surface (e.g. bearing/distance)
Usage:
(library code)
"""
__version__ = "$Rev: 18454 $"
__license__ = """This program is free software: you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation, either version 3 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program. If not, see ."""
_debug = 0
from math import *
from time import clock
def bearing(a,b):
dlat = radians(b[0] - a[0])
dlon = radians(b[1] - a[1])
dlon = dlon * cos(radians(a[0]))
return(degrees(atan2(dlon, dlat)))
def distance(a,b, haversine=False):
if(haversine):
return(distance_haversine(a,b))
lat1 = radians(a[0])
lon1 = radians(a[1])
lat2 = radians(b[0])
lon2 = radians(b[1])
d = acos(sin(lat1)*sin(lat2) + cos(lat1)*cos(lat2) * cos(lon2-lon1)) * 6371;
return(d)
def distance_haversine(a,b):
dlat = radians(b[0] - a[0])
dlon = radians(b[1] - a[1])
a1 = sin(0.5 * dlat)
a2a = cos(radians(a[0]))
a2b = cos(radians(b[0]))
a3 = sin(0.5 * dlon)
a = a1*a1 + a2a*a2b * a3*a3
c = 2 * atan2(sqrt(a), sqrt(1-a))
d = 6371 * c
return(d)
def compassPoint(x):
points = ('N','NNE','NE','ENE','E','ESE','SE','SSE','S','SSW','SW','WSW','W','WNW','NW','NNW')
part = 360.0 / len(points)
x = x + 0.5 * part
while(x < 0):
x = x + 360
while(x > 360):
x = x - 360
point = int(x / part)
return(points[point])
if(__name__ == "__main__"):
if(0):
# Test compass-point names
x = -180
while(x < 360):
print "%05.1f: %s" % (x, compassPoint(x))
x = x + 15
a = (51.478,-0.4856)
b = (51.477,-0.4328)
print bearing(a,b)
for h in (True,False):
start = clock()
it = 5000
for i in range(it):
d = distance(a,b,h)
t = 1000*(clock() - start) / it
print "%s: %1.3fms / iteration, gives %f" % (h and "haversine" or "normal", t, d)