【转】【数学】判断一个点是否在一个多边形里面

“判断一个点是否在一个多边形里”,一开始以为是个挺难的问题,但Google了一下之后发现其实蛮简单,所用到的算法叫做“Ray-casting Algorithm”,中文应该叫“光线投射算法”,这是维基百科的描述:[维基百科]

简单地说可以这么判断:从这个点引出一根“射线”,与多边形的任意若干条边相交,累计相交的边的数目,如果是奇数,那么点就在多边形内,否则点就在多边形外。

如图,A点引一条射线,与多边形3条边相交,奇数,所以A点在多边形内,而从B点引一条射线,与多边形的2条边相交,偶数,所以B点在多边形外。

我打算把这个算法用于判断地图上所在的位置是否在一个范围之内,我先用鼠标在地图上绘制出一个多边形区域,然后再用这个方法判断一个坐标是否在这个多边形范围内,我仍然拿五角星做试验品,在高德地图上描出一个五角星:

嗯?怎么五角星居然中间没被镂空?这是怎么回事?经过研究,我发现高德地图的鼠标工具的多边形填充用的是另外一套规则,叫做“None Zero Mode”,判断一个点是否在多边形内的规则就变成了:从这个点引出一根“射线”,与多边形的任意若干条边相交,计数初始化为0,若相交处被多边形的边从左到右切过,计数+1,若相交处被多边形的边从右到左切过,计数-1,最后检查计数,如果是0,点在多边形外,如果非0,点在多边形内。回到五角星的例子,这次要注意多边形线条描绘的方向:

从C点引出一条射线,与这条射线相交的两条多边形的边均是从左向右切过,总计数是2,因此C点在多边形内。用个更形象点的方式描述就是:从C点出发,一直朝一个方向走,遇到两条单行道,都是从自己的左边切至右边的方向,计数+1,计数+1,总计数所以是2。

算法实现起来居然很简单,几行代码即可,真的是几行代码,我用的是C#,大家可以轻轻松松改成别的。

public static class RayCastingAlgorithm {
        public static bool IsWithin(Point pt, IList<Point> polygon, bool noneZeroMode) {
            int ptNum = polygon.Count();
            if (ptNum < 3) {
                return false;
            }
            int j = ptNum - 1;
            bool oddNodes = false;
            int zeroState = 0;
            for (int k = 0; k < ptNum; k++) {
                Point ptK = polygon[k];
                Point ptJ = polygon[j];
                if (((ptK.Y > pt.Y) != (ptJ.Y > pt.Y)) && (pt.X < (ptJ.X - ptK.X) * (pt.Y - ptK.Y) / (ptJ.Y - ptK.Y) + ptK.X)) {
                    oddNodes = !oddNodes;
                    if (ptK.Y > ptJ.Y) {
                        zeroState++;
                    }
                    else {
                        zeroState--;
                    }
                }
                j = k;
            }
            return noneZeroMode?zeroState!=0:oddNodes;
        }
    }

我用WPF写了个demo,如图:

给懒得敲打吗的同学玩玩。(源码:VS2015

 

原文地址: https://www.cnblogs.com/guogangj/p/5127527.html

 

考虑到double值有误差,以及有时在线的边上一点就需要识别为区域内,所以改了下加了个容差值(当然没考虑算法速度的问题,只是判断点是否在线上,有其他好的思路的可以提供下啊)

算法方法:

public static bool IsWithin(Point pt, IList<Point> polygon, bool noneZeroMode, double dTol = 0)
        {
            int ptNum = polygon.Count();
            if (ptNum < 3)
            {
                return false;
            }
            int j = ptNum - 1;
            bool oddNodes = false;
            int zeroState = 0;
            for (int k = 0; k < ptNum; k++)
            {
                Point ptK = polygon[k];
                Point ptJ = polygon[j];
                if (((ptK.Y > pt.Y) != (ptJ.Y > pt.Y)) && (pt.X < (ptJ.X - ptK.X) * (pt.Y - ptK.Y) / (ptJ.Y - ptK.Y) + ptK.X))
                {
                    oddNodes = !oddNodes;
                    if (ptK.Y > ptJ.Y)
                    {
                        zeroState++;
                    }
                    else
                    {
                        zeroState--;
                    }
                }
                j = k;
            }
            bool flag = noneZeroMode ? zeroState != 0 : oddNodes;
            if (flag || dTol.IsAlmostEqualTo(0)) return flag;
            //增加判断点在直线附近容差范围内划分为区域内
            {
                int len = polygon.Count;
                for (int i = 0; i < len; ++i)
                {
                    var p1 = polygon[i];
                    var p2 = i == len - 1 ? polygon[0] : polygon[i + 1];
                    var d = pt.GetDropPoint(p1, p2);
                    if (d.DistanceTo(pt).IsLessThanEqualTo(0, dTol))
                    {
                        if (d.IsInLine(p1, p2, dTol)) return true;
                    }
                }
                return false;
            }
        }

用到的其他一些容差计算的方法:

public static class CommonExpand
    {
        /// <summary>
        /// 判断两个double是否相同
        /// </summary>
        /// <param name="src"></param>
        /// <param name="dst"></param>
        /// <param name="dTol"></param>
        /// <returns></returns>
        public static bool IsAlmostEqualTo(this double src, double dst, double dTol = 0.00328)
        {
            var dis = Math.Abs(src - dst);
            if (dis <= dTol)
                return true;
            else
                return false;
        }

        /// <summary>
        /// 小于
        /// </summary>
        /// <param name="src"></param>
        /// <param name="dst"></param>
        /// <param name="dTol"></param>
        /// <returns></returns>
        public static bool IsLessThan(this double src, double dst, double dTol = 0.00328)
        {
            if (src < dst && !src.IsAlmostEqualTo(dst, dTol))
                return true;
            else
                return false;
        }

        /// <summary>
        /// 小于等于
        /// </summary>
        /// <param name="src"></param>
        /// <param name="dst"></param>
        /// <param name="dTol"></param>
        /// <returns></returns>
        public static bool IsLessThanEqualTo(this double src, double dst, double dTol = 0.00328)
        {
            if (src < dst || src.IsAlmostEqualTo(dst, dTol))
                return true;
            else
                return false;
        }

        /// <summary>
        /// 大于
        /// </summary>
        /// <param name="src"></param>
        /// <param name="dst"></param>
        /// <param name="dTol"></param>
        /// <returns></returns>
        public static bool IsGreaterThan(this double src, double dst, double dTol = 0.00328)
        {
            if (src > dst && !src.IsAlmostEqualTo(dst, dTol))
                return true;
            else
                return false;
        }

        /// <summary>
        /// 大于等于
        /// </summary>
        /// <param name="src"></param>
        /// <param name="dst"></param>
        /// <param name="dTol"></param>
        /// <returns></returns>
        public static bool IsGreaterThanEqualTo(this double src, double dst, double dTol = 0.00328)
        {
            if (src > dst || src.IsAlmostEqualTo(dst, dTol))
                return true;
            else
                return false;
        }
        /// <summary>
        /// 判断两个Point是否相同
        /// </summary>
        /// <param name="src"></param>
        /// <param name="dst"></param>
        /// <param name="dTol"></param>
        /// <returns></returns>
        public static bool IsAlmostEqualTo(this Point src, Point dst, double dTol = 0.00328)
        {
            if (Math.Abs(src.X - dst.X) < dTol && Math.Abs(src.Y - dst.Y) < dTol)
                return true;
            else
                return false;
        }
        /// <summary>
        /// 判断两个向量是否相等
        /// </summary>
        /// <param name="src"></param>
        /// <param name="dst"></param>
        /// <param name="dTol"></param>
        /// <returns></returns>
        public static bool IsAlmostEqualTo(this Vector src, Vector dst, double dTol = 0.00328)
        {
            if (src.X.IsAlmostEqualTo(dst.X) && src.Y.IsAlmostEqualTo(dst.Y))
                return true;
            else
                return false;
        }
        /// <summary>
        /// 判断同一条直线上的点,是否在线段以内
        /// </summary>
        /// <param name="src"></param>
        /// <param name="p1"></param>
        /// <param name="p2"></param>
        /// <param name="deviation"></param>
        /// <returns></returns>
        public static bool IsInLine(this Point src, Point p1, Point p2, double deviation = 0.00328)
        {
            if (src.IsAlmostEqualTo(p1, deviation) || src.IsAlmostEqualTo(p2, deviation)) return true;
            var vec1 = new Vector(p1.X - src.X, p1.Y - src.Y); vec1.Normalize();
            var vec2 = new Vector(p2.X - src.X, p2.Y - src.Y); vec2.Normalize();
            if (vec1.IsAlmostEqualTo(-vec2))
                return true;
            else
                return false;
        }
        /// <summary>
        /// 点到直线的垂足
        /// </summary>
        /// <param name="src"></param>
        /// <param name="p1"></param>
        /// <param name="p2"></param>
        /// <returns></returns>
        public static Point GetDropPoint(this Point src, Point p1, Point p2)
        {
            if (p1.X.IsAlmostEqualTo(p2.X))
            { return new Point(p1.X, src.Y); }
            else if (p1.Y.IsAlmostEqualTo(p2.Y))
            { return new Point(src.X, p1.Y); }
            else
            {
                double k = (p2.Y - p1.Y) / (p2.X - p1.X);
                double b1 = p1.Y - k * p1.X;
                double b2 = src.Y + src.X / k;
                double x = k * (b2 - b1) / (k * k + 1);
                double y = k * x + b1;
                return new Point(x, y);
            }
        }
        /// <summary>
        /// 点到点的距离
        /// </summary>
        /// <param name="src"></param>
        /// <param name="dst"></param>
        /// <returns></returns>
        public static double DistanceTo(this Point src, Point dst)
        {
            return Math.Sqrt(Math.Pow(src.X - dst.X, 2) + Math.Pow(src.Y - dst.Y, 2));
        }
    }

 

posted on 2021-11-19 10:43  梦琪小生  阅读(432)  评论(0编辑  收藏  举报

导航