优化禁飞区距离算法

liusuyi

2025-12-12 595e2bc9f191b4f58aab035cd4731e84ac03db91

 ard-work/src/main/java/com/ard/work/component/websocket/handler/NoFlyDistanceManager.java

@@ -41,19 +41,26 @@
            ArdNoFlyBox box = zone.getArdNoFlyBox();
            if (box == null) continue;

            // 包围盒快速排除
            if (current.x < box.getMinx() || current.x > box.getMaxx() ||
                    current.y < box.getMiny() || current.y > box.getMaxy()) {
            // ⭐ 外扩 50 米
            ArdNoFlyBox expanded = expandBoxByMeter(box, 50);

            // ⭐ 包围盒快速排除必须使用 expanded，而不是 box
            if (current.x < expanded.getMinx() || current.x > expanded.getMaxx() ||
                    current.y < expanded.getMiny() || current.y > expanded.getMaxy()) {
                continue;
            }

            // 计算 polygon 距离
            List<Vertex> polygon = zone.getVertices();
            if (polygon == null || polygon.size() < 3) continue;

            double distance = NoFlyZoneUtils.pointToPolygonDistance(current, polygon);
            double distanceDeg = NoFlyZoneUtils.pointToPolygonDistance(current, polygon);

            if (distance < minDistance) {
                minDistance = distance;
            // ⭐ 转成米
            double distanceMeter = NoFlyZoneUtils.degDistanceToMeter(distanceDeg, current.y);

            if (distanceMeter < minDistance) {
                minDistance = distanceMeter;
                nearestZone = zone;
            }
        }
@@ -63,9 +70,26 @@
        return NoFlyDistanceDTO.builder()
                .boxSn(boxSn)
                .zoneName(nearestZone.getName())
                .distance(minDistance)
                .distance(minDistance)              // 米
                .inNoFlyZone(minDistance == 0)
                .build();
    }

    // 外扩包围盒多少米
    private ArdNoFlyBox expandBoxByMeter(ArdNoFlyBox box, double meter) {

        // 计算经纬度偏移
        double latShift = meter / 111320.0;  // 纬度方向
        double lngShift = meter / (111320.0 * Math.cos(Math.toRadians(
                (box.getMiny() + box.getMaxy()) / 2
        ))); // 经度方向与纬度相关

        return new ArdNoFlyBox(
                box.getMinx() - lngShift,
                box.getMiny() - latShift,
                box.getMaxx() + lngShift,
                box.getMaxy() + latShift
        );
    }


@@ -73,4 +97,7 @@
    protected String getMessageType() {
        return "noFlyZoneDistance";
    }



}