GPS算法

計算兩個GPS坐标的距離

Posted on 2010-04-20 18:34 xuanfeng 閱讀( 7347) 評論( 6) 編輯 收藏

場景：已知兩個GPS點的經緯度坐标資訊。計算兩點的距離。

1． 距離/緯度關系

  GPS: 22.514519,113.380301

  GPS: 22.511962,113.380301

距離:284.6439379583341  

jl_wd=284.6439379583341/(22.51451-22.511962)

=111712.69150641055729984301412873 (米/度)

2． 距離/經度關系

GPS: 22.514866, 113.388444

GPS: 22.514866, 113.379378

距離: 932.2997762326453

jl_jd =932.2997762326453/(113.388444-113.379378)

=102834.74258026089786013677476285(米/度)

3．勾股定理 

勾股定理:a2+b2 =c2

看上圖中已知道A，B的坐标後，就可以求得A點與B點的緯度內插補點的絕對值

wd_c=|(N1,-N2)|

A點與B點的經度內插補點的絕對值

jd_c=|(E2-E1)|

知道了經度、緯度和距離的關系，又知道了A點與B點的經度差和緯度差，那麼就可以求出b的長度和a的長度,a和b求出來後就可以用直三角形的勾股定理求出c邊的長度也就是A點也B點的距離。

b=wd_c*jl_wd

a=jd_c*jl_jd

c=√(a2 +b2)

實作代碼:

//計算兩點GPS坐标距離 
private const double EARTH_RADIUS = 6378.137;
private static double rad(double d)
{
   return d * Math.PI / 180.0;
}

public static double GetDistance(double lat1, double lng1, double lat2, double lng2)
{
   double radLat1 = rad(lat1);
   double radLat2 = rad(lat2);
   double a = radLat1 - radLat2;
   double b = rad(lng1) - rad(lng2);
   double s = 2 * Math.Asin(Math.Sqrt(Math.Pow(Math.Sin(a/2),2) +
    Math.Cos(radLat1)*Math.Cos(radLat2)*Math.Pow(Math.Sin(b/2),2)));
   s = s * EARTH_RADIUS;
   s = Math.Round(s * 10000) / 10000;
   return s;
}
           

參考網址：http://www.cnblogs.com/xuanfeng/archive/2010/04/20/1716431.html