// Try to see if the SolidWorks Body2 shape is a pure box.
// If so,return true. If not a box, return false.
// If it is a box, in 'corner' and 'Dx,Dy,Dx' one can get
// the box main corner and the three departing edges.
public static bool SWbodyToBox(Body2 swBody,
ref Point3D corner,
ref Vector3D Ex, ref Vector3D Ey, ref Vector3D Ez)
{
bool isbox = false;
if (swBody.GetFaceCount() == 6)
{
if (swBody.GetEdgeCount() == 12)
{
if (swBody.GetVertexCount() == 8)
{
object[] mfaces = (object[])swBody.GetFaces();
object[] medges = (object[])swBody.GetEdges();
object[] mverts = (object[])swBody.GetVertices();
isbox = true;
// rejective test 1: are all faces as planes?
bool allplanes = true;
for (int i = 0; i < 6; i++)
{
Face2 sphface = (Face2)mfaces[i];
Surface msurf = (Surface)sphface.GetSurface();
if (!msurf.IsPlane())
{
allplanes = false;
}
}
if (allplanes)
{
isbox = true;
Vector3D[] pnts = new Vector3D[8];
for (int ip = 0; ip < 8; ip++)
{
pnts[ip] = new Vector3D(((double[])((Vertex)mverts[ip]).GetPoint())[0],
((double[])((Vertex)mverts[ip]).GetPoint())[1],
((double[])((Vertex)mverts[ip]).GetPoint())[2]);
}
Vector3D pC = pnts[0];
int X_id = 0;
int Y_id = 0;
int Z_id = 0;
Vector3D pX = pnts[0];
Vector3D pY = pnts[0];
Vector3D pZ = pnts[0];
Vector3D Dx = (pX - pC);
Vector3D Dy = (pY - pC);
Vector3D Dz = (pZ - pC);
// rejective test 1: are there 3 points that define an orthogonal trihedron with pC corner?
bool found_corner = false;
for (int xi = 1; xi < 8; xi++)
{
for (int yi = xi + 1; yi < 8; yi++)
{
for (int zi = yi + 1; zi < 8; zi++)
{
pX = pnts[xi];
pY = pnts[yi];
pZ = pnts[zi];
Dx = (pX - pC);
Dy = (pY - pC);
Dz = (pZ - pC);
if ((Math.Abs(Vector3D.DotProduct(Dx, Dy)) < Dx.Length * (1e-5)) &&
(Math.Abs(Vector3D.DotProduct(Dy, Dz)) < Dx.Length * (1e-5)) &&
(Math.Abs(Vector3D.DotProduct(Dz, Dx)) < Dx.Length * (1e-5)))
{
X_id = xi; Y_id = yi; Z_id = zi;
found_corner = true;
break;
}
}
if (found_corner)
{
break;
}
}
if (found_corner)
{
break;
}
}
if (!found_corner)
{
isbox = false;
}
double box_tol = Dx.Length * (1e-5);
//System.Windows.Forms.MessageBox.Show(" Dx " + Dx + "\n" + " Dy " + Dy + "\n" + " Dz " + Dz);
// rejective test 2: is there a point opposite to pC?
Vector3D pE = pC + Dx + Dy;
bool found_E = false;
int E_id = 0;
for (int ip = 1; ip < 8; ip++)
{
Vector3D ds = pE - pnts[ip];
if (ds.Length < box_tol)
{
found_E = true;
E_id = ip;
}
}
if (!found_E)
{
isbox = false;
}
// rejective test 3: are other four points aligned?
Vector3D norm = Vector3D.CrossProduct(Dx, Dy);
norm.Normalize();
Vector3D[] ptsA = new Vector3D[4];
bool[] aligned = new bool[4];
double[] dists = new double[4];
aligned[0] = aligned[1] = aligned[2] = aligned[3] = false;
ptsA[0] = pC;
ptsA[1] = pX;
ptsA[2] = pY;
ptsA[3] = pnts[E_id];
for (int iA = 0; iA < 4; iA++)
{
for (int ip = 1; ip < 8; ip++)
{
if ((ip != E_id) && (ip != X_id) && (ip != Y_id))
{
Vector3D D = pnts[ip] - ptsA[iA];
if ((Vector3D.CrossProduct(D, norm)).Length < box_tol)
{
aligned[iA] = true;
dists[iA] = Vector3D.DotProduct(D, norm);
}
}
}
}
if ((aligned[0] != true) ||
(aligned[1] != true) ||
(aligned[2] != true) ||
(aligned[3] != true))
{
isbox = false;
}
if ((Math.Abs(dists[0] - dists[1]) > box_tol) ||
(Math.Abs(dists[0] - dists[2]) > box_tol) ||
(Math.Abs(dists[0] - dists[3]) > box_tol))
{
isbox = false;
}
// return geom.info
if (isbox)
{
corner = new Point3D(pC.X, pC.Y, pC.Z);
Ex = Dx;
Ey = Dy;
Ez = norm * dists[0];
}
}
}
}
}
return(isbox);
}
// Try to see if the SolidWorks Body2 shape is a pure box.
// If so,return true. If not a box, return false.
// If it is a box, in 'corner' and 'Dx,Dy,Dx' one can get
// the box main corner and the three departing edges.
public static bool SWbodyToBox(Body2 swBody,
ref Point3D corner,
ref Vector3D Ex, ref Vector3D Ey, ref Vector3D Ez)
{
bool isbox = false;
if (swBody.GetFaceCount() == 6)
if (swBody.GetEdgeCount() == 12)
if (swBody.GetVertexCount() == 8)
{
object[] mfaces = (object[])swBody.GetFaces();
object[] medges = (object[])swBody.GetEdges();
object[] mverts = (object[])swBody.GetVertices();
isbox = true;
// rejective test 1: are all faces as planes?
bool allplanes = true;
for (int i = 0; i < 6; i++)
{
Face2 sphface = (Face2)mfaces[i];
Surface msurf = (Surface)sphface.GetSurface();
if (!msurf.IsPlane())
{
allplanes = false;
}
}
if (allplanes)
{
isbox = true;
Vector3D[] pnts = new Vector3D[8];
for (int ip = 0; ip < 8; ip++)
pnts[ip] = new Vector3D(((double[])((Vertex)mverts[ip]).GetPoint())[0],
((double[])((Vertex)mverts[ip]).GetPoint())[1],
((double[])((Vertex)mverts[ip]).GetPoint())[2]);
Vector3D pC = pnts[0];
int X_id = 0;
int Y_id = 0;
int Z_id = 0;
Vector3D pX = pnts[0];
Vector3D pY = pnts[0];
Vector3D pZ = pnts[0];
Vector3D Dx = (pX - pC);
Vector3D Dy = (pY - pC);
Vector3D Dz = (pZ - pC);
// rejective test 1: are there 3 points that define an orthogonal trihedron with pC corner?
bool found_corner = false;
for (int xi = 1; xi < 8; xi++)
{
for (int yi = xi + 1; yi < 8; yi++)
{
for (int zi = yi + 1; zi < 8; zi++)
{
pX = pnts[xi];
pY = pnts[yi];
pZ = pnts[zi];
Dx = (pX - pC);
Dy = (pY - pC);
Dz = (pZ - pC);
if ((Math.Abs(Vector3D.DotProduct(Dx, Dy)) < Dx.Length * (1e-5)) &&
(Math.Abs(Vector3D.DotProduct(Dy, Dz)) < Dx.Length * (1e-5)) &&
(Math.Abs(Vector3D.DotProduct(Dz, Dx)) < Dx.Length * (1e-5)))
{
X_id = xi; Y_id = yi; Z_id = zi;
found_corner = true;
break;
}
}
if (found_corner) break;
}
if (found_corner) break;
}
if (!found_corner)
{
isbox = false;
}
double box_tol = Dx.Length * (1e-5);
//System.Windows.Forms.MessageBox.Show(" Dx " + Dx + "\n" + " Dy " + Dy + "\n" + " Dz " + Dz);
// rejective test 2: is there a point opposite to pC?
Vector3D pE = pC + Dx + Dy;
bool found_E = false;
int E_id = 0;
for (int ip = 1; ip < 8; ip++)
{
Vector3D ds = pE - pnts[ip];
if (ds.Length < box_tol)
{
found_E = true;
E_id = ip;
}
}
if (!found_E)
{
isbox = false;
}
// rejective test 3: are other four points aligned?
Vector3D norm = Vector3D.CrossProduct(Dx, Dy);
norm.Normalize();
Vector3D[] ptsA = new Vector3D[4];
bool[] aligned = new bool[4];
double[] dists = new double[4];
aligned[0] = aligned[1] = aligned[2] = aligned[3] = false;
ptsA[0] = pC;
ptsA[1] = pX;
ptsA[2] = pY;
ptsA[3] = pnts[E_id];
for (int iA = 0; iA < 4; iA++)
for (int ip = 1; ip < 8; ip++)
{
if ((ip != E_id) && (ip != X_id) && (ip != Y_id))
{
Vector3D D = pnts[ip] - ptsA[iA];
if ((Vector3D.CrossProduct(D, norm)).Length < box_tol)
{
aligned[iA] = true;
dists[iA] = Vector3D.DotProduct(D, norm);
}
}
}
if ((aligned[0] != true) ||
(aligned[1] != true) ||
(aligned[2] != true) ||
(aligned[3] != true))
{
isbox = false;
}
if ((Math.Abs(dists[0] - dists[1]) > box_tol) ||
(Math.Abs(dists[0] - dists[2]) > box_tol) ||
(Math.Abs(dists[0] - dists[3]) > box_tol))
{
isbox = false;
}
// return geom.info
if (isbox)
{
corner = new Point3D(pC.X,pC.Y,pC.Z);
Ex = Dx;
Ey = Dy;
Ez = norm*dists[0];
}
}
}
return isbox;
}
// Try to see if the SolidWorks Body2 shape is a pure convex hull.
// If so,return true. If not a convex hull, return false.
// If it is a convex hull, in 'vertexes' get all the points.
public static bool SWbodyToConvexHull(Body2 swBody,
ref Point3D[] vertexes, int maxvertexes)
{
bool ishull = false;
if (swBody.GetVertexCount() <= maxvertexes)
{
object[] mfaces = (object[])swBody.GetFaces();
object[] medges = (object[])swBody.GetEdges();
object[] mverts = (object[])swBody.GetVertices();
ishull = true;
// rejective test 1: are all faces as planes?
bool allplanes = true;
for (int i = 0; i < swBody.GetFaceCount(); i++)
{
Face2 aface = (Face2)mfaces[i];
Surface msurf = (Surface)aface.GetSurface();
if (!msurf.IsPlane())
{
allplanes = false;
}
}
if (!allplanes)
{
return(false);
}
// rejective test 2: are all edges as straight lines?
bool allstraightedges = true;
for (int i = 0; i < swBody.GetEdgeCount(); i++)
{
Edge aedge = (Edge)medges[i];
Curve mcurve = (Curve)aedge.GetCurve();
if (!mcurve.IsLine())
{
allstraightedges = false;
}
}
if (!allstraightedges)
{
return(false);
}
// rejective test 3: are there holes as in tori?
// Use Euler formula v + f - e = 2 -2*genus
if (swBody.GetVertexCount() + swBody.GetFaceCount() - swBody.GetEdgeCount() != 2)
{
return(false);
}
if (ishull)
{
vertexes = new Point3D[swBody.GetVertexCount()];
for (int ip = 0; ip < swBody.GetVertexCount(); ip++)
{
vertexes[ip] = new Point3D(((double[])((Vertex)mverts[ip]).GetPoint())[0],
((double[])((Vertex)mverts[ip]).GetPoint())[1],
((double[])((Vertex)mverts[ip]).GetPoint())[2]);
}
}
}
return(ishull);
}
// Try to see if the SolidWorks Body2 shape is a pure convex hull.
// If so,return true. If not a convex hull, return false.
// If it is a convex hull, in 'vertexes' get all the points.
public static bool SWbodyToConvexHull(Body2 swBody,
ref Point3D[] vertexes, int maxvertexes)
{
bool ishull = false;
if (swBody.GetVertexCount() <= maxvertexes)
{
object[] mfaces = (object[])swBody.GetFaces();
object[] medges = (object[])swBody.GetEdges();
object[] mverts = (object[])swBody.GetVertices();
ishull = true;
// rejective test 1: are all faces as planes?
bool allplanes = true;
for (int i = 0; i < swBody.GetFaceCount(); i++)
{
Face2 aface = (Face2)mfaces[i];
Surface msurf = (Surface)aface.GetSurface();
if (!msurf.IsPlane())
{
allplanes = false;
}
}
if (!allplanes)
return false;
// rejective test 2: are all edges as straight lines?
bool allstraightedges = true;
for (int i = 0; i < swBody.GetEdgeCount(); i++)
{
Edge aedge = (Edge)medges[i];
Curve mcurve = (Curve)aedge.GetCurve();
if (!mcurve.IsLine())
{
allstraightedges = false;
}
}
if (!allstraightedges)
return false;
// rejective test 3: are there holes as in tori?
// Use Euler formula v + f - e = 2 -2*genus
if (swBody.GetVertexCount() + swBody.GetFaceCount() - swBody.GetEdgeCount() != 2)
return false;
if (ishull)
{
vertexes = new Point3D[swBody.GetVertexCount()];
for (int ip = 0; ip < swBody.GetVertexCount(); ip++)
{
vertexes[ip] = new Point3D(((double[])((Vertex)mverts[ip]).GetPoint())[0],
((double[])((Vertex)mverts[ip]).GetPoint())[1],
((double[])((Vertex)mverts[ip]).GetPoint())[2]);
}
}
}
return ishull;
}
