原文 http://www.cnblogs.com/softfair/p/distance_of_two_latitude_and_longitude_points.htmlhtml
根據 2 個經緯度點,計算這 2 個經緯度點之間的距離git
球面上任意兩點之間的距離計算公式能夠參考維基百科上的下述文章。函數
值得一提的是,維基百科推薦使用Haversine公式,理由是Great-circle distance公式用到了大量餘弦函數, 而兩點間距離很短時(好比地球表面上相距幾百米的兩點),餘弦函數會得出0.999...的結果, 會致使較大的舍入偏差。而Haversine公式採用了正弦函數,即便距離很小,也能保持足夠的有效數字。 之前採用三角函數表計算時的確會有這個問題,但通過實際驗證,採用計算機來計算時,兩個公式的區別不大。 穩妥起見,這裏仍是採用Haversine公式。spa
其中orm
根據 2 個經緯度座標,距離計算函數htm
下面就是計算球面間兩點(lat1, lon1) - (lat2, lon2)之間距離的函數。blog
using System; using System.Collections.Generic; using System.Linq; using System.Text; namespace HarvenSin { class Program { /// <summary> /// 根據經緯度,計算2個點之間的距離。 /// </summary> /// <param name="args"></param> static void Main(string[] args) { //39.94607,116.32793 31.24063,121.42575 Console.WriteLine(Distance(39.94607, 116.32793, 31.24063, 121.42575)); } public static double HaverSin(double theta) { var v = Math.Sin(theta / 2); return v * v; } static double EARTH_RADIUS = 6371.0;//km 地球半徑 平均值,公里 /// <summary> /// 給定的經度1,緯度1;經度2,緯度2. 計算2個經緯度之間的距離。 /// </summary> /// <param name="lat1">經度1</param> /// <param name="lon1">緯度1</param> /// <param name="lat2">經度2</param> /// <param name="lon2">緯度2</param> /// <returns>距離(千米、公里)</returns> public static double Distance(double lat1,double lon1, double lat2,double lon2) { //用haversine公式計算球面兩點間的距離。 //經緯度轉換成弧度 lat1 = ConvertDegreesToRadians(lat1); lon1 = ConvertDegreesToRadians(lon1); lat2 = ConvertDegreesToRadians(lat2); lon2 = ConvertDegreesToRadians(lon2); //差值 var vLon = Math.Abs(lon1 - lon2); var vLat = Math.Abs(lat1 - lat2); //h is the great circle distance in radians, great circle就是一個球體上的切面,它的圓心便是球心的一個周長最大的圓。 var h = HaverSin(vLat) + Math.Cos(lat1) * Math.Cos(lat2) * HaverSin(vLon); var distance = 2 * EARTH_RADIUS * Math.Asin(Math.Sqrt(h)); return distance; } /// <summary> /// 將角度換算爲弧度。 /// </summary> /// <param name="degrees">角度</param> /// <returns>弧度</returns> public static double ConvertDegreesToRadians(double degrees) { return degrees * Math.PI / 180; } public static double ConvertRadiansToDegrees(double radian) { return radian * 180.0 / Math.PI; } } }
公式來歷:ip
VERSINE(F)=1-cos(F)ci
Haversine名字來歷是Ha-VERSINE,即Half-Versine ,表示sin的一半的意思。rem
hav(A) = (1-cos(A))/2 = sin(A/2)* sin(A/2)
推倒過程:
以下一個半徑爲1 的圓,O是圓心,A、B是弦(chord)。角度AOB=theta。則角度AOC=theta/2。OC是垂直於AB的垂線(perpendicular)。AC長度是sin(theta/2),AB長度是2*sin(theta/2)。
(圖1)
以下地球圖所示,假設半徑R爲1,O是球心,A (lat1,lon1) 和 B (lat2,lon2) 是咱們感興趣的2個點。2跟經度線 lon1,lon2相交於北極(north pole)N。EF所在的線是赤道(equator)。ACBD是平面上的等腰梯形的四個頂點(vertice)。AC和DB的弦(直線)在圖上沒有畫 出。CD的位置是:C (lat2,lon1) and D (lat1,lon2)。角度AOC是A點與C點的緯度差 dlat。角度EOF是經度E點和經度F點的差dlon。
(圖2)
弦AC的長度,參照圖1的方式,那麼是AC=2*sin(dlat/2),弦BD也是同樣的長度。
E、F 2個點是赤道上的2個點,它們的緯度是0。EF的距離是EF=2*sin(dlon/2)
A、D2個點所在的緯度是lat1。AD所在緯度的圓平面的半徑是cos(lat1)。從A做一條垂線(perpendicular)到OE爲AG,AO是球半徑,則OG=cos(lat1),即A、D所在緯度圓圈的半徑(AO`)。
這時候,AD的弦長AD= 2*sin(dlon/2)*cos(lat1),相似的能夠推出CB的長度= CB=2*sin(dlon/2)*cos(lat2)
下面看一下如何求AB的長度,回到平面等腰梯形,以下圖:
(圖3)
AH是到CB的垂線(perpendicular),CH= (CB-AD)/2。
根據勾股定理(Pythagorean theorem): 【^2表示2的平方】
AH^2 = AC^2 - CH^2
= AC^2 - (CB-AD)^2/4
HB 的長度是HB=AD+CH = AD+(CB-AD)/2 = (CB+AD)/2,根據勾股定理獲得:
AB^2 = AH^2 + HB^2
= AC^2 - (CB-AD)^2/4 + (CB+AD)^2/4
= AC^2 + CB*AD
根據前面球面上的求經緯距離的方式,咱們已經獲得 AC、AD和CB的長度,代入公式獲得:
AB^2 = 4*(sin^2(dlat/2) + 4*cos(lat1)*cos(lat2)*sin^2(dlon/2))
假設中間值h 是AB長度一半的平方,以下
h = (AB/2)^2
= (sin^2(dlat/2)) + cos(lat1) * cos(lat2) * sin^2(dlon/2)
(請參看代碼裏的h)
最後一步,是求得表明AB長度的角度AOB。參照圖1的方式,咱們能夠知道
(圖4)
設AC= ,根據勾股定理(Pythagorean theorem)獲得:
OC= = sqrt(OA^2 - AC^2)
= = sqrt(1-a) // sqrt表示開根號
若是設c是角AOB的度數值。
tan(<AOC) = tan(c)= AC/OC = sqrt(a)/sqrt(1-a)
則:
c = 2 * arctan(sqrt(a)/sqrt(1-a)),
最後的AB真實距離,把地球半徑帶上就能夠了。
distance = 2 * EARTH_RADIUS * c。
結束。
參考資料: