Exemple #1
0
        public bool TryGetIntersection(Vector2D point, out IntersectionInfo result)
        {
            ContainmentType contains;

            rect.Contains(ref point, out contains);
            if (contains == ContainmentType.Contains)
            {
                int x = (int)Math.Floor((point.X - rect.Min.X) * gridSpacingInv);
                int y = (int)Math.Floor((point.Y - rect.Min.Y) * gridSpacingInv);

                Scalar bottomLeft  = nodes[x][y];
                Scalar bottomRight = nodes[x + 1][y];
                Scalar topLeft     = nodes[x][y + 1];
                Scalar topRight    = nodes[x + 1][y + 1];

                if (bottomLeft <= 0 ||
                    bottomRight <= 0 ||
                    topLeft <= 0 ||
                    topRight <= 0)
                {
                    Scalar xPercent = (point.X - (gridSpacing * x + rect.Min.X)) * gridSpacingInv;
                    Scalar yPercent = (point.Y - (gridSpacing * y + rect.Min.Y)) * gridSpacingInv;

                    Scalar top, bottom, distance;

                    MathHelper.Lerp(ref topLeft, ref topRight, ref xPercent, out top);
                    MathHelper.Lerp(ref bottomLeft, ref bottomRight, ref xPercent, out bottom);
                    MathHelper.Lerp(ref bottom, ref top, ref yPercent, out distance);

                    if (distance <= 0)
                    {
                        Scalar right, left;

                        MathHelper.Lerp(ref bottomRight, ref topRight, ref yPercent, out right);
                        MathHelper.Lerp(ref bottomLeft, ref topLeft, ref yPercent, out left);

                        Vector2D normal;
                        normal.X = right - left;
                        normal.Y = top - bottom;
                        //Vector2D.Normalize(ref normal, out result.Normal);
                        result.rawNormal  = normal;
                        result.normalized = false;
                        result.Position   = point;
                        result.Distance   = distance;
                        return(true);
                    }
                }
            }
            result = IntersectionInfo.Zero;
            return(false);
        }
        public bool TryGetIntersection(Vector2D point, out IntersectionInfo result)
        {
            ContainmentType contains;
            rect.Contains(ref point,out contains);
            if (contains == ContainmentType.Contains)
            {
                int x = (int)Math.Floor((point.X - rect.Min.X) * gridSpacingInv);
                int y = (int)Math.Floor((point.Y - rect.Min.Y) * gridSpacingInv);

                Scalar bottomLeft = nodes[x][y];
                Scalar bottomRight = nodes[x + 1][y];
                Scalar topLeft = nodes[x][y + 1];
                Scalar topRight = nodes[x + 1][y + 1];

                if (bottomLeft <= 0 ||
                    bottomRight <= 0 ||
                    topLeft <= 0 ||
                    topRight <= 0)
                {
                    Scalar xPercent = (point.X - (gridSpacing * x + rect.Min.X)) * gridSpacingInv;
                    Scalar yPercent = (point.Y - (gridSpacing * y + rect.Min.Y)) * gridSpacingInv;

                    Scalar top, bottom, distance;

                    MathHelper.Lerp(ref topLeft, ref topRight, ref xPercent, out top);
                    MathHelper.Lerp(ref bottomLeft, ref bottomRight, ref xPercent, out bottom);
                    MathHelper.Lerp(ref bottom, ref top, ref yPercent, out distance);

                    if (distance <= 0)
                    {
                        Scalar right, left;

                        MathHelper.Lerp(ref bottomRight, ref topRight, ref yPercent, out right);
                        MathHelper.Lerp(ref bottomLeft, ref topLeft, ref yPercent, out left);

                        Vector2D normal;
                        normal.X = right - left;
                        normal.Y = top - bottom;
                        Vector2D.Normalize(ref normal, out result.Normal);
                        result.Position = point;
                        result.Distance = distance;
                        return true;
                    }
                }
            }
            result = IntersectionInfo.Zero;
            return false;
        }
Exemple #3
0
 public override bool TryGetIntersection(Vector2D vector, out IntersectionInfo info)
 {
     if (grid == null)
     {
         throw new NotSupportedException();
     }
     Vector2D local;
     Vector2D.Transform(ref matrix2DInv.VertexMatrix, ref vector, out local);
     if (grid.TryGetIntersection(local, out info))
     {
         Vector2D.Transform(ref matrix2D.NormalMatrix, ref info.normal, out info.normal);
         info.location = vector;
         return true;
     }
     return false;
 }
Exemple #4
0
        public bool TryGetIntersection(Vector2D vector, out IntersectionInfo result)
        {
            if (BoundingBox2D.TestIntersection(ref box, ref vector))
            {
                int x = (int)Math.Floor((vector.X - box.Lower.X) * gridSpacingInv);
                int y = (int)Math.Floor((vector.Y - box.Lower.Y) * gridSpacingInv);

                Scalar bottomLeft = nodes[x, y];
                Scalar bottomRight = nodes[x + 1, y];
                Scalar topLeft = nodes[x, y + 1];
                Scalar topRight = nodes[x + 1, y + 1];

                if (bottomLeft <= 0 ||
                    bottomRight <= 0 ||
                    topLeft <= 0 ||
                    topRight <= 0)
                {
                    Scalar xPercent = (vector.X - (gridSpacing * x + box.Lower.X)) * gridSpacingInv;
                    Scalar yPercent = (vector.Y - (gridSpacing * y + box.Lower.Y)) * gridSpacingInv;

                    Scalar top, bottom, distance;

                    MathHelper.Lerp(ref topLeft, ref topRight, ref xPercent, out top);
                    MathHelper.Lerp(ref bottomLeft, ref bottomRight, ref xPercent, out bottom);
                    MathHelper.Lerp(ref bottom, ref top, ref yPercent, out distance);

                    if (distance <= 0)
                    {
                        Scalar right, left;

                        MathHelper.Lerp(ref bottomRight, ref topRight, ref yPercent, out right);
                        MathHelper.Lerp(ref bottomLeft, ref topLeft, ref yPercent, out left);

                        Vector2D normal;
                        normal.X = right - left;
                        normal.Y = top - bottom;
                        Vector2D.Normalize(ref normal, out normal);
                        result = new IntersectionInfo(vector, normal, distance);
                        return true;
                    }
                }
            }
            result = null;
            return false;
        }
Exemple #5
0
 public override bool TryGetIntersection(Vector2D vector, out IntersectionInfo info)
 {
     Scalar result;
     Vector2D normal;
     Vector2D.Subtract(ref vector, ref position, out normal);
     Vector2D.Normalize(ref normal, out result, out normal);
     result -= radius;
     if (result <= 0)
     {
         info = new IntersectionInfo(vector, normal, result);
         return true;
     }
     info = null;
     return false;
 }
Exemple #6
0
 public override bool TryGetIntersection(Vector2D vector, out IntersectionInfo info)
 {
     throw new NotSupportedException();
 }