根据两个经纬度坐标计算距离

最新推荐文章于 2024-05-31 10:46:10 发布

陈诞

最新推荐文章于 2024-05-31 10:46:10 发布

阅读量102

点赞数 2

分类专栏： java 文章标签： java

本文链接：https://blog.csdn.net/qq_44819536/article/details/137799537

版权

java 专栏收录该内容

1 篇文章 0 订阅

订阅专栏

代码

/**
     * 球面直线距离
     * @param lat1  纬度
     * @param lon1  经度
     * @param alt1  高度
     * @param lat2
     * @param lon2
     * @param alt2
     * @return
     */
    public static double calculateDistance(double lat1, double lon1, double alt1,
        double lat2, double lon2, double alt2) {

        // 根据Haversine公式计算地表距离
        double distanceOnEarth = calculateSurfaceDistance(lat1, lon1, lat2, lon2);

        // 计算高度差（需要确保高度单位和地表距离单位一致，这里假设都是千米）
        double heightDifference = Math.abs(alt1/1000 - alt2/1000);

        // 使用欧几里得公式计算直线距离
        double straightLineDist = Math.sqrt(Math.pow(distanceOnEarth, 2) + Math.pow(heightDifference, 2));

        double v = new BigDecimal(straightLineDist).setScale(2, BigDecimal.ROUND_HALF_UP).doubleValue();
        return v; // 返回结果
    }

    private static final int EARTH_RADIUS = 6371; // 地球平均半径，单位为千米
    /**
     * 平面直线距离
     * @param lat1
     * @param lon1
     * @param lat2
     * @param lon2
     * @return
     */
    private static double calculateSurfaceDistance(double lat1, double lon1,
        double lat2, double lon2) {
        // 转换角度到弧度
        double lat1Radians = Math.toRadians(lat1);
        double lon1Radians = Math.toRadians(lon1);
        double lat2Radians = Math.toRadians(lat2);
        double lon2Radians = Math.toRadians(lon2);

        // 根据Haversine公式计算
        double latDiff = lat2Radians - lat1Radians;
        double lonDiff = lon2Radians - lon1Radians;
        double a = Math.pow(Math.sin(latDiff / 2), 2)
            + Math.cos(lat1Radians) * Math.cos(lat2Radians)
            * Math.pow(Math.sin(lonDiff / 2), 2);

        double c = 2 * Math.atan2(Math.sqrt(a), Math.sqrt(1 - a));

        return EARTH_RADIUS * c; // 返回结果
    }