1. 程式人生 > >計算兩個GPS座標的距離方法

計算兩個GPS座標的距離方法

Java 計算兩個GPS座標點之間的距離

Lat1 Lung1 表示A點經緯度,Lat2 Lung2 表示B點經緯度;
a=Lat1 – Lat2 為兩點緯度之差 b=Lung1 -Lung2 為兩點經度之差;
6378.137為地球半徑,單位為千米;
計算出來的結果單位為千米。

從google maps的腳本里扒了段程式碼,是用來計算兩點間經緯度距離

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;
    }

在android中可採用如下程式碼獲取距離

public double getDistance(double lat1, double lon1, double lat2, double lon2) {
    float[] results=new float[1];
    Location.distanceBetween(lat1, lon1, lat2, lon2, results);
    return results[0];
}

在其他裝置若沒有類似android的Location的distanceBetween方法開採用如下程式碼獲取
這個計算得出的結果是英里,如果要轉換成公里,需要乘以1.609344,若是海里需要乘以0.8684

double distance(double lat1, double lon1, double lat2, double lon2) {
    double theta = lon1 - lon2;
    double dist = Math.sin(deg2rad(lat1)) * Math.sin(deg2rad(lat2))
                + Math.cos(deg2rad(lat1)) * Math.cos(deg2rad(lat2))
                * Math.cos(deg2rad(theta));
    dist = Math.acos(dist);
    dist = rad2deg(dist);
    double miles = dist * 60 * 1.1515;
    return miles;
}
//將角度轉換為弧度
static double deg2rad(double degree) {
    return degree / 180 * Math.PI;
}
//將弧度轉換為角度
static double rad2deg(double radian) {
    return radian * 180 / Math.PI;
}

計算方位角pab,

其中lat_a, lng_a是A的緯度和經度; lat_b, lng_b是B的緯度和經度。
程式碼如下:

private double gps2d(double lat_a, double lng_a, double lat_b, double lng_b)
{
  double d = 0;
  lat_a=lat_a*Math.PI/180;
  lng_a=lng_a*Math.PI/180;
  lat_b=lat_b*Math.PI/180;
  lng_b=lng_b*Math.PI/180;

  d=Math.sin(lat_a)*Math.sin(lat_b)+Math.cos(lat_a)*Math.cos(lat_b)*Math.cos(lng_b-lng_a);
  d=Math.sqrt(1-d*d);
  d=Math.cos(lat_b)*Math.sin(lng_b-lng_a)/d;
  d=Math.asin(d)*180/Math.PI;
//d = Math.round(d*10000);
  return d;
}

地圖應用介面中使用的經緯度單位是NTU,您需要把其它單位的經緯度值轉化過來,以下為常用的轉換關係:

基本轉換:

NTU = 度*100000
度 = NTU/100000
例如:
經度 = 116.21345°
緯度 = 39.445875°
NTU經度:116.21345 * 100000 = 11621345(NTU)
NTU緯度:39.445874*100000=3944587(NTU)

度分轉換:

將度分單位資料轉換為度單位資料
度=度+分/60
例如:
經度 = 116°20.12’
緯度 = 39°12.34’
經度 = 116 + 20.12 / 60 = 116.33533°
緯度 = 39 + 12.34 / 60 = 39.20567°
NTU經度 = 116.33533 * 100000 = 11633533(NTU)
NTU緯度 = 39.20567 * 100000 = 3920567(NTU)

度分秒轉換:

將度分秒單位資料轉換為度單位資料
度 = 度 + 分 / 60 + 秒 / 60 / 60
例如:
經度 = 116°20’43”
緯度 = 39°12’37”
經度 = 116 + 20 / 60 + 43 / 60 / 60 = 116.34528°
緯度 = 39 + 12 / 60 + 37 / 60 / 60 = 39.21028°
NTU經度 = 116.34528 * 100000 = 11634528(NTU)
NTU緯度 = 39.21028 * 100000 = 3921028(NTU)

其格式的經緯值先轉換度,再採用上面的運算。
與經緯度有關的基礎知識:
NTU 相當於十萬分之一度。

如何計算經度方向距離

比如:
點A的緯度為3995400,點B的緯度為3995300,則這兩個點在沿著緯線的方向相差100米。
點A的經度為11695400,點B的經度為11695300,則這兩個點在沿著經線的方向相差大約為77米,
該值的計算方法可以用近似公式:
經度方向距離 = 經度差 * cos(緯度值) = 100 * cos(39) = 77米。
如何計算兩點間距離

比如:
點A的經度為11695400,緯度為3995400。點B的經度為11695300,緯度為3995300。
公式:兩點間距離 = [ (A點經度 - B點經度)^2 + (A點緯度 - B點緯度)^2 ] ^ (1/2) = [ (11695400 - 11695300)^2
+ (3995400 - 3995300)^2 ] ^(1/2) =(10000+10000) ^ (1/2) =141米