Exemplo n.º 1
0
        public static bool RaycastShArc(Ray ray, out float t, Vector3 arcOrigin, Vector3 arcStartPoint, Vector3 arcPlaneNormal, float degreesFromStart, ArcEpsilon epsilon = new ArcEpsilon())
        {
            t = 0.0f;

            degreesFromStart = ConvertToSh3DArcAngle(arcOrigin, arcStartPoint, arcPlaneNormal, degreesFromStart);
            Plane arcPlane = new Plane(arcPlaneNormal, arcOrigin);

            float rayEnter;

            if (arcPlane.Raycast(ray, out rayEnter) &&
                ShArcContains3DPoint(ray.GetPoint(rayEnter), false, arcOrigin,
                                     arcStartPoint, arcPlaneNormal, degreesFromStart, epsilon))
            {
                t = rayEnter;
                return(true);
            }

            if (epsilon.ExtrudeEps != 0.0f)
            {
                float dot = Vector3Ex.AbsDot(ray.direction, arcPlaneNormal);
                if (dot < ExtrudeEpsThreshold.Get)
                {
                    OBB arcOBB = CalcSh3DArcOBB(arcOrigin, arcStartPoint, arcPlaneNormal, degreesFromStart, epsilon);
                    return(BoxMath.Raycast(ray, arcOBB.Center, arcOBB.Size, arcOBB.Rotation));
                }
            }

            return(false);
        }
Exemplo n.º 2
0
 public static bool LgArcContains2DPoint(Vector2 point, Vector2 arcOrigin, Vector2 arcStartPoint, float degreesFromStart, ArcEpsilon epsilon = new ArcEpsilon())
 {
     epsilon.ExtrudeEps = 0.0f;
     return(LgArcContains3DPoint(point.ToVector3(), false, arcOrigin.ToVector3(), arcStartPoint.ToVector3(), Vector3.forward, degreesFromStart, epsilon));
 }
Exemplo n.º 3
0
        public static OBB CalcLg3DArcOBB(Vector3 arcOrigin, Vector3 arcStartPoint, Vector3 arcPlaneNormal, float degreesFromStart, ArcEpsilon epsilon = new ArcEpsilon())
        {
            if (Math.Abs(degreesFromStart) <= 180.0f)
            {
                return(CalcSh3DArcOBB(arcOrigin, arcStartPoint, arcPlaneNormal, degreesFromStart, epsilon));
            }

            Vector3 toStartPt      = (arcStartPoint - arcOrigin);
            Vector3 toEndPt        = Quaternion.AngleAxis(degreesFromStart, arcPlaneNormal) * toStartPt;
            Vector3 endPt          = arcOrigin + toEndPt;
            Vector3 fromStartToEnd = (endPt - arcStartPoint);
            Vector3 midPt          = arcStartPoint + fromStartToEnd * 0.5f;
            Vector3 toMidPt        = midPt - arcOrigin;

            midPt += toMidPt.normalized * epsilon.AreaEps;

            float      radius      = (arcOrigin - arcStartPoint).magnitude;
            float      obbDepth    = radius + toMidPt.magnitude + 2.0f * epsilon.AreaEps;
            Quaternion obbRotation = Quaternion.LookRotation(toMidPt.normalized, arcPlaneNormal);
            Vector3    obbCenter   = midPt - toMidPt.normalized * obbDepth * 0.5f;
            OBB        obb         = new OBB(obbCenter, obbRotation);

            float obbWidth  = (radius + epsilon.AreaEps) * 2.0f;
            float obbHeight = epsilon.ExtrudeEps * 2.0f;

            obb.Size = new Vector3(obbWidth, obbHeight, obbDepth);

            return(obb);
        }
Exemplo n.º 4
0
        public static bool Is3DPointOnLgArcWire(Vector3 point, bool checkOnPlane, Vector3 arcOrigin, Vector3 arcStartPoint,
                                                Vector3 arcPlaneNormal, float degreesFromStart, ArcEpsilon epsilon = new ArcEpsilon())
        {
            if (Mathf.Abs(degreesFromStart) <= 180.0f)
            {
                return(Is3DPointOnShArcWire(point, checkOnPlane, arcOrigin, arcStartPoint, arcPlaneNormal, degreesFromStart, epsilon));
            }

            Vector3 toStartPt = (arcStartPoint - arcOrigin);
            Vector3 toPt      = (point - arcOrigin);

            float distToPt  = toPt.magnitude;
            float arcRadius = (arcOrigin - arcStartPoint).magnitude;

            Plane arcPlane = new Plane(arcPlaneNormal, arcOrigin);

            if (checkOnPlane && arcPlane.GetAbsDistanceToPoint(point) > epsilon.ExtrudeEps)
            {
                return(false);
            }

            Vector3 arcEndPoint         = Quaternion.AngleAxis(degreesFromStart, arcPlaneNormal) * toStartPt + arcOrigin;
            float   distanceFromSegment = point.GetDistanceToSegment(arcOrigin, arcStartPoint);

            if (distanceFromSegment <= epsilon.WireEps)
            {
                return(true);
            }

            distanceFromSegment = point.GetDistanceToSegment(arcOrigin, arcEndPoint);
            if (distanceFromSegment <= epsilon.WireEps)
            {
                return(true);
            }

            degreesFromStart = ConvertToSh3DArcAngle(arcOrigin, arcStartPoint, arcPlaneNormal, degreesFromStart);
            float startToPtAngle = Vector3Ex.SignedAngle(toStartPt, toPt, arcPlaneNormal);

            if (Mathf.Sign(startToPtAngle) == Mathf.Sign(degreesFromStart) &&
                Mathf.Abs(startToPtAngle) <= Mathf.Abs(degreesFromStart))
            {
                return(false);
            }

            return(distToPt >= arcRadius - epsilon.WireEps &&
                   distToPt <= arcRadius + epsilon.WireEps);
        }
Exemplo n.º 5
0
        public static OBB CalcSh3DArcOBB(Vector3 arcOrigin, Vector3 arcStartPoint, Vector3 arcPlaneNormal, float degreesFromStart, ArcEpsilon epsilon = new ArcEpsilon())
        {
            degreesFromStart = ConvertToSh3DArcAngle(arcOrigin, arcStartPoint, arcPlaneNormal, degreesFromStart);

            Vector3 toStartPt     = (arcStartPoint - arcOrigin);
            Vector3 toMidBorderPt = Quaternion.AngleAxis(degreesFromStart * 0.5f, arcPlaneNormal) * toStartPt;
            Vector3 midBorderPt   = arcOrigin + toMidBorderPt;

            Quaternion obbRotation = Quaternion.LookRotation(toMidBorderPt.normalized, arcPlaneNormal);
            Vector3    obbCenter   = arcOrigin + toMidBorderPt * 0.5f;
            OBB        obb         = new OBB(obbCenter, obbRotation);

            Vector3 toEndPt    = Quaternion.AngleAxis(degreesFromStart, arcPlaneNormal) * toStartPt;
            float   sizeEpsAdd = 2.0f * epsilon.AreaEps;
            float   obbWidth   = Vector3Ex.AbsDot(toEndPt, obb.Right) + Vector3Ex.AbsDot(toStartPt, obb.Right) + sizeEpsAdd;
            float   obbDepth   = midBorderPt.magnitude + sizeEpsAdd;
            float   obbHeight  = epsilon.ExtrudeEps * 2.0f;

            obb.Size = new Vector3(obbWidth, obbHeight, obbDepth);

            return(obb);
        }
Exemplo n.º 6
0
        public static bool LgArcContains3DPoint(Vector3 point, bool checkOnPlane, Vector3 arcOrigin, Vector3 arcStartPoint,
                                                Vector3 arcPlaneNormal, float degreesFromStart, ArcEpsilon epsilon = new ArcEpsilon())
        {
            degreesFromStart %= 360.0f;
            if (Mathf.Abs(degreesFromStart) <= 180.0f)
            {
                return(ShArcContains3DPoint(point, checkOnPlane, arcOrigin, arcStartPoint, arcPlaneNormal, degreesFromStart, epsilon));
            }

            Vector3 toPt      = (point - arcOrigin);
            Vector3 toStartPt = (arcStartPoint - arcOrigin);

            degreesFromStart = ConvertToSh3DArcAngle(arcOrigin, arcStartPoint, arcPlaneNormal, degreesFromStart);
            float startToPtAngle      = Vector3Ex.SignedAngle(toStartPt, toPt, arcPlaneNormal);
            bool  isInsideShortestArc = Mathf.Sign(startToPtAngle) == Mathf.Sign(degreesFromStart) &&
                                        Mathf.Abs(startToPtAngle) <= Mathf.Abs(degreesFromStart);

            if (isInsideShortestArc && epsilon.AreaEps != 0.0f)
            {
                Vector3 arcEndPoint         = Quaternion.AngleAxis(degreesFromStart, arcPlaneNormal) * toStartPt + arcOrigin;
                float   distanceFromSegment = point.GetDistanceToSegment(arcOrigin, arcStartPoint);
                if (distanceFromSegment <= epsilon.AreaEps)
                {
                    return(true);
                }

                distanceFromSegment = point.GetDistanceToSegment(arcOrigin, arcEndPoint);
                if (distanceFromSegment <= epsilon.AreaEps)
                {
                    return(true);
                }

                return(false);
            }

            float arcRadius = (arcOrigin - arcStartPoint).magnitude + epsilon.AreaEps;

            return(toPt.magnitude <= arcRadius);
        }
Exemplo n.º 7
0
        public static bool ShArcContains2DPoint(Vector2 point, Vector2 arcOrigin, Vector2 arcStartPoint, float degreesFromStart, ArcEpsilon epsilon = new ArcEpsilon())
        {
            degreesFromStart   = ArcMath.ConvertToSh2DArcAngle(arcOrigin, arcStartPoint, degreesFromStart);
            epsilon.ExtrudeEps = 0.0f;

            return(ShArcContains3DPoint(point.ToVector3(), false, arcOrigin.ToVector3(), arcStartPoint.ToVector3(), Vector3.forward, degreesFromStart, epsilon));
        }
Exemplo n.º 8
0
        public static bool ShArcContains3DPoint(Vector3 point, bool checkOnPlane, Vector3 arcOrigin, Vector3 arcStartPoint,
                                                Vector3 arcPlaneNormal, float degreesFromStart, ArcEpsilon epsilon = new ArcEpsilon())
        {
            Vector3 toStartPt = (arcStartPoint - arcOrigin);
            Vector3 toPt      = (point - arcOrigin);

            float arcRadius = (arcOrigin - arcStartPoint).magnitude + epsilon.AreaEps;

            if (arcRadius < toPt.magnitude)
            {
                return(false);
            }

            Plane arcPlane = new Plane(arcPlaneNormal, arcOrigin);

            if (checkOnPlane && arcPlane.GetAbsDistanceToPoint(point) > epsilon.ExtrudeEps)
            {
                return(false);
            }

            float startToPtAngle = Vector3Ex.SignedAngle(toStartPt, toPt, arcPlaneNormal);

            if (Mathf.Sign(startToPtAngle) == Mathf.Sign(degreesFromStart) &&
                Mathf.Abs(startToPtAngle) <= Mathf.Abs(degreesFromStart))
            {
                return(true);
            }

            if (epsilon.AreaEps != 0.0f)
            {
                Vector3 arcEndPoint         = Quaternion.AngleAxis(degreesFromStart, arcPlaneNormal) * toStartPt + arcOrigin;
                float   distanceFromSegment = point.GetDistanceToSegment(arcOrigin, arcStartPoint);
                if (distanceFromSegment <= epsilon.AreaEps)
                {
                    return(true);
                }

                distanceFromSegment = point.GetDistanceToSegment(arcOrigin, arcEndPoint);
                if (distanceFromSegment <= epsilon.AreaEps)
                {
                    return(true);
                }
            }

            return(false);
        }