Salome HOME
52a35e8f097d3fc844048ff9741fd82ea57708b3
[modules/smesh.git] / src / StdMeshers / StdMeshers_Quadrangle_2D.cxx
1 //  SMESH SMESH : implementaion of SMESH idl descriptions
2 //
3 //  Copyright (C) 2003  OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
4 //  CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS 
5 // 
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. 
10 // 
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. 
15 // 
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 
19 // 
20 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
21 //
22 //
23 //
24 //  File   : StdMeshers_Quadrangle_2D.cxx
25 //           Moved here from SMESH_Quadrangle_2D.cxx
26 //  Author : Paul RASCLE, EDF
27 //  Module : SMESH
28 //  $Header$
29
30 #include "StdMeshers_Quadrangle_2D.hxx"
31
32 #include "StdMeshers_FaceSide.hxx"
33
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"
39
40 #include "SMDS_MeshElement.hxx"
41 #include "SMDS_MeshNode.hxx"
42 #include "SMDS_EdgePosition.hxx"
43 #include "SMDS_FacePosition.hxx"
44
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>
55 #include <TopExp.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>
62
63 #include "utilities.h"
64 #include "Utils_ExceptHandlers.hxx"
65
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)
72 #endif
73
74 using namespace std;
75
76 typedef gp_XY gp_UV;
77
78 //=============================================================================
79 /*!
80  *  
81  */
82 //=============================================================================
83
84 StdMeshers_Quadrangle_2D::StdMeshers_Quadrangle_2D (int hypId, int studyId, SMESH_Gen* gen)
85      : SMESH_2D_Algo(hypId, studyId, gen)
86 {
87   MESSAGE("StdMeshers_Quadrangle_2D::StdMeshers_Quadrangle_2D");
88   _name = "Quadrangle_2D";
89   _shapeType = (1 << TopAbs_FACE);
90   _compatibleHypothesis.push_back("QuadranglePreference");
91   myTool = 0;
92 }
93
94 //=============================================================================
95 /*!
96  *  
97  */
98 //=============================================================================
99
100 StdMeshers_Quadrangle_2D::~StdMeshers_Quadrangle_2D()
101 {
102   MESSAGE("StdMeshers_Quadrangle_2D::~StdMeshers_Quadrangle_2D");
103 }
104
105 //=============================================================================
106 /*!
107  *  
108  */
109 //=============================================================================
110
111 bool StdMeshers_Quadrangle_2D::CheckHypothesis
112                          (SMESH_Mesh&                          aMesh,
113                           const TopoDS_Shape&                  aShape,
114                           SMESH_Hypothesis::Hypothesis_Status& aStatus)
115 {
116   bool isOk = true;
117   aStatus = SMESH_Hypothesis::HYP_OK;
118
119   // there is only one compatible Hypothesis so far
120   const list <const SMESHDS_Hypothesis * >&hyps = GetUsedHypothesis(aMesh, aShape);
121   myQuadranglePreference = hyps.size() > 0;
122
123   return isOk;
124 }
125
126 //=============================================================================
127 /*!
128  *  
129  */
130 //=============================================================================
131
132 bool StdMeshers_Quadrangle_2D::Compute (SMESH_Mesh& aMesh,
133                                         const TopoDS_Shape& aShape) throw (SALOME_Exception)
134 {
135   Unexpect aCatch(SalomeException);
136
137   SMESHDS_Mesh * meshDS = aMesh.GetMeshDS();
138   aMesh.GetSubMesh(aShape);
139
140   myTool = new SMESH_MesherHelper(aMesh);
141   std::auto_ptr<SMESH_MesherHelper> helperDeleter( myTool );// to delete helper at exit from Compute()
142
143   _quadraticMesh = myTool->IsQuadraticSubMesh(aShape);
144
145   FaceQuadStruct *quad = CheckNbEdges( aMesh, aShape );
146   std::auto_ptr<FaceQuadStruct> quadDeleter( quad ); // to delete quad at exit from Compute()
147   if (!quad)
148     return false;
149
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;
156     int ntmp = nfull/2;
157     ntmp = ntmp*2;
158     if( nfull==ntmp && ( (n1!=n3) || (n2!=n4) ) ) {
159       // special path for using only quandrangle faces
160       bool ok = ComputeQuadPref(aMesh, aShape, quad);
161       return ok;
162     }
163   }
164
165   // set normalized grid on unit square in parametric domain
166   
167   if (!SetNormalizedGrid(aMesh, aShape, quad))
168     return false;
169
170   // --- compute 3D values on points, store points & quadrangles
171
172   int nbdown  = quad->side[0]->NbPoints();
173   int nbup    = quad->side[2]->NbPoints();
174
175   int nbright = quad->side[1]->NbPoints();
176   int nbleft  = quad->side[3]->NbPoints();
177
178   int nbhoriz  = Min(nbdown, nbup);
179   int nbvertic = Min(nbright, nbleft);
180
181   const TopoDS_Face& F = TopoDS::Face(aShape);
182   Handle(Geom_Surface) S = BRep_Tool::Surface(F);
183
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;
195     }
196   }
197   
198   // mesh faces
199
200   //             [2]
201   //      --.--.--.--.--.--  nbvertic
202   //     |                 | ^
203   //     |                 | ^
204   // [3] |                 | ^ j  [1]
205   //     |                 | ^
206   //     |                 | ^
207   //      ---.----.----.---  0
208   //     0 > > > > > > > > nbhoriz
209   //              i
210   //             [0]
211   
212   i = 0;
213   int ilow = 0;
214   int iup = nbhoriz - 1;
215   if (quad->isEdgeOut[3]) { ilow++; } else { if (quad->isEdgeOut[1]) iup--; }
216   
217   int jlow = 0;
218   int jup = nbvertic - 1;
219   if (quad->isEdgeOut[0]) { jlow++; } else { if (quad->isEdgeOut[2]) jup--; }
220   
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);
231     }
232   }
233
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);
238
239   double eps = Precision::Confusion();
240
241   // Boundary quadrangles
242   
243   if (quad->isEdgeOut[0]) {
244     // Down edge is out
245     // 
246     // |___|___|___|___|___|___|
247     // |   |   |   |   |   |   |
248     // |___|___|___|___|___|___|
249     // |   |   |   |   |   |   |
250     // |___|___|___|___|___|___| __ first row of the regular grid
251     // .  .  .  .  .  .  .  .  . __ down edge nodes
252     // 
253     // >->->->->->->->->->->->-> -- direction of processing
254       
255     int g = 0; // number of last processed node in the regular grid
256     
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--;
261     
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;
266       a = uv_e0[i].node;
267       b = uv_e0[i + 1].node;
268       gp_Pnt pb (b->X(), b->Y(), b->Z());
269       
270       // find node c in the regular grid, which will be linked with node b
271       int near = g;
272       if (i == stop - 1) {
273         // right bound reached, link with the rightmost node
274         near = iup;
275         c = quad->uv_grid[nbhoriz + iup].node;
276       }
277       else {
278         // find in the grid node c, nearest to the b
279         double mind = RealLast();
280         for (int k = g; k <= iup; k++) {
281           
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
285           else
286             nk = quad->uv_grid[nbhoriz + k].node; // get one of middle nodes
287
288           gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
289           double dist = pb.Distance(pnk);
290           if (dist < mind - eps) {
291             c = nk;
292             near = k;
293             mind = dist;
294           } else {
295             break;
296           }
297         }
298       }
299
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);
304       }
305       else { // make quadrangle
306         if (near - 1 < ilow)
307           d = uv_e3[1].node;
308         else
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);
313
314         // if node d is not at position g - make additional triangles
315         if (near - 1 > g) {
316           for (int k = near - 1; k > g; k--) {
317             c = quad->uv_grid[nbhoriz + k].node;
318             if (k - 1 < ilow)
319               d = uv_e3[1].node;
320             else
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);
325           }
326         }
327         g = near;
328       }
329     }
330   } else {
331     if (quad->isEdgeOut[2]) {
332       // Up edge is out
333       // 
334       // <-<-<-<-<-<-<-<-<-<-<-<-< -- direction of processing
335       // 
336       // .  .  .  .  .  .  .  .  . __ up edge nodes
337       //  ___ ___ ___ ___ ___ ___  __ first row of the regular grid
338       // |   |   |   |   |   |   |
339       // |___|___|___|___|___|___|
340       // |   |   |   |   |   |   |
341       // |___|___|___|___|___|___|
342       // |   |   |   |   |   |   |
343
344       int g = nbhoriz - 1; // last processed node in the regular grid
345
346       int stop = 0;
347       // if left edge is out, we will stop at a second node
348       if (quad->isEdgeOut[3]) stop++;
349
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;
354         a = uv_e2[i].node;
355         b = uv_e2[i - 1].node;
356         gp_Pnt pb (b->X(), b->Y(), b->Z());
357
358         // find node c in the grid, which will be linked with node b
359         int near = g;
360         if (i == stop + 1) { // left bound reached, link with the leftmost node
361           c = quad->uv_grid[nbhoriz*(nbvertic - 2) + ilow].node;
362           near = ilow;
363         } else {
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;
368             if (k > iup)
369               nk = uv_e1[nbright - 2].node;
370             else
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) {
375               c = nk;
376               near = k;
377               mind = dist;
378             } else {
379               break;
380             }
381           }
382         }
383
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);
388         }
389         else { // make quadrangle
390           if (near + 1 > iup)
391             d = uv_e1[nbright - 2].node;
392           else
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);
397
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;
401               if (k + 1 > iup)
402                 d = uv_e1[nbright - 2].node;
403               else
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);
408             }
409           }
410           g = near;
411         }
412       }
413     }
414   }
415
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;
424       a = uv_e1[i].node;
425       b = uv_e1[i + 1].node;
426       gp_Pnt pb (b->X(), b->Y(), b->Z());
427
428       // find node c in the grid, nearest to the b
429       int near = g;
430       if (i == stop - 1) { // up bondary reached
431         c = quad->uv_grid[nbhoriz*(jup + 1) - 2].node;
432         near = jup;
433       } else {
434         double mind = RealLast();
435         for (int k = g; k <= jup; k++) {
436           const SMDS_MeshNode *nk;
437           if (k < jlow)
438             nk = uv_e0[nbdown - 2].node;
439           else
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) {
444             c = nk;
445             near = k;
446             mind = dist;
447           } else {
448             break;
449           }
450         }
451       }
452
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);
457       }
458       else { // make quadrangle
459         if (near - 1 < jlow)
460           d = uv_e0[nbdown - 2].node;
461         else
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);
466
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;
470             if (k - 1 < jlow)
471               d = uv_e0[nbdown - 2].node;
472             else
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);
477           }
478         }
479         g = near;
480       }
481     }
482   } else {
483     if (quad->isEdgeOut[3]) {
484 //      MESSAGE("left edge is out");
485       int g = nbvertic - 1; // last processed node in the grid
486       int stop = 0;
487       if (quad->isEdgeOut[0]) stop++;
488       for (i = nbleft - 1; i > stop; i--) {
489         const SMDS_MeshNode *a, *b, *c, *d;
490         a = uv_e3[i].node;
491         b = uv_e3[i - 1].node;
492         gp_Pnt pb (b->X(), b->Y(), b->Z());
493
494         // find node c in the grid, nearest to the b
495         int near = g;
496         if (i == stop + 1) { // down bondary reached
497           c = quad->uv_grid[nbhoriz*jlow + 1].node;
498           near = jlow;
499         } else {
500           double mind = RealLast();
501           for (int k = g; k >= jlow; k--) {
502             const SMDS_MeshNode *nk;
503             if (k > jup)
504               nk = uv_e2[1].node;
505             else
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) {
510               c = nk;
511               near = k;
512               mind = dist;
513             } else {
514               break;
515             }
516           }
517         }
518
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);
523         }
524         else { // make quadrangle
525           if (near + 1 > jup)
526             d = uv_e2[1].node;
527           else
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);
532
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;
536               if (k + 1 > jup)
537                 d = uv_e2[1].node;
538               else
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);
543             }
544           }
545           g = near;
546         }
547       }
548     }
549   }
550
551   bool isOk = true;
552   return isOk;
553 }
554
555 //=============================================================================
556 /*!
557  *  
558  */
559 //=============================================================================
560
561 FaceQuadStruct* StdMeshers_Quadrangle_2D::CheckNbEdges(SMESH_Mesh &         aMesh,
562                                                        const TopoDS_Shape & aShape)
563      throw(SALOME_Exception)
564 {
565   Unexpect aCatch(SalomeException);
566
567   const TopoDS_Face & F = TopoDS::Face(aShape);
568
569   // verify 1 wire only, with 4 edges
570   TopoDS_Vertex V;
571   list< TopoDS_Edge > edges;
572   list< int > nbEdgesInWire;
573   int nbWire = SMESH_Block::GetOrderedEdges (F, V, edges, nbEdgesInWire);
574   if (nbWire != 1) {
575     INFOS("only 1 wire by face (quadrangles)");
576     return 0;
577   }
578   FaceQuadStruct* quad = new FaceQuadStruct;
579   quad->uv_grid = 0;
580   for ( int i = 0; i < NB_SIDES; ++i )
581     quad->side[i] = 0;
582
583   int nbSides = 0;
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);
588   }
589   else if ( nbEdgesInWire.front() > 4 ) { // more than 4 edges - try to unite
590     list< TopoDS_Edge > sideEdges;
591     while ( edgeIt != edges.end()) {
592       sideEdges.clear();
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 );
598         if ( sameSide )
599           sideEdges.push_back( *edgeIt++ );
600       }
601       quad->side[nbSides] = new StdMeshers_FaceSide(F,sideEdges,&aMesh,nbSides<TOP_SIDE);
602       ++nbSides;
603     }
604   }
605   if (nbSides != 4) {
606     INFOS("face must have 4 edges / quadrangle");
607     delete quad;
608     quad = 0;
609   }
610
611   return quad;
612 }
613
614 //=============================================================================
615 /*!
616  *  CheckAnd2Dcompute
617  */
618 //=============================================================================
619
620 FaceQuadStruct *StdMeshers_Quadrangle_2D::CheckAnd2Dcompute
621                            (SMESH_Mesh &         aMesh,
622                             const TopoDS_Shape & aShape,
623                             const bool           CreateQuadratic) throw(SALOME_Exception)
624 {
625   Unexpect aCatch(SalomeException);
626
627   _quadraticMesh = CreateQuadratic;
628
629   FaceQuadStruct *quad = CheckNbEdges(aMesh, aShape);
630
631   if(!quad) return 0;
632
633   // set normalized grid on unit square in parametric domain
634   SetNormalizedGrid(aMesh, aShape, quad);
635
636   return quad;
637 }
638
639 //=============================================================================
640 /*!
641  *  
642  */
643 //=============================================================================
644
645 faceQuadStruct::~faceQuadStruct()
646 {
647   for (int i = 0; i < 4; i++) {
648     if (side[i])     delete side[i];
649     //if (uv_edges[i]) delete [] uv_edges[i];
650   }
651   if (uv_grid)       delete [] uv_grid;
652 }
653
654 namespace {
655   inline const vector<UVPtStruct>& GetUVPtStructIn(FaceQuadStruct* quad, int i, int nbSeg)
656   {
657     bool isXConst = ( i == BOTTOM_SIDE || i == TOP_SIDE );
658     double constValue = ( i == BOTTOM_SIDE || i == LEFT_SIDE ) ? 0 : 1;
659     return
660       quad->isEdgeOut[i] ?
661       quad->side[i]->SimulateUVPtStruct(nbSeg,isXConst,constValue) :
662       quad->side[i]->GetUVPtStruct(isXConst,constValue);
663   }
664 }
665
666 //=============================================================================
667 /*!
668  *  
669  */
670 //=============================================================================
671
672 bool StdMeshers_Quadrangle_2D::SetNormalizedGrid (SMESH_Mesh & aMesh,
673                                                   const TopoDS_Shape& aShape,
674                                                   FaceQuadStruct* & quad) throw (SALOME_Exception)
675 {
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é
681
682 //  MESSAGE("StdMeshers_Quadrangle_2D::SetNormalizedGrid");
683 //  const TopoDS_Face& F = TopoDS::Face(aShape);
684
685   // 1 --- find orientation of the 4 edges, by test on extrema
686
687   //      max             min                    0     x1     1
688   //     |<----north-2-------^                a3 -------------> a2
689   //     |                   |                   ^1          1^
690   //    west-3            east-1 =right          |            |
691   //     |                   |         ==>       |            |
692   //  y0 |                   | y1                |            |
693   //     |                   |                   |0          0|
694   //     v----south-0-------->                a0 -------------> a1
695   //      min             max                    0     x0     1
696   //             =down
697   //
698
699   // 3 --- 2D normalized values on unit square [0..1][0..1]
700
701   int nbhoriz  = Min(quad->side[0]->NbPoints(), quad->side[2]->NbPoints());
702   int nbvertic = Min(quad->side[1]->NbPoints(), quad->side[3]->NbPoints());
703
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());
708
709   UVPtStruct *uv_grid = quad->uv_grid = new UVPtStruct[nbvertic * nbhoriz];
710
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 );
715
716   if ( uv_e0.empty() || uv_e1.empty() || uv_e2.empty() || uv_e3.empty() ) {
717     MESSAGE("Nodes from edges not loaded");
718     return false;
719   }
720
721   // nodes Id on "in" edges
722   if (! quad->isEdgeOut[0]) {
723     int j = 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;
727     }
728   }
729   if (! quad->isEdgeOut[1]) {
730     int i = nbhoriz - 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;
734     }
735   }
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;
741     }
742   }
743   if (! quad->isEdgeOut[3]) {
744     int i = 0;
745     for (int j = 0; j < nbvertic; j++) { // left
746       int ij = j * nbhoriz + i;
747       uv_grid[ij].node = uv_e3[j].node;
748     }
749   }
750
751   // normalized 2d values on grid
752   for (int i = 0; i < nbhoriz; i++)
753   {
754     for (int j = 0; j < nbvertic; j++)
755     {
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);
766       uv_grid[ij].x = x;
767       uv_grid[ij].y = y;
768       //MESSAGE("-xy-01 "<<x0<<" "<<x1<<" "<<y0<<" "<<y1);
769       //MESSAGE("-xy-norm "<<i<<" "<<j<<" "<<x<<" "<<y);
770     }
771   }
772
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 );
778
779   for (int i = 0; i < nbhoriz; i++)
780   {
781     for (int j = 0; j < nbvertic; j++)
782     {
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
790
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();
796
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;
799
800       uv_grid[ij].u = uv.X();
801       uv_grid[ij].v = uv.Y();
802     }
803   }
804   return true;
805 }
806
807 //=======================================================================
808 //function : ShiftQuad
809 //purpose  : auxilary function for ComputeQuadPref
810 //=======================================================================
811
812 static void ShiftQuad(FaceQuadStruct* quad, const int num, bool)
813 {
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 ];
822   }
823 }
824
825 //=======================================================================
826 //function : CalcUV
827 //purpose  : auxilary function for ComputeQuadPref
828 //=======================================================================
829
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)
834 {
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);
839
840   double x = (x0 + y0 * (x1 - x0)) / (1 - (y1 - y0) * (x1 - x0));
841   double y = y0 + x * (y1 - y0);
842
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);
847
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();
852
853   gp_UV uv = p0 * (1 - y) + p1 * x + p2 * y + p3 * (1 - x);
854
855   uv -= (1 - x) * (1 - y) * a0 + x * (1 - y) * a1 + x * y * a2 + (1 - x) * y * a3;
856
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;
861
862   return uv;
863 }
864
865 //=======================================================================
866 //function : ComputeQuadPref
867 //purpose  : 
868 //=======================================================================
869 /*!
870  * Special function for creation only quandrangle faces
871  */
872 bool StdMeshers_Quadrangle_2D::ComputeQuadPref
873                           (SMESH_Mesh &        aMesh,
874                            const TopoDS_Shape& aShape,
875                            FaceQuadStruct*     quad) throw (SALOME_Exception)
876 {
877   Unexpect aCatch(SalomeException);
878
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);
883   bool WisF = false;
884   if(W.Orientation()==TopAbs_FORWARD) 
885     WisF = true;
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 );
891
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();
896   int dh = abs(nb-nt);
897   int dv = abs(nr-nl);
898
899   if( dh>=dv ) {
900     if( nt>nb ) {
901       // it is a base case => not shift quad but me be replacement is need
902       ShiftQuad(quad,0,WisF);
903     }
904     else {
905       // we have to shift quad on 2
906       ShiftQuad(quad,2,WisF);
907     }
908   }
909   else {
910     if( nr>nl ) {
911       // we have to shift quad on 1
912       ShiftQuad(quad,1,WisF);
913     }
914     else {
915       // we have to shift quad on 3
916       ShiftQuad(quad,3,WisF);
917     }
918   }
919
920   nb = quad->side[0]->NbPoints();
921   nr = quad->side[1]->NbPoints();
922   nt = quad->side[2]->NbPoints();
923   nl = quad->side[3]->NbPoints();
924   dh = abs(nb-nt);
925   dv = abs(nr-nl);
926   int nbh  = Max(nb,nt);
927   int nbv = Max(nr,nl);
928   int addh = 0;
929   int addv = 0;
930
931   // orientation of face and 3 main domain for future faces
932   //       0   top    1
933   //      1------------1
934   //       |   |  |   |
935   //       |   |  |   |
936   //       | L |  | R |
937   //  left |   |  |   | rigth
938   //       |  /    \  |
939   //       | /  C   \ |
940   //       |/        \|
941   //      0------------0
942   //       0  bottom  1
943
944   if(dh>dv) {
945     addv = (dh-dv)/2;
946     nbv = nbv + addv;
947   }
948   else { // dv>=dh
949     addh = (dv-dh)/2;
950     nbh = nbh + addh;
951   }
952
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);
957
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;
966   }
967   for(i=0; i<nr; i++) {
968     npr.Append(uv_er[i].normParam);
969   }
970   for(i=0; i<nt; i++) {
971     npt.Append(uv_et[i].normParam);
972   }
973   for(i=0; i<nl; i++) {
974     npl.Append(uv_el[i].normParam);
975   }
976
977   // add some params to right and left after the first param
978   // insert to right
979   int dr = nbv - nr;
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);
983   }
984   // insert to left
985   int dl = nbv - nl;
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);
989   }
990   //cout<<"npb:";
991   //for(i=1; i<=npb.Length(); i++) {
992   //  cout<<" "<<npb.Value(i);
993   //}
994   //cout<<endl;
995   
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;
1002
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;
1009
1010   // step1: create faces for left domain
1011   StdMeshers_Array2OfNode NodesL(1,dl+1,1,nl);
1012   // add left nodes
1013   for(j=1; j<=nl; j++)
1014     NodesL.SetValue(1,j,uv_el[j-1].node);
1015   if(dl>0) {
1016     // add top nodes
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);
1023       double x1 = x0;
1024       // diagonal node
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);
1033       // internal nodes
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);
1043       }
1044     }
1045     for(i=1; i<=UVtmp.Length() && UVL.Length()<nbv-nnn-1; i++) {
1046       UVL.Append(UVtmp.Value(i));
1047     }
1048     //cout<<"Dump NodesL:"<<endl;
1049     //for(i=1; i<=dl+1; i++) {
1050     //  cout<<"i="<<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()<<")";
1053     //  }
1054     //  cout<<endl;
1055     //}
1056     // create faces
1057     for(i=1; i<=dl; i++) {
1058       for(j=1; j<nl; j++) {
1059         if(WisF) {
1060           SMDS_MeshFace* F =
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);
1064         }
1065         else {
1066           SMDS_MeshFace* F =
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);
1070         }
1071       }
1072     }
1073   }
1074   else {
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 ));
1078     }
1079   }
1080
1081   // step2: create faces for right domain
1082   StdMeshers_Array2OfNode NodesR(1,dr+1,1,nr);
1083   // add right nodes
1084   for(j=1; j<=nr; j++) 
1085     NodesR.SetValue(1,j,uv_er[nr-j].node);
1086   if(dr>0) {
1087     // add top nodes
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);
1094       double x1 = x0;
1095       // diagonal node
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);
1104       // internal nodes
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);
1114       }
1115     }
1116     for(i=1; i<=UVtmp.Length() && UVR.Length()<nbv-nnn-1; i++) {
1117       UVR.Append(UVtmp.Value(i));
1118     }
1119     // create faces
1120     for(i=1; i<=dr; i++) {
1121       for(j=1; j<nr; j++) {
1122         if(WisF) {
1123           SMDS_MeshFace* F =
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);
1127         }
1128         else {
1129           SMDS_MeshFace* F =
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);
1133         }
1134       }
1135     }
1136   }
1137   else {
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 ));
1141     }
1142   }
1143
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));
1154   for(i=1; i<nr; i++)
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)
1160   for(i=2; i<nb; i++)
1161     NodesC.SetValue(i,1,uv_eb[i-1].node);
1162
1163   // create and add needed nodes
1164   // add linear layers
1165   for(i=2; i<nb; i++) {
1166     double x0 = npt.Value(dl+i);
1167     double x1 = x0;
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);
1176     }
1177   }
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()<<")";
1183   //}
1184   //cout<<endl;
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);
1195     }
1196   }
1197   // create faces
1198   for(i=1; i<nb; i++) {
1199     for(j=1; j<nbv; j++) {
1200       if(WisF) {
1201         SMDS_MeshFace* F =
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);
1205       }
1206       else {
1207         SMDS_MeshFace* F =
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);
1211       }
1212     }
1213   }
1214
1215   bool isOk = true;
1216   return isOk;
1217 }
1218