1 # -*- coding: utf-8 -*-
4 from geomsmesh import geompy
12 # -----------------------------------------------------------------------------
13 # --- groupe de quadrangles de face transformé en face géométrique par filling
15 def quadranglesToShapeNoCorner(meshQuad, shapeFissureParams, centreFondFiss):
17 groupe de quadrangles de face transformée en faces géométriques par filling
18 on part de quadrangles définissant une zone a 4 cotés (convexe), et on reconstitue n lignes de p points.
19 Ces n lignes de p points sont transformées en n courbes géométriques,
20 à partir desquelles on reconstitue une surface géométrique.
21 Il peut y avoir plusieurs faces géométriques reconstituées, si on fournit des groupes de quadrangles non connexes.
22 On détecte les angles vifs, pour conserver des arêtes vives délimitant des faces connexes.
23 @param meshQuad : maillages constitué de quadrangles constituant une ou plusieurs zones convexes
24 @return (fillings, noeuds_Bords) : liste de geomObject, listes des bords (bord = liste ordonnée de noeuds (geomObject))
28 isVecteurDefaut = False
29 if shapeFissureParams.has_key('vecteurDefaut'):
30 isVecteurDefaut = True
31 vecteurDefaut = shapeFissureParams['vecteurDefaut']
33 fillings = [] # les faces reconstituées, découpées selon les arêtes vives
35 bords_Partages = [] # contient a la fin les courbes correspondant aux arêtes vives
36 fillconts = [] # les faces reconstituées, sans découpage selon les arêtes vives
37 idFilToCont = [] # index face découpée vers face sans découpe
38 iface = 0 # index face découpée
39 icont = 0 # index face continue
41 allNodeIds = meshQuad.GetNodesId()
42 while len(allNodeIds):
44 for idNode in nodeIds: # rechercher un coin
45 elems = meshQuad.GetNodeInverseElements(idNode)
47 # un coin: un noeud, un element quadrangle
50 idStart = idNode # le noeud de coin
51 elemStart = elem # l'élément quadrangle au coin
52 xyz = meshQuad.GetNodeXYZ(idStart)
54 logging.debug("idStart %s, coords %s", idStart, str(xyz))
56 nodelines =[] # on va constituer une liste de lignes de points
60 logging.debug("--- une ligne")
64 agauche = False # sens de parcours des 4 noeuds d'un quadrangle
68 ligneIncomplete = True # on commence une ligne de points
72 while ligneIncomplete: # compléter la ligne de points
73 nodeline.append(idNode)
74 allNodeIds.remove(idNode)
76 nodes = meshQuad.GetElemNodes(elem)
77 i = nodes.index(idNode) # repérer l'index du noeud courant (i) dans l'élément quadrangle (0 a 3)
78 if agauche: # déterminer le noeud suivant (j) et celui opposé (k) dans le quadrangle
96 isuiv = nodes[j] #noeud suivant
97 iapres = nodes[k] #noeud opposé
100 # précédent a trouver, dernière ligne : précédent au lieu de suivant
107 elems3 = meshQuad.GetNodeInverseElements(iprec)
108 if len(elems3) == 1: # autre coin
115 #print nodes, idNode, isuiv, iapres
116 elems1 = meshQuad.GetNodeInverseElements(isuiv)
117 elems2 = meshQuad.GetNodeInverseElements(iapres)
118 ligneIncomplete = False
120 if elems1.count(elem2) and elem2 != elem:
121 ligneIncomplete = True
125 if not ligneIncomplete:
126 nodeline.append(isuiv)
127 allNodeIds.remove(isuiv)
128 logging.debug("nodeline %s", nodeline)
129 logging.debug("elemline %s", elemline)
130 nodelines.append(nodeline)
131 print "nodelines = ", nodelines
132 longueur = [len(val) for val in nodelines]
133 print "longueur = ", longueur
134 # on a constitué une liste de lignes de points connexes
135 logging.debug("dimensions [%s, %s]", len(nodelines), len(nodeline))
137 # stockage des coordonnées dans un tableau numpy
138 mat = np.zeros((len(nodelines), len(nodeline), 3))
139 for i, ligne in enumerate(nodelines):
140 for j, nodeId in enumerate(ligne):
141 mat[i,j] = meshQuad.GetNodeXYZ(nodeId)
142 logging.debug("matrice de coordonnées: \n%s",mat)
143 logging.debug("dimensions %s", mat.shape)
145 # recherche d'angles supérieurs a un seuil sur une ligne : angle entre deux vecteurs successifs
146 cosmin = math.cos(math.pi/4.) # TODO: angle reference en paramètre
147 vecx = mat[:, 1:, :] - mat[:, :-1, :] # vecteurs selon direction "x"
148 vx0 = vecx[:, :-1, :] # vecteurs amont
149 vx1 = vecx[:, 1:, :] # vecteurs aval
150 e = np.einsum('ijk,ijk->ij', vx0, vx1) # produit scalaire des vecteurs
151 f = np.apply_along_axis(mydot, 2, vx0) # normes carrées vecteurs amont
152 g = np.apply_along_axis(mydot, 2, vx1) # normes carrées vecteurs aval
153 h = e/(np.sqrt(f*g)) # cosinus
154 ruptureX = h < cosmin # True si angle > reference
155 logging.debug("matrice de rupture X: \n%s",ruptureX)
156 rupX = filter(lambda x: np.prod(ruptureX[:,x]), range(len(nodeline)-2))
157 logging.debug("colonnes de rupture: %s",rupX)
158 # recherche d'angles supérieurs a un seuil sur une colonne : angle entre deux vecteurs successifs
159 vecy = mat[ 1:, :, :] - mat[:-1, :, :] # vecteurs selon direction "y"
160 vy0 = vecy[:-1, :, :] # vecteurs amont
161 vy1 = vecy[ 1:, :, :] # vecteurs aval
162 e = np.einsum('ijk,ijk->ij', vy0, vy1) # produit scalaire des vecteurs
163 f = np.apply_along_axis(mydot, 2, vy0) # normes carrées vecteurs amont
164 g = np.apply_along_axis(mydot, 2, vy1) # normes carrées vecteurs aval
165 h = e/(np.sqrt(f*g)) # cosinus
166 ruptureY = h < cosmin # True si angle > reference
167 logging.debug("matrice de rupture Y: \n%s",ruptureY)
168 rupY = filter(lambda x: np.prod(ruptureY[x, :]), range(len(nodelines)-2))
169 logging.debug("lignes de rupture: %s",rupY)
170 if (len(rupX)*len(rupY)) > 0:
171 logging.critical("""Cas non traité: présence d'angles vifs dans 2 directions,
172 lors de la reconstitution des faces géométriques dans la zone remaillée""")
177 rupX.append(mat.shape[1]-1)
178 for i, index in enumerate(rupX):
183 mats.append(mat[:, imin:imax, :])
184 if imax == mat.shape[1] + 1:
188 bordsPartages.append([imin,ifin]) # les indices différents de 0 correspondent à des bords partagés
190 rupY.append(mat.shape[0]-1)
191 for i, index in enumerate(rupY):
196 mats.append(mat[imin:imax, :, :])
197 if imax == mat.shape[0] + 1:
201 bordsPartages.append([imin,ifin]) # les indices différents de 0 correspondent à des bords partagés
204 bordsPartages.append([0,0]) # les indices différents de 0 correspondent à des bords partagés
207 for nmat, amat in enumerate(mats):
208 logging.debug("dimensions matrice %s: %s", nmat, amat.shape)
209 nbLignes = amat.shape[1] # pas de rupture, ou rupture selon des colonnes: on transpose
210 nbCols = amat.shape[0]
211 if len(rupY) > 0 : # rupture selon des lignes: pas de transposition
212 nbLignes = amat.shape[0]
213 nbCols = amat.shape[1]
217 noeudsBords.append([])
219 for i in range(nbLignes):
221 for j in range(nbCols):
222 #logging.debug("point[%s,%s] = (%s, %s, %s)",i,j,amat[i,j,0], amat[i,j,1], amat[i,j,2])
223 if len(rupY) > 0 : # pas de transposition
224 node = geompy.MakeVertex(amat[i,j,0], amat[i,j,1], amat[i,j,2])
225 else: # transposition
226 node = geompy.MakeVertex(amat[j,i,0], amat[j,i,1], amat[j,i,2])
227 nodeList.append(node)
229 noeudsBords[0].append(node)
231 #geompy.addToStudy( node, name )
232 if i == (nbLignes -1):
233 noeudsBords[2].append(node)
235 #geompy.addToStudy( node, name )
237 noeudsBords[1].append(node)
239 #geompy.addToStudy( node, name )
241 noeudsBords[3].append(node)
243 #geompy.addToStudy( node, name )
245 curve = geompy.MakeInterpol(nodeList, False, False)
247 #geompy.addToStudy( curve, name )
248 if len(curvconts) == 0 or len(curves) > 0: # éliminer les doublons de la surface sans découpe
249 curvconts.append(nodeList)
251 if bordsPartages[nmat][0] :
252 bordsPartages[nmat][0] = curves[0] # la première ligne est un bord partagé
254 bordsPartages[nmat][0] = None
255 if bordsPartages[nmat][1] :
256 bordsPartages[nmat][1] = curves[-1] # la dernière ligne est un bord partagé
258 bordsPartages[nmat][1] = None
259 filling = geompy.MakeFilling(geompy.MakeCompound(curves), 2, 5, 0.0001, 0.0001, 0, GEOM.FOM_Default, True)
260 # --- test orientation filling
261 vertex = geompy.MakeVertexOnSurface(filling, 0.5, 0.5)
262 normal = geompy.GetNormal(filling, vertex)
264 if centreFondFiss is not None:
265 logging.debug("orientation filling a l'aide du centre de fond de fissure")
266 vecteurDefaut = geompy.MakeVector(centreFondFiss, vertex)
268 if not isVecteurDefaut:
272 pointExplicite = False
273 if shapeFissureParams.has_key('pointIn_x'):
274 pointExplicite = True
275 pointIn_x = shapeFissureParams['pointIn_x']
276 if shapeFissureParams.has_key('pointIn_y'):
277 pointExplicite = True
278 pointIn_y = shapeFissureParams['pointIn_y']
279 if shapeFissureParams.has_key('pointIn_z'):
280 pointExplicite = True
281 pointIn_z = shapeFissureParams['pointIn_z']
283 cdg = geompy.MakeVertex(pointIn_x, pointIn_y, pointIn_z)
284 logging.debug("orientation filling par point intérieur %s", (pointIn_x, pointIn_y, pointIn_z))
285 vecteurDefaut = geompy.MakeVector(cdg, vertex)
287 if shapeFissureParams.has_key('convexe'):
288 isConvexe = shapeFissureParams['convexe']
289 logging.debug("orientation filling par indication de convexité %s", isConvexe)
290 cdg = geompy.MakeCDG(filling)
292 vecteurDefaut = geompy.MakeVector(cdg, vertex)
294 vecteurDefaut = geompy.MakeVector(vertex, cdg)
296 if vecteurDefaut is not None:
297 geompy.addToStudy(normal, "normFillOrig%d"%iface)
298 geompy.addToStudy(vecteurDefaut, "fromInterieur%d"%iface)
299 if geompy.GetAngleRadians(vecteurDefaut, normal) > math.pi/2.0:
300 filling = geompy.ChangeOrientation(filling)
301 geompy.addToStudy( filling, "filling%d"%iface )
302 #geompy.ExportBREP(filling, "filling.brep")
304 fillings.append(filling)
305 noeuds_bords.append(noeudsBords)
306 idFilToCont.append(icont)
307 bords_Partages += bordsPartages
308 print "bords_Partages = ", bords_Partages
309 pass # --- loop on mats
310 # --- reconstruction des faces continues à partir des listes de noeuds
311 # les courbes doivent suivre la courbure pour éviter les oscillations
312 if icont == iface - 1: # pas de découpe, on garde la même face
313 fillcont = fillings[-1]
315 nbLignes = len(curvconts[0])
317 for i in range(nbLignes):
318 nodes = [curvconts[j][i] for j in range(len(curvconts))]
319 curve = geompy.MakeInterpol(nodes, False, False)
321 fillcont = geompy.MakeFilling(geompy.MakeCompound(curves), 2, 5, 0.0001, 0.0001, 0, GEOM.FOM_Default, True)
322 geompy.addToStudy( fillcont, "filcont%d"%icont )
323 fillconts.append(fillcont)
325 pass # --- loop while there are remaining nodes
327 return fillings, noeuds_bords, bords_Partages, fillconts, idFilToCont