根据经纬度计算距离

import java.math.BigDecimal;
import java.text.DecimalFormat;
import java.util.Formatter.BigDecimalLayoutForm;

public class DisUtil {
    private static final double EARTH_RADIUS = 6378137;//赤道半径(单位m)  

    /** 
     * 转化为弧度(rad) 
     * */
    private static double rad(double d) {
        return d * Math.PI / 180.0;
    }

    /** 
     * 基于余弦定理求两经纬度距离 
     * @param lon1 第一点的精度 
     * @param lat1 第一点的纬度 
     * @param lon2 第二点的精度 
     * @param lat3 第二点的纬度 
     * @return 返回的距离,单位km 
     * */
    public static double lantitudeLongitudeDist(double lon1, double lat1,
            double lon2, double lat2) {
        double radLat1 = rad(lat1);
        double radLat2 = rad(lat2);

        double radLon1 = rad(lon1);
        double radLon2 = rad(lon2);

        if (radLat1 < 0)
            radLat1 = Math.PI / 2 + Math.abs(radLat1);// south  
        if (radLat1 > 0)
            radLat1 = Math.PI / 2 - Math.abs(radLat1);// north  
        if (radLon1 < 0)
            radLon1 = Math.PI * 2 - Math.abs(radLon1);// west  
        if (radLat2 < 0)
            radLat2 = Math.PI / 2 + Math.abs(radLat2);// south  
        if (radLat2 > 0)
            radLat2 = Math.PI / 2 - Math.abs(radLat2);// north  
        if (radLon2 < 0)
            radLon2 = Math.PI * 2 - Math.abs(radLon2);// west  
        double x1 = EARTH_RADIUS * Math.cos(radLon1) * Math.sin(radLat1);
        double y1 = EARTH_RADIUS * Math.sin(radLon1) * Math.sin(radLat1);
        double z1 = EARTH_RADIUS * Math.cos(radLat1);

        double x2 = EARTH_RADIUS * Math.cos(radLon2) * Math.sin(radLat2);
        double y2 = EARTH_RADIUS * Math.sin(radLon2) * Math.sin(radLat2);
        double z2 = EARTH_RADIUS * Math.cos(radLat2);

        double d = Math.sqrt((x1 - x2) * (x1 - x2) + (y1 - y2) * (y1 - y2)
                + (z1 - z2) * (z1 - z2));
        //余弦定理求夹角  
        double theta = Math.acos((EARTH_RADIUS * EARTH_RADIUS + EARTH_RADIUS
                * EARTH_RADIUS - d * d)
                / (2 * EARTH_RADIUS * EARTH_RADIUS));
        double dis = theta * EARTH_RADIUS;
        
        
        return formatDis(dis/1000D);
    }
    
    
    public static Double formatDis(double distance) {
        DecimalFormat df=new DecimalFormat("#.0");
        Double dis = new Double(df.format(distance));
        return dis<0.1D?0.1D:dis;
    }
    
    

    /** 
     * TODO(这里用一句话描述这个方法的作用)
     * @param args  
     * @return void    返回类型 
     */

    public static void main(String[] args) {
        
        double lon1 =120.140709;
        double lat1 = 30.273073;
        double lon2 =120.106214;
        double lat2 =30.155228;
        /*120.0908,30.29705
120.1334,30.2649

        double lon1 = 120.079115;
        double lat1 = 30.233043;
        double lon2 = 120.127862;
        double lat2 = 30.199016;
        */
        
        double w = DisUtil.lantitudeLongitudeDist(lon1, lat1, lon2, lat2);
        
        DecimalFormat df=new DecimalFormat("#.00");
        
        System.out.println(df.format(w));
        
//        double h = DisUtil.LantitudeLongitudeDist(lon1, lat1, lon1, lat2);

        System.out.println("w 距离为:" + w + " m");
//        System.out.println("h 距离为:" + h + " m");
        
        //高 5643.898183154683
    }
}
 

猜你喜欢

转载自blog.csdn.net/pianpiannia/article/details/88415403
今日推荐