计算两个经纬度之间的距离 单位(m)

/**
     * 计算两个经纬度之间的距离 单位(m)
     * 
     * @param lat1
     * @param lng1
     * @param lat2
     * @param lng2
     * @return
     */
    public static double getFlatternDistance(double lat1, double lng1, double lat2, double lng2) {
        lat1 = lat1 / 360000;
        lng1 = lng1 / 360000;
        lat2 = lat2 / 360000;
        lng2 = lng2 / 360000;
        
        double f = rad((lat1 + lat2) / 2);
        double g = rad((lat1 - lat2) / 2);
        double l = rad((lng1 - lng2) / 2);
        
        double sg = Math.sin(g);
        double sl = Math.sin(l);
        double sf = Math.sin(f);
        
        double s, c, w, r, d, h1, h2;
        double a = EARTH_RADIUS;
        double fl = 1 / 298.257;
        
        sg = sg * sg;
        sl = sl * sl;
        sf = sf * sf;
        
        s = sg * (1 - sl) + (1 - sf) * sl;
        c = (1 - sg) * (1 - sl) + sf * sl;
        
        w = Math.atan(Math.sqrt(s / c));
        if (w == 0d) {
            return 0d;
        }
        r = Math.sqrt(s * c) / w;
        d = 2 * w * a;
        if (c == 0d) {
            return 0d;
        }
        h1 = (3 * r - 1) / 2 / c;
        if (s == 0d) {
            return 0d;
        }
        h2 = (3 * r + 1) / 2 / s;
        
        return Math.abs((int)(d * (1 + fl * (h1 * sf * (1 - sg) - h2 * (1 - sf) * sg))));
    }
    
    private static double rad(double d) {
        return d * Math.PI / 180.0;
    }

private static final double EARTH_RADIUS = 6378137.0;

猜你喜欢

转载自my.oschina.net/ffse54s/blog/1806787