bool AddFace(AM_Face face, int [] nvertex) { int numVertex = nvertex.Length; Debug.Assert(face != null); int iLast = m_ArrayFaces.Count; face.Index = iLast; m_ArrayFaces.Add(face); // localizza gli spigoli (in senso antiorario) for (int i = 0; i < numVertex; i++) { int v0 = nvertex[i]; int v1 = nvertex[(i + 1) % numVertex]; face[i] = FindEdge(m_ArrayVertexes[v0], m_ArrayVertexes[v1]); // se lo spigolo non esiste viene aggiunto nell'array if (face[i] == null) { face[i] = AddEdge(m_ArrayVertexes[v0], m_ArrayVertexes[v1]); } } if (!face.SetConnection()) { return(false); } return(true); }
internal static void SwapEdge(AM_Edge pedge) { Debug.Assert(pedge.CcwFace().NumEdges == 3); Debug.Assert(pedge.CwFace().NumEdges == 3); AM_Edge pstart = pedge; do { Point2d p1 = pedge.CcwEdge().DestCoord(); Point2d p2 = pedge.OrgCoord(); Point2d p3 = pedge.DestCoord(); Point2d p4 = pedge.Symm().CcwEdge().DestCoord(); //int n1 = pedge.CcwEdge().Destination().Index; //int n2 = pedge.Origin().Index; //int n3 = pedge.Destination().Index; //int n4 = pedge.Symm().CcwEdge().Destination().Index; //int v1 = pedge.CcwEdge().Symm().m_nVertex; //int v2 = pedge.m_nVertex; //int v3 = pedge.Symm().m_nVertex; //int v4 = pedge.Symm().CcwEdge().Symm().m_nVertex; AM_Edge poldPrev = pedge.Prev; AM_Edge poldNext = pedge.Next; AM_Edge pnewNext = pedge.Prev.Symm(); AM_Edge pnewPrev = pnewNext.Prev; AM_Face poldFace = pedge.Face; pedge.Origin().Edge = poldNext; pedge.Vertex = pnewNext.Vertex; // Ripristina l'origine... pedge.Origin().Edge = pedge; // e aggiorna il suo puntatore // ripristina i collegamenti corretti poldPrev.Next = poldNext; poldNext.Prev = poldPrev; pnewPrev.Next = pedge; pnewNext.Prev = pedge; pedge.Next = pnewNext; pedge.Prev = pnewPrev; Debug.Assert(pedge.Origin() != pedge.Destination()); // parte dallo spigolo che definisce la faccia sinistra // e che è precedente in senso antiorario pnewNext = poldNext.Symm(); for (int i = 0; i < 3; i++) { pnewNext.Face = poldFace; poldFace[i] = pnewNext; pnewNext = pnewNext.CcwEdge(); } pedge = pedge.Symm(); } while (pstart != pedge); }
void Init(Point3d a, Point3d b, Point3d c) { Debug.Assert(m_ArrayFaces.Count == 0); AM_Face face = new AM_Face(); Point3d[] coord = { a, b, c }; AddFace(face, coord); m_StartingEdge = face[0]; }
void AddActiveFace(AM_Face face) { Debug.Assert(face != null); if (face.FaceType != AM_Face.EFaceType.FT_ACTIVE) { face.FaceType = AM_Face.EFaceType.FT_ACTIVE; face.ActiveIndex = m_ArrayActFace.Count; m_ArrayActFace.Add(face); } }
AM_Edge OnFaceEdge(Point2d x, AM_Face face) { for (int i = 0; i < face.NumEdges; i++) { if (OnEdge(x, face[i])) { return(face[i]); } } return(null); }
bool RefineMeshStep() { AM_Face face = null; Point2d innerPoint; AM_Face triangleContaining = null; face = FindMaxActive(); if (face == null) { return(false); } m_StartingEdge = face.GetStartingEdge(); innerPoint = face.InsertPoint(m_pSpaceFunction); //localizzo il triangolo che contiene il punto per fare il test di spaziatura. AM_Edge e = Locate(innerPoint); triangleContaining = e != null? (AM_Edge.RightOf(innerPoint, e) ? e.CwFace() : e.CcwFace()) : null; if (triangleContaining == null) { DeleteActiveFace(face); } else { //innerPoint.Z = triangleContaining.SpaceFunction(innerPoint, m_pSpaceFunction); double s = triangleContaining.SpaceFunction(innerPoint, m_pSpaceFunction); if (triangleContaining.SpacingTest(innerPoint, m_pSpaceFunction)) { AM_Vertex vertex; if (!InsertPoint(innerPoint, s, out vertex)) { DeleteActiveFace(face); } } else { DeleteActiveFace(face); } } return(true); }
bool AddFace(AM_Face face, Point3d [] Coord) { int numVertex = Coord.Length; int [] pnvertex = new int[numVertex]; // localizza i vertici for (int i = 0; i < numVertex; i++) { pnvertex[i] = AddVertex(new Point2d(Coord[i]), 0); } bool bRet = AddFace(face, pnvertex); return(bRet); }
void DeleteActiveFace(AM_Face face) { if (face == null) { return; } int nlast = m_ArrayActFace.Count - 1; AM_Face lastFace = m_ArrayActFace[nlast]; m_ArrayActFace[face.ActiveIndex] = lastFace; lastFace.ActiveIndex = face.ActiveIndex; m_ArrayActFace.RemoveAt(nlast); face.ActiveIndex = -1; face.FaceType = AM_Face.EFaceType.FT_NONE; }
internal bool GetCoordZ(Point2d p, ref double Z) { // Localizza uno spigolo vicino AM_Edge edge = Locate(p); if (edge == null) { return(false); } AM_Face face = null; if (AM_Edge.LeftOf(p, edge)) { face = edge.CcwFace(); } else { face = edge.CwFace(); } Z = 0; if (face == null) { return(false); } Point2d p0 = face.Vertex(0).Coord; Point2d p1 = face.Vertex(1).Coord; Point2d p2 = face.Vertex(2).Coord; double det = AM_Util.TriArea(p0, p1, p2); Debug.Assert(det != 00); double alfa = AM_Util.TriArea(p0, p, p2) / det; double beta = AM_Util.TriArea(p0, p1, p) / det; double f0 = face.Vertex(0).Z; double f1 = face.Vertex(1).Z; double f2 = face.Vertex(2).Z; Z = f0 + alfa * (f1 - f0) + beta * (f2 - f0); return(true); }
internal void FirstClassific() { m_bFlagClassific = true; AM_Face face = null; for (int i = 0; i < m_ArrayFaces.Count; i++) { face = m_ArrayFaces[i]; face.SetTriangleParameter(m_pSpaceFunction); face.FaceType = AM_Face.EFaceType.FT_NONE; } for (int i = 0; i < m_ArrayFaces.Count; i++) { face = (AM_Face)m_ArrayFaces[i]; Classific(face); } }
bool DeleteFace(AM_Face face, bool bremoveEdge = false) { // face faccia da rimuovere // bremoveEdge flag indicante la rimozione forzata di spigoli isolati if (face == null) { return(false); } // annulla i puntatori degli spigoli che definiscono la faccia for (int i = 0; i < face.NumEdges; i++) { face[i].Face = null; } AM_Face pdeletingFace = m_ArrayFaces[face.Index]; int nlast = m_ArrayFaces.Count - 1; Debug.Assert(pdeletingFace == face); // La cancellazione dall'array globale degli spigoli avviene // spostando l'ultimo spigolo dell'array al posto di quello da cancellare m_ArrayFaces[face.Index] = m_ArrayFaces[nlast]; m_ArrayFaces[face.Index].Index = face.Index; m_ArrayFaces.RemoveAt(nlast); if (bremoveEdge) { // rimuove gli spigoli isolati for (int i = 0; i < face.NumEdges; i++) { // se la faccia destra e sinistra dello spigolo // non esistono significa che lo spigolo è isolato if (face[i].CwFace() != null && face[i].CcwFace() != null) { DeleteEdge(face[i]); } } } //delete face; return(true); }
internal bool CheckWEdge() { for (int i = 0; i < m_ArrayWEdges.Count; i++) { AM_Edge edge = m_ArrayWEdges[i].Edge(); Debug.Assert(edge.Origin() != edge.Destination()); } for (int i = 0; i < m_ArrayFaces.Count; i++) { AM_Face edge = m_ArrayFaces[i]; double area = AM_Util.TriArea(edge[0].OrgCoord(), edge[1].OrgCoord(), edge[2].OrgCoord()); Debug.Assert(area > 0); } return(true); }
void Classific(AM_Face face) { if (face.FaceType == AM_Face.EFaceType.FT_ACCEPTED) { for (int i = 0; i < 3; i++) { AM_Face tmp = face.GetNearTriangle(i); if (!(tmp == null)) { if (tmp.FaceType != AM_Face.EFaceType.FT_ACCEPTED) { if (tmp.FaceType == AM_Face.EFaceType.FT_NONE) { AddActiveFace(tmp); } else if (tmp.FaceType == AM_Face.EFaceType.FT_WAITING) { AddActiveFace(tmp); } } } } } else { if (face.FaceType == AM_Face.EFaceType.FT_NONE) { for (int i = 0; i < 3; i++) { AM_Face tmp = face.GetNearTriangle(i); if (tmp == null || tmp.FaceType == AM_Face.EFaceType.FT_ACCEPTED) { AddActiveFace(face); break; } else { face.FaceType = AM_Face.EFaceType.FT_WAITING; } } } } }
void Swap(AM_Edge edge) { AM_Face face1 = (AM_Face)edge.CcwFace(); AM_Face face2 = (AM_Face)edge.CwFace(); if (face1 == null || face2 == null) { if (face1 != null && face1.FaceType == AM_Face.EFaceType.FT_ACTIVE) { DeleteActiveFace(face1); } if (face2 != null && face2.FaceType == AM_Face.EFaceType.FT_ACTIVE) { DeleteActiveFace(face2); } return; } Debug.Assert(edge.CwFace() != null); Debug.Assert(edge.CcwFace() != null); if (face1.FaceType == AM_Face.EFaceType.FT_ACTIVE) { DeleteActiveFace(face1); } if (face2.FaceType == AM_Face.EFaceType.FT_ACTIVE) { DeleteActiveFace(face2); } AM_Face.SwapEdge(edge); if (m_bFlagClassific) { face1.SetTriangleParameter(m_pSpaceFunction); face2.SetTriangleParameter(m_pSpaceFunction); Classific(face1); Classific(face2); } }
AM_Face FindMaxActive() { if (m_ArrayActFace.Count == 0) { return(null); } AM_Face maxActive = ((AM_Face)m_ArrayActFace[0]); Debug.Assert(maxActive != null); double radMax = maxActive.CircumRadius; for (int i = 1; i < m_ArrayActFace.Count; i++) { AM_Face face = m_ArrayActFace[i]; if (face.CircumRadius > radMax) { radMax = face.CircumRadius; maxActive = face; } } return(maxActive); }
internal bool RecoverGenEdge(AM_Mesh2d mesh, int num, List <Point3d> AddArray, bool bStraight = false) { // se viene inserito un punto per aggiustare la conformità // il flag baddFlag diventa true bool baddFlag = false; if (!m_bFlagHole && num >= m_GenVertexArray.Count) { return(true); } int v1 = m_GenVertexArray[num]; int v2 = m_GenVertexArray[(num + 1) % m_GenVertexArray.Count]; if (v2 < v1) { v2 += GetNumVertex(); } AM_Edge pbase; AM_Edge pprev = pbase = Vertex(v1).Edge; for (int i = v1 + 1; i <= v2; i++) { AM_Vertex pV1 = Vertex((i - 1) % (GetNumVertex())); AM_Vertex pV2 = Vertex((i) % (GetNumVertex())); Point2d orgCoord = pV1.Coord; // si controlla che tutti i vertici siano in sequenza while (true) { Point2d baseCoord = pbase.DestCoord(); Point2d prvCoord = new Point2d(m_ArrayCoord[(i - 1) % (GetNumVertex())]); Point2d destCoord = new Point2d(m_ArrayCoord[i % (GetNumVertex())]); if (baseCoord == destCoord) { // il vertice è in sequenza: si continua con il successivo break; } else { pbase = pbase.Next; if (pbase == pprev) { // il ciclo dell'anello si è chiuso senza trovare il vertice // successivo; è necessario inserire un vertice in mezzeria del // lato mancante if (!bStraight) { // 1. Algoritmo di ripristino del bordo con l'aggiunta del punto medio baddFlag = true; // si segnala l'aggiunta di un vertice Point3d p1 = m_ArrayCoord[i - 1]; Point3d p2 = (m_ArrayCoord[i % (GetNumVertex())]); Point3d mid = 0.5 * (p1 + p2); Point3d insPt = new Point3d(mid.X, mid.Y, 0); // si inserisce un vertice nel mezzo del AM_Vertex pvertex; mesh.InsertPoint(new Point2d(insPt), insPt.Z, out pvertex); if (pvertex == null) { Debug.Assert(false); //throw 6; } InsertVertex(i, pvertex); v2++; AddArray.Add(insPt); // si ricomincia il controllo pbase = Vertex(i - 1).Edge; pprev = pbase; } else { // 2. Algoritmo di ripristino del bordo con swap di spigoli AM_Edge pdest = Vertex(i).Edge; Vector2d dir = destCoord - orgCoord; dir.Unitize(); var m = AM_Util.AffineMatrix(orgCoord, dir); while (pV1.FindEdge(pV2) == null) { bool bCoinc = false; AM_Edge pSearch = pbase; // Si controllano situazioni di appartenenza al lato da ripristinare do { double cosang = Vector2d.Multiply(pSearch.GetVersor(), dir); if (AM_Util.IsEqual(cosang, 1, AM_Util.FLT_EPSILON)) { // Lo spigolo appartiene già al lato da ripristinare InsertVertex(i, pSearch.Destination()); v2++; Point2d dc = pSearch.DestCoord(); AddArray.Add(new Point3d(dc.X, dc.Y, 0)); // si ricomincia il controllo pbase = Vertex(i - 1).Edge; pprev = pbase; bCoinc = true; break; } pSearch = pSearch.Next; } while (pSearch != pbase); if (bCoinc) { break; } // Trova il lato di partenza pSearch = pbase; while (!AM_Util.IsInside(pSearch.GetVector(), pSearch.Next.GetVector(), dir)) { pSearch = pSearch.Next; if (pSearch == pprev) { Debug.Assert(false); //mesh.ExportMesh("RecoverSt7.txt"); return(false); } } AM_Edge pStartEdge = pSearch.CcwEdge(); List <AM_Edge> swapArray = new List <AM_Edge>(); while (pStartEdge.Destination() != pV2) { Point2d o = pStartEdge.OrgCoord(); Point2d d = pStartEdge.DestCoord(); swapArray.Add(pStartEdge); pStartEdge = pStartEdge.Prev; Point2d pt = AM_Util.ToLocal(m, pStartEdge.DestCoord()); if (pt.Y < -AM_Util.FLT_EPSILON) { pStartEdge = pStartEdge.CcwEdge(); Debug.Assert(AM_Util.ToLocal(m, pStartEdge.DestCoord()).Y > 0); } } for (int j = 0; j < swapArray.Count; j++) { AM_Edge pSwapEdge = swapArray[j]; // Vengono ruotati gli spigoli all'interno if (AM_Util.CheckSwapEdge(pSwapEdge)) { Debug.Assert(pSearch.CcwFace() != null && pSearch.Next.CwFace() != null); Debug.Assert(pSwapEdge.CcwFace() != null && pSwapEdge.CwFace() != null); AM_Face.SwapEdge(pSwapEdge); } } } } } } } pbase = Vertex(i % (GetNumVertex())).Edge; pprev = pbase; } return(baddFlag); }
internal bool InsertPoint(Point2d x, double space, out AM_Vertex pvertex) { pvertex = null; AM_Face face = null; // Localizza uno spigolo vicino AM_Edge edge = Locate(x); if (edge == null) { return(false); } // Localizza il triangolo che contiene il punto x // e imposta 'm_pStartingEdge', primo spigolo del triangolo o del quadrilatero // che deve essere riconnesso al punto x if (AM_Edge.LeftOf(x, edge)) { face = (AM_Face)(edge.CcwFace()); m_StartingEdge = edge.CcwEdge(); } else { face = (AM_Face)(edge.CwFace()); m_StartingEdge = edge.Symm().CcwEdge(); } if (face == null) { return(false); } // Verifica dell'eventuale esistenza del punto if (x == edge.OrgCoord()) { pvertex = edge.Origin(); return(false); } if (x == edge.DestCoord()) { pvertex = edge.Destination(); return(false); } Point2d[] v1 = { face.Vertex(0).Coord, face.Vertex(1).Coord, face.Vertex(2).Coord, }; //isOnEdge = OnEdge(x, edge); AM_Edge pOnEdge = OnFaceEdge(x, face); if (pOnEdge != null) { m_StartingEdge = pOnEdge.CcwEdge(); // il punto si trova su un contorno! AM_Face pCwFace = pOnEdge.CwFace(); AM_Face pCcwFace = pOnEdge.CcwFace(); if (pCwFace == null || pCcwFace == null) { return(false); } } // Il punto è all'interno di un triangolo o su uno spigolo if (face.FaceType == AM_Face.EFaceType.FT_ACTIVE) { DeleteActiveFace(face); } DeleteFace(face); if (pOnEdge != null) { // Cancella lo spigolo su cui si appoggia e // conseguentemente anche l'altro spigolo AM_Face pCwFace = pOnEdge.CwFace(); AM_Face pCcwFace = pOnEdge.CcwFace(); if (pCwFace != null && pCwFace.FaceType == AM_Face.EFaceType.FT_ACTIVE) { DeleteActiveFace(pCwFace); } if (pCcwFace != null && pCcwFace.FaceType == AM_Face.EFaceType.FT_ACTIVE) { DeleteActiveFace(pCcwFace); } DeleteEdge(pOnEdge); } // Inserisce il nuovo vertice nell'array globale pvertex = new AM_Vertex(x, 0, space); if (pvertex == null) { Debug.Assert(false); //throw -1; } int m_nVertex = m_ArrayVertexes.Count; pvertex.Index = m_ArrayVertexes.Count; m_ArrayVertexes.Add(pvertex); // Inserisce i nuovi triangoli (facce) edge = m_StartingEdge.CcwEdge(); int numEdge = (pOnEdge != null? 4 : 3); for (int ne = 0; ne < numEdge; ne++) { AM_Face new_face = new AM_Face(); if (new_face == null) { Debug.Assert(false); //throw -1; } AM_Edge actEdge = edge; edge = edge.CcwEdge(); int [] nCoord = { m_nVertex, actEdge.Vertex.Index, actEdge.DestVertex().Index }; AddFace(new_face, nCoord); if (m_bFlagClassific) { new_face.SetTriangleParameter(m_pSpaceFunction); Classific(new_face); } } // Esamina gli spigoli per assicurare che la condizione di // Delaunay sia soddisfatta edge = m_StartingEdge; m_StartingEdge = m_StartingEdge.CcwEdge(); do { //TRACE_EDGE(edge); AM_Edge t = edge.Prev; if (edge.CwFace() != null && AM_Edge.RightOf(t.DestCoord(), edge) && AM_Util.InCircle(edge.OrgCoord(), t.DestCoord(), edge.DestCoord(), x)) { //TRACE0("Faccia swap: "); //TRACE_EDGE(edge); Swap(edge); edge = edge.Prev; } else if (edge.Next == m_StartingEdge) { // Non ci sono più spigoli break; } else { // Recupera un altro spigolo sospetto edge = edge.Next.CwEdge(); } } while (true); return(true); }