Exemplo n.º 1
0
        public static PointResult2f ClosestPoint(IList <Vector2f> line, Vector2f point)
        {
            float         dist   = float.PositiveInfinity;
            PointResult2f result = new PointResult2f();
            Segment2f     seg;

            int count = line.Count;

            for (int i = 0; i < count - 1; i++)
            {
                int I0 = i;
                int I1 = i + 1;

                seg.A = line[I0];
                seg.B = line[I1];

                float t;
                SegmentIntersections2f.ClosestPointOnSegment(seg, point, out t);

                Vector2f closest = seg.A + (seg.B - seg.A) * t;
                float    d2      = Vector2f.SqrDistance(closest, point);
                if (d2 < dist)
                {
                    result.Hit   = true;
                    result.Point = closest;
                    result.T     = t;
                    result.A     = I0;
                    result.B     = I1;
                    dist         = d2;
                }
            }

            return(result);
        }
Exemplo n.º 2
0
        public static LineResult2f ClosestSegment(IList <Vector2f> line0, IList <Vector2f> line1)
        {
            Segment2f closest, seg0, seg1;

            float        dist   = float.PositiveInfinity;
            LineResult2f result = new LineResult2f();

            int count = line0.Count;

            for (int i = 0; i < count - 1; i++)
            {
                int I0 = i;
                int I1 = i + 1;

                seg0.A = line0[I0];
                seg0.B = line0[I1];

                for (int j = 0; j < line1.Count - 1; j++)
                {
                    int J0 = j;
                    int J1 = j + 1;

                    seg1.A = line1[j];
                    seg1.B = line1[j + 1];

                    float s, t;
                    SegmentIntersections2f.ClosestSegmentToSegments(seg0, seg1, out s, out t);

                    closest.A = seg0.A + (seg0.B - seg0.A) * s;
                    closest.B = seg1.A + (seg1.B - seg1.A) * t;

                    float d2 = closest.SqrLength;

                    if (d2 < dist)
                    {
                        dist = d2;

                        result.Hit    = true;
                        result.Point0 = closest.A;
                        result.T0     = s;
                        result.A0     = I0;
                        result.B0     = I1;

                        result.Point1 = closest.B;
                        result.T1     = t;
                        result.A1     = J0;
                        result.B1     = J1;
                    }
                }
            }

            return(result);
        }
Exemplo n.º 3
0
        public static LineResult2f LineIntersectsSegment(IList <Vector2f> line, Segment2f seg, bool reverse = false, float radius = 0.0f)
        {
            Segment2f closest, seg0;
            float     r2 = radius > 0.0f ? radius * radius : FMath.EPS;

            int count = line.Count;

            for (int i = 0; i < count - 1; i++)
            {
                int I0 = i;
                int I1 = i + 1;

                if (reverse)
                {
                    I0 = count - i - 2;
                    I1 = count - i - 1;
                }

                seg0.A = line[I0];
                seg0.B = line[I1];

                float s, t;
                SegmentIntersections2f.ClosestSegmentToSegments(seg0, seg, out s, out t);

                closest.A = seg0.A + (seg0.B - seg0.A) * s;
                closest.B = seg.A + (seg.B - seg.A) * t;

                if (closest.SqrLength < r2)
                {
                    LineResult2f result = new LineResult2f();
                    result.Hit    = true;
                    result.Point0 = closest.A;
                    result.T0     = s;
                    result.A0     = I0;
                    result.B0     = I1;

                    result.Point1 = closest.B;
                    result.T1     = t;
                    result.A1     = 0;
                    result.B1     = 1;

                    return(result);
                }
            }

            return(LineResult2f.NoHit);
        }
Exemplo n.º 4
0
        public static LineResult2f LineIntersectsLine(IList <Vector2f> line0, IList <Vector2f> line1, bool reverse0 = false, bool reverse1 = false, float radius = 0.0f)
        {
            Segment2f closest, seg0, seg1;
            float     r2 = radius > 0.0f ? radius * radius : FMath.EPS;

            int count = line0.Count;

            for (int i = 0; i < count - 1; i++)
            {
                int I0 = i;
                int I1 = i + 1;

                if (reverse0)
                {
                    I0 = count - i - 2;
                    I1 = count - i - 1;
                }

                seg0.A = line0[I0];
                seg0.B = line0[I1];

                for (int j = 0; j < line1.Count - 1; j++)
                {
                    int J0 = j;
                    int J1 = j + 1;

                    if (reverse1)
                    {
                        J0 = count - j - 2;
                        J1 = count - j - 1;
                    }

                    seg1.A = line1[j];
                    seg1.B = line1[j + 1];

                    float s, t;
                    SegmentIntersections2f.ClosestSegmentToSegments(seg0, seg1, out s, out t);

                    closest.A = seg0.A + (seg0.B - seg0.A) * s;
                    closest.B = seg1.A + (seg1.B - seg1.A) * t;

                    if (closest.SqrLength < r2)
                    {
                        LineResult2f result = new LineResult2f();
                        result.Hit    = true;
                        result.Point0 = closest.A;
                        result.T0     = s;
                        result.A0     = I0;
                        result.B0     = I1;

                        result.Point1 = closest.B;
                        result.T1     = t;
                        result.A1     = J0;
                        result.B1     = J1;

                        return(result);
                    }
                }
            }

            return(LineResult2f.NoHit);
        }