1 // SMESH SMESH : implementaion of SMESH idl descriptions
3 // Copyright (C) 2003 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
4 // CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
6 // This library is free software; you can redistribute it and/or
7 // modify it under the terms of the GNU Lesser General Public
8 // License as published by the Free Software Foundation; either
9 // version 2.1 of the License.
11 // This library is distributed in the hope that it will be useful,
12 // but WITHOUT ANY WARRANTY; without even the implied warranty of
13 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 // Lesser General Public License for more details.
16 // You should have received a copy of the GNU Lesser General Public
17 // License along with this library; if not, write to the Free Software
18 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
24 // File : StdMeshers_Quadrangle_2D.cxx
25 // Moved here from SMESH_Quadrangle_2D.cxx
26 // Author : Paul RASCLE, EDF
30 #include "StdMeshers_Quadrangle_2D.hxx"
32 #include "StdMeshers_FaceSide.hxx"
34 #include "SMESH_Gen.hxx"
35 #include "SMESH_Mesh.hxx"
36 #include "SMESH_subMesh.hxx"
37 #include "SMESH_MesherHelper.hxx"
38 #include "SMESH_Block.hxx"
40 #include "SMDS_MeshElement.hxx"
41 #include "SMDS_MeshNode.hxx"
42 #include "SMDS_EdgePosition.hxx"
43 #include "SMDS_FacePosition.hxx"
45 #include <BRepAdaptor_Curve.hxx>
46 #include <BRep_Tool.hxx>
47 #include <BRepLProp.hxx>
48 #include <BRepTools.hxx>
49 #include <BRepTools_WireExplorer.hxx>
50 #include <Geom_Surface.hxx>
51 #include <Geom_Curve.hxx>
52 #include <Geom2d_Curve.hxx>
53 #include <GeomAdaptor_Curve.hxx>
54 #include <GCPnts_UniformAbscissa.hxx>
56 #include <Precision.hxx>
57 #include <gp_Pnt2d.hxx>
58 #include <TColStd_ListIteratorOfListOfInteger.hxx>
59 #include <TColStd_SequenceOfReal.hxx>
60 #include <TColgp_SequenceOfXY.hxx>
61 #include <NCollection_DefineArray2.hxx>
63 #include "utilities.h"
64 #include "Utils_ExceptHandlers.hxx"
66 #ifndef StdMeshers_Array2OfNode_HeaderFile
67 #define StdMeshers_Array2OfNode_HeaderFile
68 typedef const SMDS_MeshNode* SMDS_MeshNodePtr;
69 DEFINE_BASECOLLECTION (StdMeshers_BaseCollectionNodePtr, SMDS_MeshNodePtr)
70 DEFINE_ARRAY2(StdMeshers_Array2OfNode,
71 StdMeshers_BaseCollectionNodePtr, SMDS_MeshNodePtr)
78 //=============================================================================
82 //=============================================================================
84 StdMeshers_Quadrangle_2D::StdMeshers_Quadrangle_2D (int hypId, int studyId, SMESH_Gen* gen)
85 : SMESH_2D_Algo(hypId, studyId, gen)
87 MESSAGE("StdMeshers_Quadrangle_2D::StdMeshers_Quadrangle_2D");
88 _name = "Quadrangle_2D";
89 _shapeType = (1 << TopAbs_FACE);
90 _compatibleHypothesis.push_back("QuadranglePreference");
94 //=============================================================================
98 //=============================================================================
100 StdMeshers_Quadrangle_2D::~StdMeshers_Quadrangle_2D()
102 MESSAGE("StdMeshers_Quadrangle_2D::~StdMeshers_Quadrangle_2D");
105 //=============================================================================
109 //=============================================================================
111 bool StdMeshers_Quadrangle_2D::CheckHypothesis
113 const TopoDS_Shape& aShape,
114 SMESH_Hypothesis::Hypothesis_Status& aStatus)
117 aStatus = SMESH_Hypothesis::HYP_OK;
119 // there is only one compatible Hypothesis so far
120 const list <const SMESHDS_Hypothesis * >&hyps = GetUsedHypothesis(aMesh, aShape);
121 myQuadranglePreference = hyps.size() > 0;
126 //=============================================================================
130 //=============================================================================
132 bool StdMeshers_Quadrangle_2D::Compute (SMESH_Mesh& aMesh,
133 const TopoDS_Shape& aShape) throw (SALOME_Exception)
135 Unexpect aCatch(SalomeException);
137 SMESHDS_Mesh * meshDS = aMesh.GetMeshDS();
138 aMesh.GetSubMesh(aShape);
140 myTool = new SMESH_MesherHelper(aMesh);
141 std::auto_ptr<SMESH_MesherHelper> helperDeleter( myTool );// to delete helper at exit from Compute()
143 _quadraticMesh = myTool->IsQuadraticSubMesh(aShape);
145 FaceQuadStruct *quad = CheckNbEdges( aMesh, aShape );
146 std::auto_ptr<FaceQuadStruct> quadDeleter( quad ); // to delete quad at exit from Compute()
150 if(myQuadranglePreference) {
151 int n1 = quad->side[0]->NbPoints();
152 int n2 = quad->side[1]->NbPoints();
153 int n3 = quad->side[2]->NbPoints();
154 int n4 = quad->side[3]->NbPoints();
155 int nfull = n1+n2+n3+n4;
158 if( nfull==ntmp && ( (n1!=n3) || (n2!=n4) ) ) {
159 // special path for using only quandrangle faces
160 bool ok = ComputeQuadPref(aMesh, aShape, quad);
165 // set normalized grid on unit square in parametric domain
167 if (!SetNormalizedGrid(aMesh, aShape, quad))
170 // --- compute 3D values on points, store points & quadrangles
172 int nbdown = quad->side[0]->NbPoints();
173 int nbup = quad->side[2]->NbPoints();
175 int nbright = quad->side[1]->NbPoints();
176 int nbleft = quad->side[3]->NbPoints();
178 int nbhoriz = Min(nbdown, nbup);
179 int nbvertic = Min(nbright, nbleft);
181 const TopoDS_Face& F = TopoDS::Face(aShape);
182 Handle(Geom_Surface) S = BRep_Tool::Surface(F);
184 // internal mesh nodes
185 int i, j, geomFaceID = meshDS->ShapeToIndex( F );
186 for (i = 1; i < nbhoriz - 1; i++) {
187 for (j = 1; j < nbvertic - 1; j++) {
188 int ij = j * nbhoriz + i;
189 double u = quad->uv_grid[ij].u;
190 double v = quad->uv_grid[ij].v;
191 gp_Pnt P = S->Value(u, v);
192 SMDS_MeshNode * node = meshDS->AddNode(P.X(), P.Y(), P.Z());
193 meshDS->SetNodeOnFace(node, geomFaceID, u, v);
194 quad->uv_grid[ij].node = node;
201 // --.--.--.--.--.-- nbvertic
207 // ---.----.----.--- 0
208 // 0 > > > > > > > > nbhoriz
214 int iup = nbhoriz - 1;
215 if (quad->isEdgeOut[3]) { ilow++; } else { if (quad->isEdgeOut[1]) iup--; }
218 int jup = nbvertic - 1;
219 if (quad->isEdgeOut[0]) { jlow++; } else { if (quad->isEdgeOut[2]) jup--; }
221 // regular quadrangles
222 for (i = ilow; i < iup; i++) {
223 for (j = jlow; j < jup; j++) {
224 const SMDS_MeshNode *a, *b, *c, *d;
225 a = quad->uv_grid[j * nbhoriz + i].node;
226 b = quad->uv_grid[j * nbhoriz + i + 1].node;
227 c = quad->uv_grid[(j + 1) * nbhoriz + i + 1].node;
228 d = quad->uv_grid[(j + 1) * nbhoriz + i].node;
229 SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
230 meshDS->SetMeshElementOnShape(face, geomFaceID);
234 const vector<UVPtStruct>& uv_e0 = quad->side[0]->GetUVPtStruct(true,0 );
235 const vector<UVPtStruct>& uv_e1 = quad->side[1]->GetUVPtStruct(false,1);
236 const vector<UVPtStruct>& uv_e2 = quad->side[2]->GetUVPtStruct(true,1 );
237 const vector<UVPtStruct>& uv_e3 = quad->side[3]->GetUVPtStruct(false,0);
239 double eps = Precision::Confusion();
241 // Boundary quadrangles
243 if (quad->isEdgeOut[0]) {
246 // |___|___|___|___|___|___|
248 // |___|___|___|___|___|___|
250 // |___|___|___|___|___|___| __ first row of the regular grid
251 // . . . . . . . . . __ down edge nodes
253 // >->->->->->->->->->->->-> -- direction of processing
255 int g = 0; // number of last processed node in the regular grid
257 // number of last node of the down edge to be processed
258 int stop = nbdown - 1;
259 // if right edge is out, we will stop at a node, previous to the last one
260 if (quad->isEdgeOut[1]) stop--;
262 // for each node of the down edge find nearest node
263 // in the first row of the regular grid and link them
264 for (i = 0; i < stop; i++) {
265 const SMDS_MeshNode *a, *b, *c, *d;
267 b = uv_e0[i + 1].node;
268 gp_Pnt pb (b->X(), b->Y(), b->Z());
270 // find node c in the regular grid, which will be linked with node b
273 // right bound reached, link with the rightmost node
275 c = quad->uv_grid[nbhoriz + iup].node;
278 // find in the grid node c, nearest to the b
279 double mind = RealLast();
280 for (int k = g; k <= iup; k++) {
282 const SMDS_MeshNode *nk;
283 if (k < ilow) // this can be, if left edge is out
284 nk = uv_e3[1].node; // get node from the left edge
286 nk = quad->uv_grid[nbhoriz + k].node; // get one of middle nodes
288 gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
289 double dist = pb.Distance(pnk);
290 if (dist < mind - eps) {
300 if (near == g) { // make triangle
301 //SMDS_MeshFace* face = meshDS->AddFace(a, b, c);
302 SMDS_MeshFace* face = myTool->AddFace(a, b, c);
303 meshDS->SetMeshElementOnShape(face, geomFaceID);
305 else { // make quadrangle
309 d = quad->uv_grid[nbhoriz + near - 1].node;
310 //SMDS_MeshFace* face = meshDS->AddFace(a, b, c, d);
311 SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
312 meshDS->SetMeshElementOnShape(face, geomFaceID);
314 // if node d is not at position g - make additional triangles
316 for (int k = near - 1; k > g; k--) {
317 c = quad->uv_grid[nbhoriz + k].node;
321 d = quad->uv_grid[nbhoriz + k - 1].node;
322 //SMDS_MeshFace* face = meshDS->AddFace(a, c, d);
323 SMDS_MeshFace* face = myTool->AddFace(a, c, d);
324 meshDS->SetMeshElementOnShape(face, geomFaceID);
331 if (quad->isEdgeOut[2]) {
334 // <-<-<-<-<-<-<-<-<-<-<-<-< -- direction of processing
336 // . . . . . . . . . __ up edge nodes
337 // ___ ___ ___ ___ ___ ___ __ first row of the regular grid
339 // |___|___|___|___|___|___|
341 // |___|___|___|___|___|___|
344 int g = nbhoriz - 1; // last processed node in the regular grid
347 // if left edge is out, we will stop at a second node
348 if (quad->isEdgeOut[3]) stop++;
350 // for each node of the up edge find nearest node
351 // in the first row of the regular grid and link them
352 for (i = nbup - 1; i > stop; i--) {
353 const SMDS_MeshNode *a, *b, *c, *d;
355 b = uv_e2[i - 1].node;
356 gp_Pnt pb (b->X(), b->Y(), b->Z());
358 // find node c in the grid, which will be linked with node b
360 if (i == stop + 1) { // left bound reached, link with the leftmost node
361 c = quad->uv_grid[nbhoriz*(nbvertic - 2) + ilow].node;
364 // find node c in the grid, nearest to the b
365 double mind = RealLast();
366 for (int k = g; k >= ilow; k--) {
367 const SMDS_MeshNode *nk;
369 nk = uv_e1[nbright - 2].node;
371 nk = quad->uv_grid[nbhoriz*(nbvertic - 2) + k].node;
372 gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
373 double dist = pb.Distance(pnk);
374 if (dist < mind - eps) {
384 if (near == g) { // make triangle
385 //SMDS_MeshFace* face = meshDS->AddFace(a, b, c);
386 SMDS_MeshFace* face = myTool->AddFace(a, b, c);
387 meshDS->SetMeshElementOnShape(face, geomFaceID);
389 else { // make quadrangle
391 d = uv_e1[nbright - 2].node;
393 d = quad->uv_grid[nbhoriz*(nbvertic - 2) + near + 1].node;
394 //SMDS_MeshFace* face = meshDS->AddFace(a, b, c, d);
395 SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
396 meshDS->SetMeshElementOnShape(face, geomFaceID);
398 if (near + 1 < g) { // if d not is at g - make additional triangles
399 for (int k = near + 1; k < g; k++) {
400 c = quad->uv_grid[nbhoriz*(nbvertic - 2) + k].node;
402 d = uv_e1[nbright - 2].node;
404 d = quad->uv_grid[nbhoriz*(nbvertic - 2) + k + 1].node;
405 //SMDS_MeshFace* face = meshDS->AddFace(a, c, d);
406 SMDS_MeshFace* face = myTool->AddFace(a, c, d);
407 meshDS->SetMeshElementOnShape(face, geomFaceID);
416 // right or left boundary quadrangles
417 if (quad->isEdgeOut[1]) {
418 // MESSAGE("right edge is out");
419 int g = 0; // last processed node in the grid
420 int stop = nbright - 1;
421 if (quad->isEdgeOut[2]) stop--;
422 for (i = 0; i < stop; i++) {
423 const SMDS_MeshNode *a, *b, *c, *d;
425 b = uv_e1[i + 1].node;
426 gp_Pnt pb (b->X(), b->Y(), b->Z());
428 // find node c in the grid, nearest to the b
430 if (i == stop - 1) { // up bondary reached
431 c = quad->uv_grid[nbhoriz*(jup + 1) - 2].node;
434 double mind = RealLast();
435 for (int k = g; k <= jup; k++) {
436 const SMDS_MeshNode *nk;
438 nk = uv_e0[nbdown - 2].node;
440 nk = quad->uv_grid[nbhoriz*(k + 1) - 2].node;
441 gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
442 double dist = pb.Distance(pnk);
443 if (dist < mind - eps) {
453 if (near == g) { // make triangle
454 //SMDS_MeshFace* face = meshDS->AddFace(a, b, c);
455 SMDS_MeshFace* face = myTool->AddFace(a, b, c);
456 meshDS->SetMeshElementOnShape(face, geomFaceID);
458 else { // make quadrangle
460 d = uv_e0[nbdown - 2].node;
462 d = quad->uv_grid[nbhoriz*near - 2].node;
463 //SMDS_MeshFace* face = meshDS->AddFace(a, b, c, d);
464 SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
465 meshDS->SetMeshElementOnShape(face, geomFaceID);
467 if (near - 1 > g) { // if d not is at g - make additional triangles
468 for (int k = near - 1; k > g; k--) {
469 c = quad->uv_grid[nbhoriz*(k + 1) - 2].node;
471 d = uv_e0[nbdown - 2].node;
473 d = quad->uv_grid[nbhoriz*k - 2].node;
474 //SMDS_MeshFace* face = meshDS->AddFace(a, c, d);
475 SMDS_MeshFace* face = myTool->AddFace(a, c, d);
476 meshDS->SetMeshElementOnShape(face, geomFaceID);
483 if (quad->isEdgeOut[3]) {
484 // MESSAGE("left edge is out");
485 int g = nbvertic - 1; // last processed node in the grid
487 if (quad->isEdgeOut[0]) stop++;
488 for (i = nbleft - 1; i > stop; i--) {
489 const SMDS_MeshNode *a, *b, *c, *d;
491 b = uv_e3[i - 1].node;
492 gp_Pnt pb (b->X(), b->Y(), b->Z());
494 // find node c in the grid, nearest to the b
496 if (i == stop + 1) { // down bondary reached
497 c = quad->uv_grid[nbhoriz*jlow + 1].node;
500 double mind = RealLast();
501 for (int k = g; k >= jlow; k--) {
502 const SMDS_MeshNode *nk;
506 nk = quad->uv_grid[nbhoriz*k + 1].node;
507 gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
508 double dist = pb.Distance(pnk);
509 if (dist < mind - eps) {
519 if (near == g) { // make triangle
520 //SMDS_MeshFace* face = meshDS->AddFace(a, b, c);
521 SMDS_MeshFace* face = myTool->AddFace(a, b, c);
522 meshDS->SetMeshElementOnShape(face, geomFaceID);
524 else { // make quadrangle
528 d = quad->uv_grid[nbhoriz*(near + 1) + 1].node;
529 //SMDS_MeshFace* face = meshDS->AddFace(a, b, c, d);
530 SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
531 meshDS->SetMeshElementOnShape(face, geomFaceID);
533 if (near + 1 < g) { // if d not is at g - make additional triangles
534 for (int k = near + 1; k < g; k++) {
535 c = quad->uv_grid[nbhoriz*k + 1].node;
539 d = quad->uv_grid[nbhoriz*(k + 1) + 1].node;
540 //SMDS_MeshFace* face = meshDS->AddFace(a, c, d);
541 SMDS_MeshFace* face = myTool->AddFace(a, c, d);
542 meshDS->SetMeshElementOnShape(face, geomFaceID);
555 //=============================================================================
559 //=============================================================================
561 FaceQuadStruct* StdMeshers_Quadrangle_2D::CheckNbEdges(SMESH_Mesh & aMesh,
562 const TopoDS_Shape & aShape)
563 throw(SALOME_Exception)
565 Unexpect aCatch(SalomeException);
567 const TopoDS_Face & F = TopoDS::Face(aShape);
569 // verify 1 wire only, with 4 edges
571 list< TopoDS_Edge > edges;
572 list< int > nbEdgesInWire;
573 int nbWire = SMESH_Block::GetOrderedEdges (F, V, edges, nbEdgesInWire);
575 INFOS("only 1 wire by face (quadrangles)");
578 FaceQuadStruct* quad = new FaceQuadStruct;
580 for ( int i = 0; i < NB_SIDES; ++i )
584 list< TopoDS_Edge >::iterator edgeIt = edges.begin();
585 if ( nbEdgesInWire.front() == 4 ) { // exactly 4 edges
586 for ( ; edgeIt != edges.end(); ++edgeIt, nbSides++ )
587 quad->side[nbSides] = new StdMeshers_FaceSide(F,*edgeIt,&aMesh,nbSides<TOP_SIDE);
589 else if ( nbEdgesInWire.front() > 4 ) { // more than 4 edges - try to unite
590 list< TopoDS_Edge > sideEdges;
591 while ( edgeIt != edges.end()) {
593 sideEdges.push_back( *edgeIt++ );
594 bool sameSide = true;
595 while ( edgeIt != edges.end() && sameSide ) {
596 GeomAbs_Shape cont = SMESH_Algo::Continuity( sideEdges.back(), *edgeIt );
597 sameSide = ( cont >= GeomAbs_C1 );
599 sideEdges.push_back( *edgeIt++ );
601 quad->side[nbSides] = new StdMeshers_FaceSide(F,sideEdges,&aMesh,nbSides<TOP_SIDE);
606 INFOS("face must have 4 edges / quadrangle");
614 //=============================================================================
618 //=============================================================================
620 FaceQuadStruct *StdMeshers_Quadrangle_2D::CheckAnd2Dcompute
622 const TopoDS_Shape & aShape,
623 const bool CreateQuadratic) throw(SALOME_Exception)
625 Unexpect aCatch(SalomeException);
627 _quadraticMesh = CreateQuadratic;
629 FaceQuadStruct *quad = CheckNbEdges(aMesh, aShape);
633 // set normalized grid on unit square in parametric domain
634 SetNormalizedGrid(aMesh, aShape, quad);
639 //=============================================================================
643 //=============================================================================
645 faceQuadStruct::~faceQuadStruct()
647 for (int i = 0; i < 4; i++) {
648 if (side[i]) delete side[i];
649 //if (uv_edges[i]) delete [] uv_edges[i];
651 if (uv_grid) delete [] uv_grid;
655 inline const vector<UVPtStruct>& GetUVPtStructIn(FaceQuadStruct* quad, int i, int nbSeg)
657 bool isXConst = ( i == BOTTOM_SIDE || i == TOP_SIDE );
658 double constValue = ( i == BOTTOM_SIDE || i == LEFT_SIDE ) ? 0 : 1;
661 quad->side[i]->SimulateUVPtStruct(nbSeg,isXConst,constValue) :
662 quad->side[i]->GetUVPtStruct(isXConst,constValue);
666 //=============================================================================
670 //=============================================================================
672 bool StdMeshers_Quadrangle_2D::SetNormalizedGrid (SMESH_Mesh & aMesh,
673 const TopoDS_Shape& aShape,
674 FaceQuadStruct* & quad) throw (SALOME_Exception)
676 Unexpect aCatch(SalomeException);
677 // Algorithme décrit dans "Génération automatique de maillages"
678 // P.L. GEORGE, MASSON, § 6.4.1 p. 84-85
679 // traitement dans le domaine paramétrique 2d u,v
680 // transport - projection sur le carré unité
682 // MESSAGE("StdMeshers_Quadrangle_2D::SetNormalizedGrid");
683 // const TopoDS_Face& F = TopoDS::Face(aShape);
685 // 1 --- find orientation of the 4 edges, by test on extrema
688 // |<----north-2-------^ a3 -------------> a2
690 // west-3 east-1 =right | |
694 // v----south-0--------> a0 -------------> a1
699 // 3 --- 2D normalized values on unit square [0..1][0..1]
701 int nbhoriz = Min(quad->side[0]->NbPoints(), quad->side[2]->NbPoints());
702 int nbvertic = Min(quad->side[1]->NbPoints(), quad->side[3]->NbPoints());
704 quad->isEdgeOut[0] = (quad->side[0]->NbPoints() > quad->side[2]->NbPoints());
705 quad->isEdgeOut[1] = (quad->side[1]->NbPoints() > quad->side[3]->NbPoints());
706 quad->isEdgeOut[2] = (quad->side[2]->NbPoints() > quad->side[0]->NbPoints());
707 quad->isEdgeOut[3] = (quad->side[3]->NbPoints() > quad->side[1]->NbPoints());
709 UVPtStruct *uv_grid = quad->uv_grid = new UVPtStruct[nbvertic * nbhoriz];
711 const vector<UVPtStruct>& uv_e0 = GetUVPtStructIn( quad, 0, nbhoriz - 1 );
712 const vector<UVPtStruct>& uv_e1 = GetUVPtStructIn( quad, 1, nbvertic - 1 );
713 const vector<UVPtStruct>& uv_e2 = GetUVPtStructIn( quad, 2, nbhoriz - 1 );
714 const vector<UVPtStruct>& uv_e3 = GetUVPtStructIn( quad, 3, nbvertic - 1 );
716 if ( uv_e0.empty() || uv_e1.empty() || uv_e2.empty() || uv_e3.empty() ) {
717 MESSAGE("Nodes from edges not loaded");
721 // nodes Id on "in" edges
722 if (! quad->isEdgeOut[0]) {
724 for (int i = 0; i < nbhoriz; i++) { // down
725 int ij = j * nbhoriz + i;
726 uv_grid[ij].node = uv_e0[i].node;
729 if (! quad->isEdgeOut[1]) {
731 for (int j = 0; j < nbvertic; j++) { // right
732 int ij = j * nbhoriz + i;
733 uv_grid[ij].node = uv_e1[j].node;
736 if (! quad->isEdgeOut[2]) {
737 int j = nbvertic - 1;
738 for (int i = 0; i < nbhoriz; i++) { // up
739 int ij = j * nbhoriz + i;
740 uv_grid[ij].node = uv_e2[i].node;
743 if (! quad->isEdgeOut[3]) {
745 for (int j = 0; j < nbvertic; j++) { // left
746 int ij = j * nbhoriz + i;
747 uv_grid[ij].node = uv_e3[j].node;
751 // normalized 2d values on grid
752 for (int i = 0; i < nbhoriz; i++)
754 for (int j = 0; j < nbvertic; j++)
756 int ij = j * nbhoriz + i;
757 // --- droite i cste : x = x0 + y(x1-x0)
758 double x0 = uv_e0[i].normParam; // bas - sud
759 double x1 = uv_e2[i].normParam; // haut - nord
760 // --- droite j cste : y = y0 + x(y1-y0)
761 double y0 = uv_e3[j].normParam; // gauche-ouest
762 double y1 = uv_e1[j].normParam; // droite - est
763 // --- intersection : x=x0+(y0+x(y1-y0))(x1-x0)
764 double x = (x0 + y0 * (x1 - x0)) / (1 - (y1 - y0) * (x1 - x0));
765 double y = y0 + x * (y1 - y0);
768 //MESSAGE("-xy-01 "<<x0<<" "<<x1<<" "<<y0<<" "<<y1);
769 //MESSAGE("-xy-norm "<<i<<" "<<j<<" "<<x<<" "<<y);
773 // 4 --- projection on 2d domain (u,v)
774 gp_UV a0( uv_e0.front().u, uv_e0.front().v );
775 gp_UV a1( uv_e0.back().u, uv_e0.back().v );
776 gp_UV a2( uv_e2.back().u, uv_e2.back().v );
777 gp_UV a3( uv_e2.front().u, uv_e2.front().v );
779 for (int i = 0; i < nbhoriz; i++)
781 for (int j = 0; j < nbvertic; j++)
783 int ij = j * nbhoriz + i;
784 double x = uv_grid[ij].x;
785 double y = uv_grid[ij].y;
786 double param_0 = uv_e0[0].normParam + x * (uv_e0.back().normParam - uv_e0[0].normParam); // sud
787 double param_2 = uv_e2[0].normParam + x * (uv_e2.back().normParam - uv_e2[0].normParam); // nord
788 double param_1 = uv_e1[0].normParam + y * (uv_e1.back().normParam - uv_e1[0].normParam); // est
789 double param_3 = uv_e3[0].normParam + y * (uv_e3.back().normParam - uv_e3[0].normParam); // ouest
791 //MESSAGE("params "<<param_0<<" "<<param_1<<" "<<param_2<<" "<<param_3);
792 gp_UV p0 = quad->side[0]->Value2d(param_0).XY();
793 gp_UV p1 = quad->side[1]->Value2d(param_1).XY();
794 gp_UV p2 = quad->side[2]->Value2d(param_2).XY();
795 gp_UV p3 = quad->side[3]->Value2d(param_3).XY();
797 gp_UV uv = (1 - y) * p0 + x * p1 + y * p2 + (1 - x) * p3;
798 uv -= (1 - x) * (1 - y) * a0 + x * (1 - y) * a1 + x * y * a2 + (1 - x) * y * a3;
800 uv_grid[ij].u = uv.X();
801 uv_grid[ij].v = uv.Y();
807 //=======================================================================
808 //function : ShiftQuad
809 //purpose : auxilary function for ComputeQuadPref
810 //=======================================================================
812 static void ShiftQuad(FaceQuadStruct* quad, const int num, bool)
814 StdMeshers_FaceSide* side[4] = { quad->side[0], quad->side[1], quad->side[2], quad->side[3] };
815 for (int i = BOTTOM_SIDE; i < NB_SIDES; ++i ) {
816 int id = ( i + num ) % NB_SIDES;
817 bool wasForward = ( i < TOP_SIDE );
818 bool newForward = ( id < TOP_SIDE );
819 if ( wasForward != newForward )
820 side[ i ]->Reverse();
821 quad->side[ id ] = side[ i ];
825 //=======================================================================
827 //purpose : auxilary function for ComputeQuadPref
828 //=======================================================================
830 static gp_UV CalcUV(double x0, double x1, double y0, double y1,
831 FaceQuadStruct* quad,
832 const gp_UV& a0, const gp_UV& a1,
833 const gp_UV& a2, const gp_UV& a3)
835 const vector<UVPtStruct>& uv_eb = quad->side[0]->GetUVPtStruct(true,0 );
836 const vector<UVPtStruct>& uv_er = quad->side[1]->GetUVPtStruct(false,1);
837 const vector<UVPtStruct>& uv_et = quad->side[2]->GetUVPtStruct(true,1 );
838 const vector<UVPtStruct>& uv_el = quad->side[3]->GetUVPtStruct(false,0);
840 double x = (x0 + y0 * (x1 - x0)) / (1 - (y1 - y0) * (x1 - x0));
841 double y = y0 + x * (y1 - y0);
843 double param_b = uv_eb[0].normParam + x * (uv_eb.back().normParam - uv_eb[0].normParam);
844 double param_t = uv_et[0].normParam + x * (uv_et.back().normParam - uv_et[0].normParam);
845 double param_r = uv_er[0].normParam + y * (uv_er.back().normParam - uv_er[0].normParam);
846 double param_l = uv_el[0].normParam + y * (uv_el.back().normParam - uv_el[0].normParam);
848 gp_UV p0 = quad->side[BOTTOM_SIDE]->Value2d(param_b).XY();
849 gp_UV p1 = quad->side[RIGHT_SIDE ]->Value2d(param_r).XY();
850 gp_UV p2 = quad->side[TOP_SIDE ]->Value2d(param_t).XY();
851 gp_UV p3 = quad->side[LEFT_SIDE ]->Value2d(param_l).XY();
853 gp_UV uv = p0 * (1 - y) + p1 * x + p2 * y + p3 * (1 - x);
855 uv -= (1 - x) * (1 - y) * a0 + x * (1 - y) * a1 + x * y * a2 + (1 - x) * y * a3;
857 //cout<<"x0="<<x0<<" x1="<<x1<<" y0="<<y0<<" y1="<<y1<<endl;
858 //cout<<"x="<<x<<" y="<<y<<endl;
859 //cout<<"param_b="<<param_b<<" param_t="<<param_t<<" param_r="<<param_r<<" param_l="<<param_l<<endl;
860 //cout<<"u="<<u<<" v="<<v<<endl;
865 //=======================================================================
866 //function : ComputeQuadPref
868 //=======================================================================
870 * Special function for creation only quandrangle faces
872 bool StdMeshers_Quadrangle_2D::ComputeQuadPref
874 const TopoDS_Shape& aShape,
875 FaceQuadStruct* quad) throw (SALOME_Exception)
877 Unexpect aCatch(SalomeException);
879 SMESHDS_Mesh * meshDS = aMesh.GetMeshDS();
880 const TopoDS_Face& F = TopoDS::Face(aShape);
881 Handle(Geom_Surface) S = BRep_Tool::Surface(F);
882 const TopoDS_Wire& W = BRepTools::OuterWire(F);
884 if(W.Orientation()==TopAbs_FORWARD)
886 //if(WisF) cout<<"W is FORWARD"<<endl;
887 //else cout<<"W is REVERSED"<<endl;
888 bool FisF = (F.Orientation()==TopAbs_FORWARD);
889 if(!FisF) WisF = !WisF;
890 int i,j,geomFaceID = meshDS->ShapeToIndex( F );
892 int nb = quad->side[0]->NbPoints();
893 int nr = quad->side[1]->NbPoints();
894 int nt = quad->side[2]->NbPoints();
895 int nl = quad->side[3]->NbPoints();
901 // it is a base case => not shift quad but me be replacement is need
902 ShiftQuad(quad,0,WisF);
905 // we have to shift quad on 2
906 ShiftQuad(quad,2,WisF);
911 // we have to shift quad on 1
912 ShiftQuad(quad,1,WisF);
915 // we have to shift quad on 3
916 ShiftQuad(quad,3,WisF);
920 nb = quad->side[0]->NbPoints();
921 nr = quad->side[1]->NbPoints();
922 nt = quad->side[2]->NbPoints();
923 nl = quad->side[3]->NbPoints();
926 int nbh = Max(nb,nt);
927 int nbv = Max(nr,nl);
931 // orientation of face and 3 main domain for future faces
937 // left | | | | rigth
953 const vector<UVPtStruct>& uv_eb = quad->side[0]->GetUVPtStruct(true,0 );
954 const vector<UVPtStruct>& uv_er = quad->side[1]->GetUVPtStruct(false,1);
955 const vector<UVPtStruct>& uv_et = quad->side[2]->GetUVPtStruct(true,1 );
956 const vector<UVPtStruct>& uv_el = quad->side[3]->GetUVPtStruct(false,0);
958 // arrays for normalized params
959 //cout<<"Dump B:"<<endl;
960 TColStd_SequenceOfReal npb, npr, npt, npl;
961 for(i=0; i<nb; i++) {
962 npb.Append(uv_eb[i].normParam);
963 //cout<<"i="<<i<<" par="<<uv_eb[i].normParam<<" npar="<<uv_eb[i].normParam;
964 //const SMDS_MeshNode* N = uv_eb[i].node;
965 //cout<<" node("<<N->X()<<","<<N->Y()<<","<<N->Z()<<")"<<endl;
967 for(i=0; i<nr; i++) {
968 npr.Append(uv_er[i].normParam);
970 for(i=0; i<nt; i++) {
971 npt.Append(uv_et[i].normParam);
973 for(i=0; i<nl; i++) {
974 npl.Append(uv_el[i].normParam);
977 // add some params to right and left after the first param
980 double dpr = (npr.Value(2) - npr.Value(1))/(dr+1);
981 for(i=1; i<=dr; i++) {
982 npr.InsertAfter(1,npr.Value(2)-dpr);
986 dpr = (npl.Value(2) - npl.Value(1))/(dl+1);
987 for(i=1; i<=dl; i++) {
988 npl.InsertAfter(1,npl.Value(2)-dpr);
991 //for(i=1; i<=npb.Length(); i++) {
992 // cout<<" "<<npb.Value(i);
996 gp_XY a0( uv_eb.front().u, uv_eb.front().v );
997 gp_XY a1( uv_eb.back().u, uv_eb.back().v );
998 gp_XY a2( uv_et.back().u, uv_et.back().v );
999 gp_XY a3( uv_et.front().u, uv_et.front().v );
1000 //cout<<" a0("<<a0.X()<<","<<a0.Y()<<")"<<" a1("<<a1.X()<<","<<a1.Y()<<")"
1001 // <<" a2("<<a2.X()<<","<<a2.Y()<<")"<<" a3("<<a3.X()<<","<<a3.Y()<<")"<<endl;
1003 int nnn = Min(nr,nl);
1004 // auxilary sequence of XY for creation nodes
1005 // in the bottom part of central domain
1006 // it's length must be == nbv-nnn-1
1007 TColgp_SequenceOfXY UVL;
1008 TColgp_SequenceOfXY UVR;
1010 // step1: create faces for left domain
1011 StdMeshers_Array2OfNode NodesL(1,dl+1,1,nl);
1013 for(j=1; j<=nl; j++)
1014 NodesL.SetValue(1,j,uv_el[j-1].node);
1017 for(i=1; i<=dl; i++)
1018 NodesL.SetValue(i+1,nl,uv_et[i].node);
1019 // create and add needed nodes
1020 TColgp_SequenceOfXY UVtmp;
1021 for(i=1; i<=dl; i++) {
1022 double x0 = npt.Value(i+1);
1025 double y0 = npl.Value(i+1);
1026 double y1 = npr.Value(i+1);
1027 gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1028 gp_Pnt P = S->Value(UV.X(),UV.Y());
1029 SMDS_MeshNode * N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1030 meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1031 NodesL.SetValue(i+1,1,N);
1032 if(UVL.Length()<nbv-nnn-1) UVL.Append(UV);
1034 for(j=2; j<nl; j++) {
1035 double y0 = npl.Value(dl+j);
1036 double y1 = npr.Value(dl+j);
1037 gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1038 gp_Pnt P = S->Value(UV.X(),UV.Y());
1039 SMDS_MeshNode* N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1040 meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1041 NodesL.SetValue(i+1,j,N);
1042 if( i==dl ) UVtmp.Append(UV);
1045 for(i=1; i<=UVtmp.Length() && UVL.Length()<nbv-nnn-1; i++) {
1046 UVL.Append(UVtmp.Value(i));
1048 //cout<<"Dump NodesL:"<<endl;
1049 //for(i=1; i<=dl+1; i++) {
1051 // for(j=1; j<=nl; j++) {
1052 // cout<<" ("<<NodesL.Value(i,j)->X()<<","<<NodesL.Value(i,j)->Y()<<","<<NodesL.Value(i,j)->Z()<<")";
1057 for(i=1; i<=dl; i++) {
1058 for(j=1; j<nl; j++) {
1061 myTool->AddFace(NodesL.Value(i,j), NodesL.Value(i+1,j),
1062 NodesL.Value(i+1,j+1), NodesL.Value(i,j+1));
1063 meshDS->SetMeshElementOnShape(F, geomFaceID);
1067 myTool->AddFace(NodesL.Value(i,j), NodesL.Value(i,j+1),
1068 NodesL.Value(i+1,j+1), NodesL.Value(i+1,j));
1069 meshDS->SetMeshElementOnShape(F, geomFaceID);
1075 // fill UVL using c2d
1076 for(i=1; i<npl.Length() && UVL.Length()<nbv-nnn-1; i++) {
1077 UVL.Append( gp_UV ( uv_el[i].u, uv_el[i].v ));
1081 // step2: create faces for right domain
1082 StdMeshers_Array2OfNode NodesR(1,dr+1,1,nr);
1084 for(j=1; j<=nr; j++)
1085 NodesR.SetValue(1,j,uv_er[nr-j].node);
1088 for(i=1; i<=dr; i++)
1089 NodesR.SetValue(i+1,1,uv_et[nt-1-i].node);
1090 // create and add needed nodes
1091 TColgp_SequenceOfXY UVtmp;
1092 for(i=1; i<=dr; i++) {
1093 double x0 = npt.Value(nt-i);
1096 double y0 = npl.Value(i+1);
1097 double y1 = npr.Value(i+1);
1098 gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1099 gp_Pnt P = S->Value(UV.X(),UV.Y());
1100 SMDS_MeshNode * N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1101 meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1102 NodesR.SetValue(i+1,nr,N);
1103 if(UVR.Length()<nbv-nnn-1) UVR.Append(UV);
1105 for(j=2; j<nr; j++) {
1106 double y0 = npl.Value(nbv-j+1);
1107 double y1 = npr.Value(nbv-j+1);
1108 gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1109 gp_Pnt P = S->Value(UV.X(),UV.Y());
1110 SMDS_MeshNode* N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1111 meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1112 NodesR.SetValue(i+1,j,N);
1113 if( i==dr ) UVtmp.Prepend(UV);
1116 for(i=1; i<=UVtmp.Length() && UVR.Length()<nbv-nnn-1; i++) {
1117 UVR.Append(UVtmp.Value(i));
1120 for(i=1; i<=dr; i++) {
1121 for(j=1; j<nr; j++) {
1124 myTool->AddFace(NodesR.Value(i,j), NodesR.Value(i+1,j),
1125 NodesR.Value(i+1,j+1), NodesR.Value(i,j+1));
1126 meshDS->SetMeshElementOnShape(F, geomFaceID);
1130 myTool->AddFace(NodesR.Value(i,j), NodesR.Value(i,j+1),
1131 NodesR.Value(i+1,j+1), NodesR.Value(i+1,j));
1132 meshDS->SetMeshElementOnShape(F, geomFaceID);
1138 // fill UVR using c2d
1139 for(i=1; i<npr.Length() && UVR.Length()<nbv-nnn-1; i++) {
1140 UVR.Append( gp_UV( uv_er[i].u, uv_er[i].v ));
1144 // step3: create faces for central domain
1145 StdMeshers_Array2OfNode NodesC(1,nb,1,nbv);
1146 // add first string using NodesL
1147 for(i=1; i<=dl+1; i++)
1148 NodesC.SetValue(1,i,NodesL(i,1));
1149 for(i=2; i<=nl; i++)
1150 NodesC.SetValue(1,dl+i,NodesL(dl+1,i));
1151 // add last string using NodesR
1152 for(i=1; i<=dr+1; i++)
1153 NodesC.SetValue(nb,i,NodesR(i,nr));
1155 NodesC.SetValue(nb,dr+i+1,NodesR(dr+1,nr-i));
1156 // add top nodes (last columns)
1157 for(i=dl+2; i<nbh-dr; i++)
1158 NodesC.SetValue(i-dl,nbv,uv_et[i-1].node);
1159 // add bottom nodes (first columns)
1161 NodesC.SetValue(i,1,uv_eb[i-1].node);
1163 // create and add needed nodes
1164 // add linear layers
1165 for(i=2; i<nb; i++) {
1166 double x0 = npt.Value(dl+i);
1168 for(j=1; j<nnn; j++) {
1169 double y0 = npl.Value(nbv-nnn+j);
1170 double y1 = npr.Value(nbv-nnn+j);
1171 gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1172 gp_Pnt P = S->Value(UV.X(),UV.Y());
1173 SMDS_MeshNode* N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1174 meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1175 NodesC.SetValue(i,nbv-nnn+j,N);
1178 // add diagonal layers
1179 //cout<<"UVL.Length()="<<UVL.Length()<<" UVR.Length()="<<UVR.Length()<<endl;
1180 //cout<<"Dump UVL:"<<endl;
1181 //for(i=1; i<=UVL.Length(); i++) {
1182 // cout<<" ("<<UVL.Value(i).X()<<","<<UVL.Value(i).Y()<<")";
1185 for(i=1; i<nbv-nnn; i++) {
1186 double du = UVR.Value(i).X() - UVL.Value(i).X();
1187 double dv = UVR.Value(i).Y() - UVL.Value(i).Y();
1188 for(j=2; j<nb; j++) {
1189 double u = UVL.Value(i).X() + du*npb.Value(j);
1190 double v = UVL.Value(i).Y() + dv*npb.Value(j);
1191 gp_Pnt P = S->Value(u,v);
1192 SMDS_MeshNode* N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1193 meshDS->SetNodeOnFace(N, geomFaceID, u, v);
1194 NodesC.SetValue(j,i+1,N);
1198 for(i=1; i<nb; i++) {
1199 for(j=1; j<nbv; j++) {
1202 myTool->AddFace(NodesC.Value(i,j), NodesC.Value(i+1,j),
1203 NodesC.Value(i+1,j+1), NodesC.Value(i,j+1));
1204 meshDS->SetMeshElementOnShape(F, geomFaceID);
1208 myTool->AddFace(NodesC.Value(i,j), NodesC.Value(i,j+1),
1209 NodesC.Value(i+1,j+1), NodesC.Value(i+1,j));
1210 meshDS->SetMeshElementOnShape(F, geomFaceID);