Created
January 24, 2020 12:52
-
-
Save ultrafunkamsterdam/da8e4b253961667a279f315866c876a6 to your computer and use it in GitHub Desktop.
python vincenty geo distance
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
#!/usr/bin/env python3 | |
# coding: utf-8 | |
from __future__ import division | |
from math import atan | |
from math import atan2 | |
from math import cos | |
from math import radians | |
from math import sin | |
from math import sqrt | |
from math import tan | |
def distance(coord1,coord2,imax=200,tol=10**-12): | |
a=6378137.0 # radius at equator in meters (WGS-84) | |
f=1/298.257223563 # flattening of the ellipsoid (WGS-84) | |
b=(1-f)*a | |
phi_1,L_1,=coord1 | |
phi_2,L_2,=coord2 | |
u_1=atan((1-f)*tan(radians(phi_1))) | |
u_2=atan((1-f)*tan(radians(phi_2))) | |
L=radians(L_2-L_1) | |
Lambda=L | |
sin_u1=sin(u_1) | |
cos_u1=cos(u_1) | |
sin_u2=sin(u_2) | |
cos_u2=cos(u_2) | |
iters=0 | |
for i in range(0,imax): | |
iters+=1 | |
cos_lambda=cos(Lambda) | |
sin_lambda=sin(Lambda) | |
sin_sigma=sqrt((cos_u2*sin(Lambda))**2+(cos_u1*sin_u2-sin_u1*cos_u2*cos_lambda)**2) | |
cos_sigma=sin_u1*sin_u2+cos_u1*cos_u2*cos_lambda | |
sigma=atan2(sin_sigma,cos_sigma) | |
sin_alpha=(cos_u1*cos_u2*sin_lambda)/sin_sigma | |
cos_sq_alpha=1-sin_alpha**2 | |
cos2_sigma_m=cos_sigma-((2*sin_u1*sin_u2)/cos_sq_alpha) | |
C=(f/16)*cos_sq_alpha*(4+f*(4-3*cos_sq_alpha)) | |
Lambda_prev=Lambda | |
Lambda=L+(1-C)*f*sin_alpha*(sigma+C*sin_sigma*(cos2_sigma_m+C*cos_sigma*(-1+2*cos2_sigma_m**2))) | |
diff=abs(Lambda_prev-Lambda) | |
if diff<=tol: | |
break | |
u_sq=cos_sq_alpha*((a**2-b**2)/b**2) | |
A=1+(u_sq/16384)*(4096+u_sq*(-768+u_sq*(320-175*u_sq))) | |
B=(u_sq/1024)*(256+u_sq*(-128+u_sq*(74-47*u_sq))) | |
delta_sig=B*sin_sigma*(cos2_sigma_m+0.25*B*(cos_sigma*(-1+2*cos2_sigma_m**2)-(1/6)*B*cos2_sigma_m*(-3+4*sin_sigma**2)*(-3+4*cos2_sigma_m**2))) | |
_m=b*A*(sigma-delta_sig) | |
_mi=_m*0.000621371 | |
class Distance: | |
def __init__(self, **kw): | |
self.__dict__.update(kw) | |
def __repr__(self): | |
return ''.join([ | |
'<Distance (\n\t', | |
'\n\t'.join(f'{k}={v} ' for k,v in vars(self).items()), | |
'\n)>' | |
]) | |
return Distance( | |
meter=_m, | |
kilometer=_m/1000, | |
millimeter=_m*1000, | |
mile=_mi, | |
feet=_mi*5280, | |
inch=_mi*5280*12, | |
yard=_mi*5280/3, | |
) | |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment