牧场除草问题---经纬度坐标定位某一点是否在某个多边形区域的算法!

3 篇文章 0 订阅

原文:https://blog.csdn.net/u013239236/article/details/52213661
感谢本篇算法的原作者,自己对代码做了点修改,但核心算法不变;
声明: 本文章只为记录跟解决作者自己在开发中遇到的问题。如有侵权,还望能及时联系。

需求是: 牧场 除草问题- 分区划分Id

翻译为:一个点(使用经纬度表示坐标)是否在一个多边形内部,多边形有多个点构成,每个点是一个实际的经纬度坐标,有多个点构成一个多边形。

/**
     * 计算分区
     * 2021年6月11日14:43:58
     * wzq
    * */
    private Long calculationPartition(String x,String y){
        long result = 99999;
        //相对经纬度X,Y
        String xRelative = "30.123456";
        String yRelative = "21.123456";
        //根据相对经纬x,y ;计算分别对应的实际的相对距离
        double xDistance = getDistance(Double.valueOf(x), Double.parseDouble(xRelative));
        double yDistance = getDistance(Double.valueOf(y), Double.parseDouble(yRelative));
        //总面积  比如牧场面积
        long xAxis = 1000;
        long yAxis = 1000;
        //扫描面积  比如单次除草面积
        long xBit = 4;
        long yBit = 4;
        //向上取整
        long xBlock = new BigDecimal(xAxis).divide(new BigDecimal(xBit),0, BigDecimal.ROUND_UP ).longValue();
        //向上取整
        long yBlock = new BigDecimal(yAxis).divide(new BigDecimal(yBit),0, BigDecimal.ROUND_UP ).longValue();
        // x块 * y
        //long allBlock = new BigDecimal(xBlock).multiply(new BigDecimal(yBlock)).setScale( 0, BigDecimal.ROUND_UP ).longValue();
        long id = 1;
        // 注意  注意 注意  看我循环,经纬度的顺序--》影响id 编号
        for (int j = 0; j < yBlock; j++) {
             for (int i = 0; i < xBlock; i++) {
              //左下
                Map<String, Double> map1 = new HashMap<String,Double>(2);
                map1.put("px", Double.valueOf(xBit*i));
                map1.put("py",Double.valueOf(yBit*(j+1)));
                //左上
                Map<String, Double> map2 = new HashMap<String,Double>(2);
                map2.put("px", Double.valueOf(xBit*i));
                map2.put("py", Double.valueOf(yBit*j));
                //右上
                Map<String, Double> map3 = new HashMap<String,Double>(2);
                map3.put("px", Double.valueOf(xBit*(i+1)));
                map3.put("py", Double.valueOf(yBit*j));
                //右下
                Map<String, Double> map4 = new HashMap<String,Double>(2);
                map4.put("px", Double.valueOf(xBit*(i+1)));
                map4.put("py", Double.valueOf(yBit*(j+1)));

                //组成多边形!!
                List<Map<String,Double>> areas = new ArrayList<Map<String,Double>>();
                areas.add(map1);
                areas.add(map2);
                areas.add(map3);
                areas.add(map4);

                ArrayList<Double> polygonXa = new ArrayList<Double>();
                ArrayList<Double> polygonYa = new ArrayList<Double>();
                for (int k = 0; k < areas.size(); k++) {
                    Map<String, Double> map = areas.get(k);
                    polygonXa.add(map.get("px"));
                    polygonYa.add(map.get("py"));
                }
                //true在区域内,false不在区域内
                Boolean flag = inPointInPolygon(xDistance, yDistance, polygonXa, polygonYa);
                if(flag == true){
                   return id;
                }else{
                    id++;
                    continue;
                }

            }
        }
        return result;
    };
  /**
     * 判断目标点是否在多边形内(由多个点组成)
     *
     * @param px 目标点的经度坐标
     * @param py 目标点的纬度坐标
     * @param polygonXA 多边形的经度坐标集合
     * @param polygonYA 多边形的纬度坐标集合
     * @return 2021年6月11日14:43:58
     */
    private boolean inPointInPolygon(double px, double py, ArrayList<Double> polygonXA, ArrayList<Double> polygonYA) {
        boolean isInside = false;
        double ESP = 1e-9;
        int count = 0;
        double linePoint1x;
        double linePoint1y;
        double linePoint2x = 180;
        double linePoint2y;

        linePoint1x = px;
        linePoint1y = py;
        linePoint2y = py;

        for (int i = 0; i < polygonXA.size() - 1; i++) {
            double cx1 = polygonXA.get(i);
            double cy1 = polygonYA.get(i);
            double cx2 = polygonXA.get(i + 1);
            double cy2 = polygonYA.get(i + 1);
            // 如果目标点在任何一条线上
            if (isPointOnLine(px, py, cx1, cy1, cx2, cy2)) {
                return true;
            }
            // 如果线段的长度无限小(趋于零)那么这两点实际是重合的,不足以构成一条线段
            if (Math.abs(cy2 - cy1) < ESP) {
                continue;
            }
            // 第一个点是否在以目标点为基础衍生的平行纬度线
            if (isPointOnLine(cx1, cy1, linePoint1x, linePoint1y, linePoint2x, linePoint2y)) {
                // 第二个点在第一个的下方,靠近赤道纬度为零(最小纬度)
                if (cy1 > cy2){
                    count++;
                }
            }
            // 第二个点是否在以目标点为基础衍生的平行纬度线
            else if (isPointOnLine(cx2, cy2, linePoint1x, linePoint1y, linePoint2x, linePoint2y)) {
                // 第二个点在第一个的上方,靠近极点(南极或北极)纬度为90(最大纬度)
                if (cy2 > cy1) {
                    count++;
                }
            }
            // 由两点组成的线段是否和以目标点为基础衍生的平行纬度线相交
            else if (isIntersect(cx1, cy1, cx2, cy2, linePoint1x, linePoint1y, linePoint2x, linePoint2y)) {
                count++;
            }
        }
        if (count % 2 == 1) {
            isInside = true;
        }
        return isInside;
    }
 /**
     * 目标点是否在目标区域边上
     *
     * @param px0 目标点的经度坐标
     * @param py0 目标点的纬度坐标
     * @param px1 目标线的起点(终点)经度坐标
     * @param py1 目标线的起点(终点)纬度坐标
     * @param px2 目标线的终点(起点)经度坐标
     * @param py2 目标线的终点(起点)纬度坐标
     * @return  2021年6月11日14:43:58
     */
    private boolean isPointOnLine(double px0, double py0, double px1, double py1, double px2, double py2) {
        boolean flag = false;
        // 无限小的正数
        double ESP = 1e-9;
        if ((Math.abs(Multiply(px0, py0, px1, py1, px2, py2)) < ESP) && ((px0 - px1) * (px0 - px2) <= 0)
                && ((py0 - py1) * (py0 - py2) <= 0)) {
            flag = true;
        }
        return flag;
    }
    private double Multiply(double px0, double py0, double px1, double py1, double px2, double py2) {
        return ((px1 - px0) * (py2 - py0) - (px2 - px0) * (py1 - py0));
    }
 /**
     * 是否有 横断(横断的意思就是 4(n)个点的8(n*2)个坐标 的8(n*2)个数字(每个点都有横纵坐标)只要有任意两个数字(横和横比较纵和纵比较)相等,就是横断的意思)
     * 参数为四个点的坐标
     */
    private boolean isIntersect(double px1, double py1, double px2, double py2, double px3, double py3, double px4,
                               double py4) {
        boolean flag = false;
        double d = (px2 - px1) * (py4 - py3) - (py2 - py1) * (px4 - px3);
        if (d != 0) {
            double r = ((py1 - py3) * (px4 - px3) - (px1 - px3) * (py4 - py3)) / d;
            double s = ((py1 - py3) * (px2 - px1) - (px1 - px3) * (py2 - py1)) / d;
            if ((r >= 0) && (r <= 1) && (s >= 0) && (s <= 1)) {
                flag = true;
            }
        }
        return flag;
    }
	 /**
     * 计算两个经度之间的实际距离或两个纬度之间的实际距离
     */
    public double getDistance(double lat, double lng) {
        double radLat = rad(lat>lng?lat-lng:lng-lat);
        double s = radLat;
        s = s * 6378137;
        s = Math.round(s * 10000) / 10000;
        return s;
    }
public double rad(double d) {
        return d * Math.PI / 180.0;
    }
  • 0
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 3
    评论
评论 3
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值