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 #include "SMESH_Comment.hxx"
  40
  41 #include "SMDS_MeshElement.hxx"
  42 #include "SMDS_MeshNode.hxx"
  43 #include "SMDS_EdgePosition.hxx"
  44 #include "SMDS_FacePosition.hxx"
  45
  46 #include <BRepAdaptor_Curve.hxx>
  47 #include <BRep_Tool.hxx>
  48 #include <BRepLProp.hxx>
  49 #include <BRepTools.hxx>
  50 #include <BRepTools_WireExplorer.hxx>
  51 #include <Geom_Surface.hxx>
  52 #include <Geom_Curve.hxx>
  53 #include <Geom2d_Curve.hxx>
  54 #include <GeomAdaptor_Curve.hxx>
  55 #include <GCPnts_UniformAbscissa.hxx>
  56 #include <TopExp.hxx>
  57 #include <Precision.hxx>
  58 #include <gp_Pnt2d.hxx>
  59 #include <TColStd_ListIteratorOfListOfInteger.hxx>
  60 #include <TColStd_SequenceOfReal.hxx>
  61 #include <TColgp_SequenceOfXY.hxx>
  62 #include <NCollection_DefineArray2.hxx>
  63
  64 #include "utilities.h"
  65 #include "Utils_ExceptHandlers.hxx"
  66
  67 #ifndef StdMeshers_Array2OfNode_HeaderFile
  68 #define StdMeshers_Array2OfNode_HeaderFile
  69 typedef const SMDS_MeshNode* SMDS_MeshNodePtr;
  70 DEFINE_BASECOLLECTION (StdMeshers_BaseCollectionNodePtr, SMDS_MeshNodePtr)
  71 DEFINE_ARRAY2(StdMeshers_Array2OfNode,
  72               StdMeshers_BaseCollectionNodePtr, SMDS_MeshNodePtr)
  73 #endif
  74
  75 using namespace std;
  76
  77 typedef gp_XY gp_UV;
  78 typedef SMESH_Comment TComm;
  79
  80 //=============================================================================
  81 /*!
  82  *
  83  */
  84 //=============================================================================
  85
  86 StdMeshers_Quadrangle_2D::StdMeshers_Quadrangle_2D (int hypId, int studyId, SMESH_Gen* gen)
  87      : SMESH_2D_Algo(hypId, studyId, gen)
  88 {
  89   MESSAGE("StdMeshers_Quadrangle_2D::StdMeshers_Quadrangle_2D");
  90   _name = "Quadrangle_2D";
  91   _shapeType = (1 << TopAbs_FACE);
  92   _compatibleHypothesis.push_back("QuadranglePreference");
  93   myTool = 0;
  94 }
  95
  96 //=============================================================================
  97 /*!
  98  *
  99  */
 100 //=============================================================================
 101
 102 StdMeshers_Quadrangle_2D::~StdMeshers_Quadrangle_2D()
 103 {
 104   MESSAGE("StdMeshers_Quadrangle_2D::~StdMeshers_Quadrangle_2D");
 105 }
 106
 107 //=============================================================================
 108 /*!
 109  *
 110  */
 111 //=============================================================================
 112
 113 bool StdMeshers_Quadrangle_2D::CheckHypothesis
 114                          (SMESH_Mesh&                          aMesh,
 115                           const TopoDS_Shape&                  aShape,
 116                           SMESH_Hypothesis::Hypothesis_Status& aStatus)
 117 {
 118   bool isOk = true;
 119   aStatus = SMESH_Hypothesis::HYP_OK;
 120
 121   // there is only one compatible Hypothesis so far
 122   const list <const SMESHDS_Hypothesis * >&hyps = GetUsedHypothesis(aMesh, aShape);
 123   myQuadranglePreference = hyps.size() > 0;
 124
 125   return isOk;
 126 }
 127
 128 //=============================================================================
 129 /*!
 130  *
 131  */
 132 //=============================================================================
 133
 134 bool StdMeshers_Quadrangle_2D::Compute (SMESH_Mesh& aMesh,
 135                                         const TopoDS_Shape& aShape) throw (SALOME_Exception)
 136 {
 137   Unexpect aCatch(SalomeException);
 138
 139   SMESHDS_Mesh * meshDS = aMesh.GetMeshDS();
 140   aMesh.GetSubMesh(aShape);
 141
 142   SMESH_MesherHelper helper(aMesh);
 143   myTool = &helper;
 144
 145   _quadraticMesh = myTool->IsQuadraticSubMesh(aShape);
 146
 147   FaceQuadStruct *quad = CheckNbEdges( aMesh, aShape );
 148   std::auto_ptr<FaceQuadStruct> quadDeleter( quad ); // to delete quad at exit from Compute()
 149   if (!quad)
 150     return false;
 151
 152   if(myQuadranglePreference) {
 153     int n1 = quad->side[0]->NbPoints();
 154     int n2 = quad->side[1]->NbPoints();
 155     int n3 = quad->side[2]->NbPoints();
 156     int n4 = quad->side[3]->NbPoints();
 157     int nfull = n1+n2+n3+n4;
 158     int ntmp = nfull/2;
 159     ntmp = ntmp*2;
 160     if( nfull==ntmp && ( (n1!=n3) || (n2!=n4) ) ) {
 161       // special path for using only quandrangle faces
 162       bool ok = ComputeQuadPref(aMesh, aShape, quad);
 163       return ok;
 164     }
 165   }
 166
 167   // set normalized grid on unit square in parametric domain
 168
 169   if (!SetNormalizedGrid(aMesh, aShape, quad))
 170     return false;
 171
 172   // --- compute 3D values on points, store points & quadrangles
 173
 174   int nbdown  = quad->side[0]->NbPoints();
 175   int nbup    = quad->side[2]->NbPoints();
 176
 177   int nbright = quad->side[1]->NbPoints();
 178   int nbleft  = quad->side[3]->NbPoints();
 179
 180   int nbhoriz  = Min(nbdown, nbup);
 181   int nbvertic = Min(nbright, nbleft);
 182
 183   const TopoDS_Face& F = TopoDS::Face(aShape);
 184   Handle(Geom_Surface) S = BRep_Tool::Surface(F);
 185
 186   // internal mesh nodes
 187   int i, j, geomFaceID = meshDS->ShapeToIndex( F );
 188   for (i = 1; i < nbhoriz - 1; i++) {
 189     for (j = 1; j < nbvertic - 1; j++) {
 190       int ij = j * nbhoriz + i;
 191       double u = quad->uv_grid[ij].u;
 192       double v = quad->uv_grid[ij].v;
 193       gp_Pnt P = S->Value(u, v);
 194       SMDS_MeshNode * node = meshDS->AddNode(P.X(), P.Y(), P.Z());
 195       meshDS->SetNodeOnFace(node, geomFaceID, u, v);
 196       quad->uv_grid[ij].node = node;
 197     }
 198   }
 199
 200   // mesh faces
 201
 202   //             [2]
 203   //      --.--.--.--.--.--  nbvertic
 204   //     |                 | ^
 205   //     |                 | ^
 206   // [3] |                 | ^ j  [1]
 207   //     |                 | ^
 208   //     |                 | ^
 209   //      ---.----.----.---  0
 210   //     0 > > > > > > > > nbhoriz
 211   //              i
 212   //             [0]
 213
 214   i = 0;
 215   int ilow = 0;
 216   int iup = nbhoriz - 1;
 217   if (quad->isEdgeOut[3]) { ilow++; } else { if (quad->isEdgeOut[1]) iup--; }
 218
 219   int jlow = 0;
 220   int jup = nbvertic - 1;
 221   if (quad->isEdgeOut[0]) { jlow++; } else { if (quad->isEdgeOut[2]) jup--; }
 222
 223   // regular quadrangles
 224   for (i = ilow; i < iup; i++) {
 225     for (j = jlow; j < jup; j++) {
 226       const SMDS_MeshNode *a, *b, *c, *d;
 227       a = quad->uv_grid[j * nbhoriz + i].node;
 228       b = quad->uv_grid[j * nbhoriz + i + 1].node;
 229       c = quad->uv_grid[(j + 1) * nbhoriz + i + 1].node;
 230       d = quad->uv_grid[(j + 1) * nbhoriz + i].node;
 231       SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
 232       meshDS->SetMeshElementOnShape(face, geomFaceID);
 233     }
 234   }
 235
 236   const vector<UVPtStruct>& uv_e0 = quad->side[0]->GetUVPtStruct(true,0 );
 237   const vector<UVPtStruct>& uv_e1 = quad->side[1]->GetUVPtStruct(false,1);
 238   const vector<UVPtStruct>& uv_e2 = quad->side[2]->GetUVPtStruct(true,1 );
 239   const vector<UVPtStruct>& uv_e3 = quad->side[3]->GetUVPtStruct(false,0);
 240
 241   double eps = Precision::Confusion();
 242
 243   // Boundary quadrangles
 244
 245   if (quad->isEdgeOut[0]) {
 246     // Down edge is out
 247     //
 248     // |___|___|___|___|___|___|
 249     // |   |   |   |   |   |   |
 250     // |___|___|___|___|___|___|
 251     // |   |   |   |   |   |   |
 252     // |___|___|___|___|___|___| __ first row of the regular grid
 253     // .  .  .  .  .  .  .  .  . __ down edge nodes
 254     //
 255     // >->->->->->->->->->->->-> -- direction of processing
 256
 257     int g = 0; // number of last processed node in the regular grid
 258
 259     // number of last node of the down edge to be processed
 260     int stop = nbdown - 1;
 261     // if right edge is out, we will stop at a node, previous to the last one
 262     if (quad->isEdgeOut[1]) stop--;
 263
 264     // for each node of the down edge find nearest node
 265     // in the first row of the regular grid and link them
 266     for (i = 0; i < stop; i++) {
 267       const SMDS_MeshNode *a, *b, *c, *d;
 268       a = uv_e0[i].node;
 269       b = uv_e0[i + 1].node;
 270       gp_Pnt pb (b->X(), b->Y(), b->Z());
 271
 272       // find node c in the regular grid, which will be linked with node b
 273       int near = g;
 274       if (i == stop - 1) {
 275         // right bound reached, link with the rightmost node
 276         near = iup;
 277         c = quad->uv_grid[nbhoriz + iup].node;
 278       }
 279       else {
 280         // find in the grid node c, nearest to the b
 281         double mind = RealLast();
 282         for (int k = g; k <= iup; k++) {
 283
 284           const SMDS_MeshNode *nk;
 285           if (k < ilow) // this can be, if left edge is out
 286             nk = uv_e3[1].node; // get node from the left edge
 287           else
 288             nk = quad->uv_grid[nbhoriz + k].node; // get one of middle nodes
 289
 290           gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
 291           double dist = pb.Distance(pnk);
 292           if (dist < mind - eps) {
 293             c = nk;
 294             near = k;
 295             mind = dist;
 296           } else {
 297             break;
 298           }
 299         }
 300       }
 301
 302       if (near == g) { // make triangle
 303         //SMDS_MeshFace* face = meshDS->AddFace(a, b, c);
 304         SMDS_MeshFace* face = myTool->AddFace(a, b, c);
 305         meshDS->SetMeshElementOnShape(face, geomFaceID);
 306       }
 307       else { // make quadrangle
 308         if (near - 1 < ilow)
 309           d = uv_e3[1].node;
 310         else
 311           d = quad->uv_grid[nbhoriz + near - 1].node;
 312         //SMDS_MeshFace* face = meshDS->AddFace(a, b, c, d);
 313         SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
 314         meshDS->SetMeshElementOnShape(face, geomFaceID);
 315
 316         // if node d is not at position g - make additional triangles
 317         if (near - 1 > g) {
 318           for (int k = near - 1; k > g; k--) {
 319             c = quad->uv_grid[nbhoriz + k].node;
 320             if (k - 1 < ilow)
 321               d = uv_e3[1].node;
 322             else
 323               d = quad->uv_grid[nbhoriz + k - 1].node;
 324             //SMDS_MeshFace* face = meshDS->AddFace(a, c, d);
 325             SMDS_MeshFace* face = myTool->AddFace(a, c, d);
 326             meshDS->SetMeshElementOnShape(face, geomFaceID);
 327           }
 328         }
 329         g = near;
 330       }
 331     }
 332   } else {
 333     if (quad->isEdgeOut[2]) {
 334       // Up edge is out
 335       //
 336       // <-<-<-<-<-<-<-<-<-<-<-<-< -- direction of processing
 337       //
 338       // .  .  .  .  .  .  .  .  . __ up edge nodes
 339       //  ___ ___ ___ ___ ___ ___  __ first row of the regular grid
 340       // |   |   |   |   |   |   |
 341       // |___|___|___|___|___|___|
 342       // |   |   |   |   |   |   |
 343       // |___|___|___|___|___|___|
 344       // |   |   |   |   |   |   |
 345
 346       int g = nbhoriz - 1; // last processed node in the regular grid
 347
 348       int stop = 0;
 349       // if left edge is out, we will stop at a second node
 350       if (quad->isEdgeOut[3]) stop++;
 351
 352       // for each node of the up edge find nearest node
 353       // in the first row of the regular grid and link them
 354       for (i = nbup - 1; i > stop; i--) {
 355         const SMDS_MeshNode *a, *b, *c, *d;
 356         a = uv_e2[i].node;
 357         b = uv_e2[i - 1].node;
 358         gp_Pnt pb (b->X(), b->Y(), b->Z());
 359
 360         // find node c in the grid, which will be linked with node b
 361         int near = g;
 362         if (i == stop + 1) { // left bound reached, link with the leftmost node
 363           c = quad->uv_grid[nbhoriz*(nbvertic - 2) + ilow].node;
 364           near = ilow;
 365         } else {
 366           // find node c in the grid, nearest to the b
 367           double mind = RealLast();
 368           for (int k = g; k >= ilow; k--) {
 369             const SMDS_MeshNode *nk;
 370             if (k > iup)
 371               nk = uv_e1[nbright - 2].node;
 372             else
 373               nk = quad->uv_grid[nbhoriz*(nbvertic - 2) + k].node;
 374             gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
 375             double dist = pb.Distance(pnk);
 376             if (dist < mind - eps) {
 377               c = nk;
 378               near = k;
 379               mind = dist;
 380             } else {
 381               break;
 382             }
 383           }
 384         }
 385
 386         if (near == g) { // make triangle
 387           //SMDS_MeshFace* face = meshDS->AddFace(a, b, c);
 388           SMDS_MeshFace* face = myTool->AddFace(a, b, c);
 389           meshDS->SetMeshElementOnShape(face, geomFaceID);
 390         }
 391         else { // make quadrangle
 392           if (near + 1 > iup)
 393             d = uv_e1[nbright - 2].node;
 394           else
 395             d = quad->uv_grid[nbhoriz*(nbvertic - 2) + near + 1].node;
 396           //SMDS_MeshFace* face = meshDS->AddFace(a, b, c, d);
 397           SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
 398           meshDS->SetMeshElementOnShape(face, geomFaceID);
 399
 400           if (near + 1 < g) { // if d not is at g - make additional triangles
 401             for (int k = near + 1; k < g; k++) {
 402               c = quad->uv_grid[nbhoriz*(nbvertic - 2) + k].node;
 403               if (k + 1 > iup)
 404                 d = uv_e1[nbright - 2].node;
 405               else
 406                 d = quad->uv_grid[nbhoriz*(nbvertic - 2) + k + 1].node;
 407               //SMDS_MeshFace* face = meshDS->AddFace(a, c, d);
 408               SMDS_MeshFace* face = myTool->AddFace(a, c, d);
 409               meshDS->SetMeshElementOnShape(face, geomFaceID);
 410             }
 411           }
 412           g = near;
 413         }
 414       }
 415     }
 416   }
 417
 418   // right or left boundary quadrangles
 419   if (quad->isEdgeOut[1]) {
 420 //    MESSAGE("right edge is out");
 421     int g = 0; // last processed node in the grid
 422     int stop = nbright - 1;
 423     if (quad->isEdgeOut[2]) stop--;
 424     for (i = 0; i < stop; i++) {
 425       const SMDS_MeshNode *a, *b, *c, *d;
 426       a = uv_e1[i].node;
 427       b = uv_e1[i + 1].node;
 428       gp_Pnt pb (b->X(), b->Y(), b->Z());
 429
 430       // find node c in the grid, nearest to the b
 431       int near = g;
 432       if (i == stop - 1) { // up bondary reached
 433         c = quad->uv_grid[nbhoriz*(jup + 1) - 2].node;
 434         near = jup;
 435       } else {
 436         double mind = RealLast();
 437         for (int k = g; k <= jup; k++) {
 438           const SMDS_MeshNode *nk;
 439           if (k < jlow)
 440             nk = uv_e0[nbdown - 2].node;
 441           else
 442             nk = quad->uv_grid[nbhoriz*(k + 1) - 2].node;
 443           gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
 444           double dist = pb.Distance(pnk);
 445           if (dist < mind - eps) {
 446             c = nk;
 447             near = k;
 448             mind = dist;
 449           } else {
 450             break;
 451           }
 452         }
 453       }
 454
 455       if (near == g) { // make triangle
 456         //SMDS_MeshFace* face = meshDS->AddFace(a, b, c);
 457         SMDS_MeshFace* face = myTool->AddFace(a, b, c);
 458         meshDS->SetMeshElementOnShape(face, geomFaceID);
 459       }
 460       else { // make quadrangle
 461         if (near - 1 < jlow)
 462           d = uv_e0[nbdown - 2].node;
 463         else
 464           d = quad->uv_grid[nbhoriz*near - 2].node;
 465         //SMDS_MeshFace* face = meshDS->AddFace(a, b, c, d);
 466         SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
 467         meshDS->SetMeshElementOnShape(face, geomFaceID);
 468
 469         if (near - 1 > g) { // if d not is at g - make additional triangles
 470           for (int k = near - 1; k > g; k--) {
 471             c = quad->uv_grid[nbhoriz*(k + 1) - 2].node;
 472             if (k - 1 < jlow)
 473               d = uv_e0[nbdown - 2].node;
 474             else
 475               d = quad->uv_grid[nbhoriz*k - 2].node;
 476             //SMDS_MeshFace* face = meshDS->AddFace(a, c, d);
 477             SMDS_MeshFace* face = myTool->AddFace(a, c, d);
 478             meshDS->SetMeshElementOnShape(face, geomFaceID);
 479           }
 480         }
 481         g = near;
 482       }
 483     }
 484   } else {
 485     if (quad->isEdgeOut[3]) {
 486 //      MESSAGE("left edge is out");
 487       int g = nbvertic - 1; // last processed node in the grid
 488       int stop = 0;
 489       if (quad->isEdgeOut[0]) stop++;
 490       for (i = nbleft - 1; i > stop; i--) {
 491         const SMDS_MeshNode *a, *b, *c, *d;
 492         a = uv_e3[i].node;
 493         b = uv_e3[i - 1].node;
 494         gp_Pnt pb (b->X(), b->Y(), b->Z());
 495
 496         // find node c in the grid, nearest to the b
 497         int near = g;
 498         if (i == stop + 1) { // down bondary reached
 499           c = quad->uv_grid[nbhoriz*jlow + 1].node;
 500           near = jlow;
 501         } else {
 502           double mind = RealLast();
 503           for (int k = g; k >= jlow; k--) {
 504             const SMDS_MeshNode *nk;
 505             if (k > jup)
 506               nk = uv_e2[1].node;
 507             else
 508               nk = quad->uv_grid[nbhoriz*k + 1].node;
 509             gp_Pnt pnk (nk->X(), nk->Y(), nk->Z());
 510             double dist = pb.Distance(pnk);
 511             if (dist < mind - eps) {
 512               c = nk;
 513               near = k;
 514               mind = dist;
 515             } else {
 516               break;
 517             }
 518           }
 519         }
 520
 521         if (near == g) { // make triangle
 522           //SMDS_MeshFace* face = meshDS->AddFace(a, b, c);
 523           SMDS_MeshFace* face = myTool->AddFace(a, b, c);
 524           meshDS->SetMeshElementOnShape(face, geomFaceID);
 525         }
 526         else { // make quadrangle
 527           if (near + 1 > jup)
 528             d = uv_e2[1].node;
 529           else
 530             d = quad->uv_grid[nbhoriz*(near + 1) + 1].node;
 531           //SMDS_MeshFace* face = meshDS->AddFace(a, b, c, d);
 532           SMDS_MeshFace* face = myTool->AddFace(a, b, c, d);
 533           meshDS->SetMeshElementOnShape(face, geomFaceID);
 534
 535           if (near + 1 < g) { // if d not is at g - make additional triangles
 536             for (int k = near + 1; k < g; k++) {
 537               c = quad->uv_grid[nbhoriz*k + 1].node;
 538               if (k + 1 > jup)
 539                 d = uv_e2[1].node;
 540               else
 541                 d = quad->uv_grid[nbhoriz*(k + 1) + 1].node;
 542               //SMDS_MeshFace* face = meshDS->AddFace(a, c, d);
 543               SMDS_MeshFace* face = myTool->AddFace(a, c, d);
 544               meshDS->SetMeshElementOnShape(face, geomFaceID);
 545             }
 546           }
 547           g = near;
 548         }
 549       }
 550     }
 551   }
 552
 553   bool isOk = true;
 554   return isOk;
 555 }
 556
 557 //=============================================================================
 558 /*!
 559  *
 560  */
 561 //=============================================================================
 562
 563 FaceQuadStruct* StdMeshers_Quadrangle_2D::CheckNbEdges(SMESH_Mesh &         aMesh,
 564                                                        const TopoDS_Shape & aShape)
 565      throw(SALOME_Exception)
 566 {
 567   Unexpect aCatch(SalomeException);
 568
 569   const TopoDS_Face & F = TopoDS::Face(aShape);
 570   const bool ignoreMediumNodes = _quadraticMesh;
 571
 572   // verify 1 wire only, with 4 edges
 573   TopoDS_Vertex V;
 574   list< TopoDS_Edge > edges;
 575   list< int > nbEdgesInWire;
 576   int nbWire = SMESH_Block::GetOrderedEdges (F, V, edges, nbEdgesInWire);
 577   if (nbWire != 1) {
 578     error(COMPERR_BAD_SHAPE, TComm("Wrong number of wires: ") << nbWire);
 579     return 0;
 580   }
 581   FaceQuadStruct* quad = new FaceQuadStruct;
 582   quad->uv_grid = 0;
 583   quad->side.reserve(nbEdgesInWire.front());
 584
 585   int nbSides = 0;
 586   list< TopoDS_Edge >::iterator edgeIt = edges.begin();
 587   if ( nbEdgesInWire.front() == 4 ) { // exactly 4 edges
 588     for ( ; edgeIt != edges.end(); ++edgeIt, nbSides++ )
 589       quad->side.push_back( new StdMeshers_FaceSide(F, *edgeIt, &aMesh,
 590                                                     nbSides<TOP_SIDE, ignoreMediumNodes));
 591   }
 592   else if ( nbEdgesInWire.front() > 4 ) { // more than 4 edges - try to unite some
 593     list< TopoDS_Edge > sideEdges;
 594     while ( !edges.empty()) {
 595       sideEdges.clear();
 596       sideEdges.splice( sideEdges.end(), edges, edges.begin()); // edges.front() -> sideEdges.end()
 597       bool sameSide = true;
 598       while ( !edges.empty() && sameSide ) {
 599         GeomAbs_Shape cont = SMESH_Algo::Continuity( sideEdges.back(), edges.front() );
 600         sameSide = ( cont >= GeomAbs_G1 );
 601         if ( sameSide )
 602           sideEdges.splice( sideEdges.end(), edges, edges.begin());
 603       }
 604       if ( nbSides == 0 ) { // go backward from the first edge
 605         sameSide = true;
 606         while ( !edges.empty() && sameSide ) {
 607           GeomAbs_Shape cont = SMESH_Algo::Continuity( sideEdges.front(), edges.back() );
 608           sameSide = ( cont >= GeomAbs_G1 );
 609           if ( sameSide )
 610             sideEdges.splice( sideEdges.begin(), edges, --edges.end());
 611         }
 612       }
 613       quad->side.push_back( new StdMeshers_FaceSide(F, sideEdges, &aMesh,
 614                                                     nbSides<TOP_SIDE, ignoreMediumNodes));
 615       ++nbSides;
 616     }
 617   }
 618   if (nbSides != 4) {
 619 #ifdef _DEBUG_
 620     cout << endl << "StdMeshers_Quadrangle_2D. Edge IDs of " << nbSides << " sides:";
 621     for ( int i = 0; i < nbSides; ++i ) {
 622       cout << " ( ";
 623       for ( int e = 0; e < quad->side[i]->NbEdges(); ++e )
 624         cout << myTool->GetMeshDS()->ShapeToIndex( quad->side[i]->Edge( e )) << " ";
 625       cout << ")";
 626     }
 627     cout << endl;
 628 #endif
 629     if ( !nbSides )
 630       nbSides = nbEdgesInWire.front();
 631     error(COMPERR_BAD_SHAPE, TComm("Face must have 4 sides but not ") << nbSides);
 632     delete quad;
 633     quad = 0;
 634   }
 635
 636   return quad;
 637 }
 638
 639 //=============================================================================
 640 /*!
 641  *  CheckAnd2Dcompute
 642  */
 643 //=============================================================================
 644
 645 FaceQuadStruct *StdMeshers_Quadrangle_2D::CheckAnd2Dcompute
 646                            (SMESH_Mesh &         aMesh,
 647                             const TopoDS_Shape & aShape,
 648                             const bool           CreateQuadratic) throw(SALOME_Exception)
 649 {
 650   Unexpect aCatch(SalomeException);
 651
 652   _quadraticMesh = CreateQuadratic;
 653
 654   FaceQuadStruct *quad = CheckNbEdges(aMesh, aShape);
 655
 656   if(!quad) return 0;
 657
 658   // set normalized grid on unit square in parametric domain
 659   SetNormalizedGrid(aMesh, aShape, quad);
 660
 661   return quad;
 662 }
 663
 664 //=============================================================================
 665 /*!
 666  *
 667  */
 668 //=============================================================================
 669
 670 faceQuadStruct::~faceQuadStruct()
 671 {
 672   for (int i = 0; i < side.size(); i++) {
 673     if (side[i])     delete side[i];
 674   }
 675   if (uv_grid)       delete [] uv_grid;
 676 }
 677
 678 namespace {
 679   inline const vector<UVPtStruct>& GetUVPtStructIn(FaceQuadStruct* quad, int i, int nbSeg)
 680   {
 681     bool   isXConst   = ( i == BOTTOM_SIDE || i == TOP_SIDE );
 682     double constValue = ( i == BOTTOM_SIDE || i == LEFT_SIDE ) ? 0 : 1;
 683     return
 684       quad->isEdgeOut[i] ?
 685       quad->side[i]->SimulateUVPtStruct(nbSeg,isXConst,constValue) :
 686       quad->side[i]->GetUVPtStruct(isXConst,constValue);
 687   }
 688 }
 689
 690 //=============================================================================
 691 /*!
 692  *
 693  */
 694 //=============================================================================
 695
 696 bool StdMeshers_Quadrangle_2D::SetNormalizedGrid (SMESH_Mesh & aMesh,
 697                                                   const TopoDS_Shape& aShape,
 698                                                   FaceQuadStruct* & quad) throw (SALOME_Exception)
 699 {
 700   Unexpect aCatch(SalomeException);
 701   // Algorithme décrit dans "Génération automatique de maillages"
 702   // P.L. GEORGE, MASSON, § 6.4.1 p. 84-85
 703   // traitement dans le domaine paramétrique 2d u,v
 704   // transport - projection sur le carré unité
 705
 706 //  MESSAGE("StdMeshers_Quadrangle_2D::SetNormalizedGrid");
 707 //  const TopoDS_Face& F = TopoDS::Face(aShape);
 708
 709   // 1 --- find orientation of the 4 edges, by test on extrema
 710
 711   //      max             min                    0     x1     1
 712   //     |<----north-2-------^                a3 -------------> a2
 713   //     |                   |                   ^1          1^
 714   //    west-3            east-1 =right          |            |
 715   //     |                   |         ==>       |            |
 716   //  y0 |                   | y1                |            |
 717   //     |                   |                   |0          0|
 718   //     v----south-0-------->                a0 -------------> a1
 719   //      min             max                    0     x0     1
 720   //             =down
 721   //
 722
 723   // 3 --- 2D normalized values on unit square [0..1][0..1]
 724
 725   int nbhoriz  = Min(quad->side[0]->NbPoints(), quad->side[2]->NbPoints());
 726   int nbvertic = Min(quad->side[1]->NbPoints(), quad->side[3]->NbPoints());
 727
 728   quad->isEdgeOut[0] = (quad->side[0]->NbPoints() > quad->side[2]->NbPoints());
 729   quad->isEdgeOut[1] = (quad->side[1]->NbPoints() > quad->side[3]->NbPoints());
 730   quad->isEdgeOut[2] = (quad->side[2]->NbPoints() > quad->side[0]->NbPoints());
 731   quad->isEdgeOut[3] = (quad->side[3]->NbPoints() > quad->side[1]->NbPoints());
 732
 733   UVPtStruct *uv_grid = quad->uv_grid = new UVPtStruct[nbvertic * nbhoriz];
 734
 735   const vector<UVPtStruct>& uv_e0 = GetUVPtStructIn( quad, 0, nbhoriz - 1 );
 736   const vector<UVPtStruct>& uv_e1 = GetUVPtStructIn( quad, 1, nbvertic - 1 );
 737   const vector<UVPtStruct>& uv_e2 = GetUVPtStructIn( quad, 2, nbhoriz - 1 );
 738   const vector<UVPtStruct>& uv_e3 = GetUVPtStructIn( quad, 3, nbvertic - 1 );
 739
 740   if ( uv_e0.empty() || uv_e1.empty() || uv_e2.empty() || uv_e3.empty() )
 741     return error(dfltErr(), "Can't find nodes on sides");
 742
 743   // nodes Id on "in" edges
 744   if (! quad->isEdgeOut[0]) {
 745     int j = 0;
 746     for (int i = 0; i < nbhoriz; i++) { // down
 747       int ij = j * nbhoriz + i;
 748       uv_grid[ij].node = uv_e0[i].node;
 749     }
 750   }
 751   if (! quad->isEdgeOut[1]) {
 752     int i = nbhoriz - 1;
 753     for (int j = 0; j < nbvertic; j++) { // right
 754       int ij = j * nbhoriz + i;
 755       uv_grid[ij].node = uv_e1[j].node;
 756     }
 757   }
 758   if (! quad->isEdgeOut[2]) {
 759     int j = nbvertic - 1;
 760     for (int i = 0; i < nbhoriz; i++) { // up
 761       int ij = j * nbhoriz + i;
 762       uv_grid[ij].node = uv_e2[i].node;
 763     }
 764   }
 765   if (! quad->isEdgeOut[3]) {
 766     int i = 0;
 767     for (int j = 0; j < nbvertic; j++) { // left
 768       int ij = j * nbhoriz + i;
 769       uv_grid[ij].node = uv_e3[j].node;
 770     }
 771   }
 772
 773   // normalized 2d values on grid
 774   for (int i = 0; i < nbhoriz; i++)
 775   {
 776     for (int j = 0; j < nbvertic; j++)
 777     {
 778       int ij = j * nbhoriz + i;
 779       // --- droite i cste : x = x0 + y(x1-x0)
 780       double x0 = uv_e0[i].normParam;   // bas - sud
 781       double x1 = uv_e2[i].normParam;   // haut - nord
 782       // --- droite j cste : y = y0 + x(y1-y0)
 783       double y0 = uv_e3[j].normParam;   // gauche-ouest
 784       double y1 = uv_e1[j].normParam;   // droite - est
 785       // --- intersection : x=x0+(y0+x(y1-y0))(x1-x0)
 786       double x = (x0 + y0 * (x1 - x0)) / (1 - (y1 - y0) * (x1 - x0));
 787       double y = y0 + x * (y1 - y0);
 788       uv_grid[ij].x = x;
 789       uv_grid[ij].y = y;
 790       //MESSAGE("-xy-01 "<<x0<<" "<<x1<<" "<<y0<<" "<<y1);
 791       //MESSAGE("-xy-norm "<<i<<" "<<j<<" "<<x<<" "<<y);
 792     }
 793   }
 794
 795   // 4 --- projection on 2d domain (u,v)
 796   gp_UV a0( uv_e0.front().u, uv_e0.front().v );
 797   gp_UV a1( uv_e0.back().u,  uv_e0.back().v );
 798   gp_UV a2( uv_e2.back().u,  uv_e2.back().v );
 799   gp_UV a3( uv_e2.front().u, uv_e2.front().v );
 800
 801   for (int i = 0; i < nbhoriz; i++)
 802   {
 803     for (int j = 0; j < nbvertic; j++)
 804     {
 805       int ij = j * nbhoriz + i;
 806       double x = uv_grid[ij].x;
 807       double y = uv_grid[ij].y;
 808       double param_0 = uv_e0[0].normParam + x * (uv_e0.back().normParam - uv_e0[0].normParam); // sud
 809       double param_2 = uv_e2[0].normParam + x * (uv_e2.back().normParam - uv_e2[0].normParam); // nord
 810       double param_1 = uv_e1[0].normParam + y * (uv_e1.back().normParam - uv_e1[0].normParam); // est
 811       double param_3 = uv_e3[0].normParam + y * (uv_e3.back().normParam - uv_e3[0].normParam); // ouest
 812
 813       //MESSAGE("params "<<param_0<<" "<<param_1<<" "<<param_2<<" "<<param_3);
 814       gp_UV p0 = quad->side[0]->Value2d(param_0).XY();
 815       gp_UV p1 = quad->side[1]->Value2d(param_1).XY();
 816       gp_UV p2 = quad->side[2]->Value2d(param_2).XY();
 817       gp_UV p3 = quad->side[3]->Value2d(param_3).XY();
 818
 819       gp_UV uv = (1 - y) * p0 + x * p1 + y * p2 + (1 - x) * p3;
 820       uv -= (1 - x) * (1 - y) * a0 + x * (1 - y) * a1 + x * y * a2 + (1 - x) * y * a3;
 821
 822       uv_grid[ij].u = uv.X();
 823       uv_grid[ij].v = uv.Y();
 824     }
 825   }
 826   return true;
 827 }
 828
 829 //=======================================================================
 830 //function : ShiftQuad
 831 //purpose  : auxilary function for ComputeQuadPref
 832 //=======================================================================
 833
 834 static void ShiftQuad(FaceQuadStruct* quad, const int num, bool)
 835 {
 836   StdMeshers_FaceSide* side[4] = { quad->side[0], quad->side[1], quad->side[2], quad->side[3] };
 837   for (int i = BOTTOM_SIDE; i < NB_SIDES; ++i ) {
 838     int id = ( i + num ) % NB_SIDES;
 839     bool wasForward = ( i < TOP_SIDE );
 840     bool newForward = ( id < TOP_SIDE );
 841     if ( wasForward != newForward )
 842       side[ i ]->Reverse();
 843     quad->side[ id ] = side[ i ];
 844   }
 845 }
 846
 847 //=======================================================================
 848 //function : CalcUV
 849 //purpose  : auxilary function for ComputeQuadPref
 850 //=======================================================================
 851
 852 static gp_UV CalcUV(double x0, double x1, double y0, double y1,
 853                     FaceQuadStruct* quad,
 854                     const gp_UV& a0, const gp_UV& a1,
 855                     const gp_UV& a2, const gp_UV& a3)
 856 {
 857   const vector<UVPtStruct>& uv_eb = quad->side[0]->GetUVPtStruct(true,0 );
 858   const vector<UVPtStruct>& uv_er = quad->side[1]->GetUVPtStruct(false,1);
 859   const vector<UVPtStruct>& uv_et = quad->side[2]->GetUVPtStruct(true,1 );
 860   const vector<UVPtStruct>& uv_el = quad->side[3]->GetUVPtStruct(false,0);
 861
 862   double x = (x0 + y0 * (x1 - x0)) / (1 - (y1 - y0) * (x1 - x0));
 863   double y = y0 + x * (y1 - y0);
 864
 865   double param_b = uv_eb[0].normParam + x * (uv_eb.back().normParam - uv_eb[0].normParam);
 866   double param_t = uv_et[0].normParam + x * (uv_et.back().normParam - uv_et[0].normParam);
 867   double param_r = uv_er[0].normParam + y * (uv_er.back().normParam - uv_er[0].normParam);
 868   double param_l = uv_el[0].normParam + y * (uv_el.back().normParam - uv_el[0].normParam);
 869
 870   gp_UV p0 = quad->side[BOTTOM_SIDE]->Value2d(param_b).XY();
 871   gp_UV p1 = quad->side[RIGHT_SIDE ]->Value2d(param_r).XY();
 872   gp_UV p2 = quad->side[TOP_SIDE   ]->Value2d(param_t).XY();
 873   gp_UV p3 = quad->side[LEFT_SIDE  ]->Value2d(param_l).XY();
 874
 875   gp_UV uv = p0 * (1 - y) + p1 * x + p2 * y + p3 * (1 - x);
 876
 877   uv -= (1 - x) * (1 - y) * a0 + x * (1 - y) * a1 + x * y * a2 + (1 - x) * y * a3;
 878
 879   return uv;
 880 }
 881
 882 //=======================================================================
 883 /*!
 884  * Create only quandrangle faces
 885  */
 886 //=======================================================================
 887
 888 bool StdMeshers_Quadrangle_2D::ComputeQuadPref (SMESH_Mesh &        aMesh,
 889                                                 const TopoDS_Shape& aShape,
 890                                                 FaceQuadStruct*     quad)
 891   throw (SALOME_Exception)
 892 {
 893   Unexpect aCatch(SalomeException);
 894
 895   SMESHDS_Mesh * meshDS = aMesh.GetMeshDS();
 896   const TopoDS_Face& F = TopoDS::Face(aShape);
 897   Handle(Geom_Surface) S = BRep_Tool::Surface(F);
 898   const TopoDS_Wire& W = BRepTools::OuterWire(F);
 899   bool WisF = true;
 900 //   if(W.Orientation()==TopAbs_FORWARD)
 901 //     WisF = true;
 902   //if(WisF) cout<<"W is FORWARD"<<endl;
 903   //else cout<<"W is REVERSED"<<endl;
 904 //   bool FisF = (F.Orientation()==TopAbs_FORWARD);
 905 //   if(!FisF) WisF = !WisF;
 906 //  WisF = FisF;
 907   int i,j,geomFaceID = meshDS->ShapeToIndex( F );
 908
 909   int nb = quad->side[0]->NbPoints();
 910   int nr = quad->side[1]->NbPoints();
 911   int nt = quad->side[2]->NbPoints();
 912   int nl = quad->side[3]->NbPoints();
 913   int dh = abs(nb-nt);
 914   int dv = abs(nr-nl);
 915
 916   if( dh>=dv ) {
 917     if( nt>nb ) {
 918       // it is a base case => not shift quad but me be replacement is need
 919       ShiftQuad(quad,0,WisF);
 920     }
 921     else {
 922       // we have to shift quad on 2
 923       ShiftQuad(quad,2,WisF);
 924     }
 925   }
 926   else {
 927     if( nr>nl ) {
 928       // we have to shift quad on 1
 929       ShiftQuad(quad,1,WisF);
 930     }
 931     else {
 932       // we have to shift quad on 3
 933       ShiftQuad(quad,3,WisF);
 934     }
 935   }
 936
 937   nb = quad->side[0]->NbPoints();
 938   nr = quad->side[1]->NbPoints();
 939   nt = quad->side[2]->NbPoints();
 940   nl = quad->side[3]->NbPoints();
 941   dh = abs(nb-nt);
 942   dv = abs(nr-nl);
 943   int nbh  = Max(nb,nt);
 944   int nbv = Max(nr,nl);
 945   int addh = 0;
 946   int addv = 0;
 947
 948   // orientation of face and 3 main domain for future faces
 949   //       0   top    1
 950   //      1------------1
 951   //       |   |  |   |
 952   //       |   |  |   |
 953   //       | L |  | R |
 954   //  left |   |  |   | rigth
 955   //       |  /    \  |
 956   //       | /  C   \ |
 957   //       |/        \|
 958   //      0------------0
 959   //       0  bottom  1
 960
 961   if(dh>dv) {
 962     addv = (dh-dv)/2;
 963     nbv = nbv + addv;
 964   }
 965   else { // dv>=dh
 966     addh = (dv-dh)/2;
 967     nbh = nbh + addh;
 968   }
 969
 970   const vector<UVPtStruct>& uv_eb = quad->side[0]->GetUVPtStruct(true,0 );
 971   const vector<UVPtStruct>& uv_er = quad->side[1]->GetUVPtStruct(false,1);
 972   const vector<UVPtStruct>& uv_et = quad->side[2]->GetUVPtStruct(true,1 );
 973   const vector<UVPtStruct>& uv_el = quad->side[3]->GetUVPtStruct(false,0);
 974
 975   // arrays for normalized params
 976   //cout<<"Dump B:"<<endl;
 977   TColStd_SequenceOfReal npb, npr, npt, npl;
 978   for(i=0; i<nb; i++) {
 979     npb.Append(uv_eb[i].normParam);
 980     //cout<<"i="<<i<<" par="<<uv_eb[i].normParam<<" npar="<<uv_eb[i].normParam;
 981     //const SMDS_MeshNode* N = uv_eb[i].node;
 982     //cout<<" node("<<N->X()<<","<<N->Y()<<","<<N->Z()<<")"<<endl;
 983   }
 984   for(i=0; i<nr; i++) {
 985     npr.Append(uv_er[i].normParam);
 986   }
 987   for(i=0; i<nt; i++) {
 988     npt.Append(uv_et[i].normParam);
 989   }
 990   for(i=0; i<nl; i++) {
 991     npl.Append(uv_el[i].normParam);
 992   }
 993
 994   // add some params to right and left after the first param
 995   // insert to right
 996   int dr = nbv - nr;
 997   double dpr = (npr.Value(2) - npr.Value(1))/(dr+1);
 998   for(i=1; i<=dr; i++) {
 999     npr.InsertAfter(1,npr.Value(2)-dpr);
1000   }
1001   // insert to left
1002   int dl = nbv - nl;
1003   dpr = (npl.Value(2) - npl.Value(1))/(dl+1);
1004   for(i=1; i<=dl; i++) {
1005     npl.InsertAfter(1,npl.Value(2)-dpr);
1006   }
1007   //cout<<"npb:";
1008   //for(i=1; i<=npb.Length(); i++) {
1009   //  cout<<" "<<npb.Value(i);
1010   //}
1011   //cout<<endl;
1012
1013   gp_XY a0( uv_eb.front().u, uv_eb.front().v );
1014   gp_XY a1( uv_eb.back().u,  uv_eb.back().v );
1015   gp_XY a2( uv_et.back().u,  uv_et.back().v );
1016   gp_XY a3( uv_et.front().u, uv_et.front().v );
1017   //cout<<" a0("<<a0.X()<<","<<a0.Y()<<")"<<" a1("<<a1.X()<<","<<a1.Y()<<")"
1018   //    <<" a2("<<a2.X()<<","<<a2.Y()<<")"<<" a3("<<a3.X()<<","<<a3.Y()<<")"<<endl;
1019
1020   int nnn = Min(nr,nl);
1021   // auxilary sequence of XY for creation nodes
1022   // in the bottom part of central domain
1023   // it's length must be == nbv-nnn-1
1024   TColgp_SequenceOfXY UVL;
1025   TColgp_SequenceOfXY UVR;
1026
1027   // step1: create faces for left domain
1028   StdMeshers_Array2OfNode NodesL(1,dl+1,1,nl);
1029   // add left nodes
1030   for(j=1; j<=nl; j++)
1031     NodesL.SetValue(1,j,uv_el[j-1].node);
1032   if(dl>0) {
1033     // add top nodes
1034     for(i=1; i<=dl; i++)
1035       NodesL.SetValue(i+1,nl,uv_et[i].node);
1036     // create and add needed nodes
1037     TColgp_SequenceOfXY UVtmp;
1038     for(i=1; i<=dl; i++) {
1039       double x0 = npt.Value(i+1);
1040       double x1 = x0;
1041       // diagonal node
1042       double y0 = npl.Value(i+1);
1043       double y1 = npr.Value(i+1);
1044       gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1045       gp_Pnt P = S->Value(UV.X(),UV.Y());
1046       SMDS_MeshNode * N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1047       meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1048       NodesL.SetValue(i+1,1,N);
1049       if(UVL.Length()<nbv-nnn-1) UVL.Append(UV);
1050       // internal nodes
1051       for(j=2; j<nl; j++) {
1052         double y0 = npl.Value(dl+j);
1053         double y1 = npr.Value(dl+j);
1054         gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1055         gp_Pnt P = S->Value(UV.X(),UV.Y());
1056         SMDS_MeshNode* N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1057         meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1058         NodesL.SetValue(i+1,j,N);
1059         if( i==dl ) UVtmp.Append(UV);
1060       }
1061     }
1062     for(i=1; i<=UVtmp.Length() && UVL.Length()<nbv-nnn-1; i++) {
1063       UVL.Append(UVtmp.Value(i));
1064     }
1065     //cout<<"Dump NodesL:"<<endl;
1066     //for(i=1; i<=dl+1; i++) {
1067     //  cout<<"i="<<i;
1068     //  for(j=1; j<=nl; j++) {
1069     //    cout<<" ("<<NodesL.Value(i,j)->X()<<","<<NodesL.Value(i,j)->Y()<<","<<NodesL.Value(i,j)->Z()<<")";
1070     //  }
1071     //  cout<<endl;
1072     //}
1073     // create faces
1074     for(i=1; i<=dl; i++) {
1075       for(j=1; j<nl; j++) {
1076         if(WisF) {
1077           SMDS_MeshFace* F =
1078             myTool->AddFace(NodesL.Value(i,j), NodesL.Value(i+1,j),
1079                             NodesL.Value(i+1,j+1), NodesL.Value(i,j+1));
1080           meshDS->SetMeshElementOnShape(F, geomFaceID);
1081         }
1082         else {
1083           SMDS_MeshFace* F =
1084             myTool->AddFace(NodesL.Value(i,j), NodesL.Value(i,j+1),
1085                             NodesL.Value(i+1,j+1), NodesL.Value(i+1,j));
1086           meshDS->SetMeshElementOnShape(F, geomFaceID);
1087         }
1088       }
1089     }
1090   }
1091   else {
1092     // fill UVL using c2d
1093     for(i=1; i<npl.Length() && UVL.Length()<nbv-nnn-1; i++) {
1094       UVL.Append( gp_UV ( uv_el[i].u, uv_el[i].v ));
1095     }
1096   }
1097
1098   // step2: create faces for right domain
1099   StdMeshers_Array2OfNode NodesR(1,dr+1,1,nr);
1100   // add right nodes
1101   for(j=1; j<=nr; j++)
1102     NodesR.SetValue(1,j,uv_er[nr-j].node);
1103   if(dr>0) {
1104     // add top nodes
1105     for(i=1; i<=dr; i++)
1106       NodesR.SetValue(i+1,1,uv_et[nt-1-i].node);
1107     // create and add needed nodes
1108     TColgp_SequenceOfXY UVtmp;
1109     for(i=1; i<=dr; i++) {
1110       double x0 = npt.Value(nt-i);
1111       double x1 = x0;
1112       // diagonal node
1113       double y0 = npl.Value(i+1);
1114       double y1 = npr.Value(i+1);
1115       gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1116       gp_Pnt P = S->Value(UV.X(),UV.Y());
1117       SMDS_MeshNode * N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1118       meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1119       NodesR.SetValue(i+1,nr,N);
1120       if(UVR.Length()<nbv-nnn-1) UVR.Append(UV);
1121       // internal nodes
1122       for(j=2; j<nr; j++) {
1123         double y0 = npl.Value(nbv-j+1);
1124         double y1 = npr.Value(nbv-j+1);
1125         gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1126         gp_Pnt P = S->Value(UV.X(),UV.Y());
1127         SMDS_MeshNode* N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1128         meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1129         NodesR.SetValue(i+1,j,N);
1130         if( i==dr ) UVtmp.Prepend(UV);
1131       }
1132     }
1133     for(i=1; i<=UVtmp.Length() && UVR.Length()<nbv-nnn-1; i++) {
1134       UVR.Append(UVtmp.Value(i));
1135     }
1136     // create faces
1137     for(i=1; i<=dr; i++) {
1138       for(j=1; j<nr; j++) {
1139         if(WisF) {
1140           SMDS_MeshFace* F =
1141             myTool->AddFace(NodesR.Value(i,j), NodesR.Value(i+1,j),
1142                             NodesR.Value(i+1,j+1), NodesR.Value(i,j+1));
1143           meshDS->SetMeshElementOnShape(F, geomFaceID);
1144         }
1145         else {
1146           SMDS_MeshFace* F =
1147             myTool->AddFace(NodesR.Value(i,j), NodesR.Value(i,j+1),
1148                             NodesR.Value(i+1,j+1), NodesR.Value(i+1,j));
1149           meshDS->SetMeshElementOnShape(F, geomFaceID);
1150         }
1151       }
1152     }
1153   }
1154   else {
1155     // fill UVR using c2d
1156     for(i=1; i<npr.Length() && UVR.Length()<nbv-nnn-1; i++) {
1157       UVR.Append( gp_UV( uv_er[i].u, uv_er[i].v ));
1158     }
1159   }
1160
1161   // step3: create faces for central domain
1162   StdMeshers_Array2OfNode NodesC(1,nb,1,nbv);
1163   // add first string using NodesL
1164   for(i=1; i<=dl+1; i++)
1165     NodesC.SetValue(1,i,NodesL(i,1));
1166   for(i=2; i<=nl; i++)
1167     NodesC.SetValue(1,dl+i,NodesL(dl+1,i));
1168   // add last string using NodesR
1169   for(i=1; i<=dr+1; i++)
1170     NodesC.SetValue(nb,i,NodesR(i,nr));
1171   for(i=1; i<nr; i++)
1172     NodesC.SetValue(nb,dr+i+1,NodesR(dr+1,nr-i));
1173   // add top nodes (last columns)
1174   for(i=dl+2; i<nbh-dr; i++)
1175     NodesC.SetValue(i-dl,nbv,uv_et[i-1].node);
1176   // add bottom nodes (first columns)
1177   for(i=2; i<nb; i++)
1178     NodesC.SetValue(i,1,uv_eb[i-1].node);
1179
1180   // create and add needed nodes
1181   // add linear layers
1182   for(i=2; i<nb; i++) {
1183     double x0 = npt.Value(dl+i);
1184     double x1 = x0;
1185     for(j=1; j<nnn; j++) {
1186       double y0 = npl.Value(nbv-nnn+j);
1187       double y1 = npr.Value(nbv-nnn+j);
1188       gp_UV UV = CalcUV(x0, x1, y0, y1, quad, a0, a1, a2, a3);
1189       gp_Pnt P = S->Value(UV.X(),UV.Y());
1190       SMDS_MeshNode* N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1191       meshDS->SetNodeOnFace(N, geomFaceID, UV.X(), UV.Y());
1192       NodesC.SetValue(i,nbv-nnn+j,N);
1193     }
1194   }
1195   // add diagonal layers
1196   //cout<<"UVL.Length()="<<UVL.Length()<<" UVR.Length()="<<UVR.Length()<<endl;
1197   //cout<<"Dump UVL:"<<endl;
1198   //for(i=1; i<=UVL.Length(); i++) {
1199   //  cout<<" ("<<UVL.Value(i).X()<<","<<UVL.Value(i).Y()<<")";
1200   //}
1201   //cout<<endl;
1202   for(i=1; i<nbv-nnn; i++) {
1203     double du = UVR.Value(i).X() - UVL.Value(i).X();
1204     double dv = UVR.Value(i).Y() - UVL.Value(i).Y();
1205     for(j=2; j<nb; j++) {
1206       double u = UVL.Value(i).X() + du*npb.Value(j);
1207       double v = UVL.Value(i).Y() + dv*npb.Value(j);
1208       gp_Pnt P = S->Value(u,v);
1209       SMDS_MeshNode* N = meshDS->AddNode(P.X(), P.Y(), P.Z());
1210       meshDS->SetNodeOnFace(N, geomFaceID, u, v);
1211       NodesC.SetValue(j,i+1,N);
1212     }
1213   }
1214   // create faces
1215   for(i=1; i<nb; i++) {
1216     for(j=1; j<nbv; j++) {
1217       if(WisF) {
1218         SMDS_MeshFace* F =
1219           myTool->AddFace(NodesC.Value(i,j), NodesC.Value(i+1,j),
1220                           NodesC.Value(i+1,j+1), NodesC.Value(i,j+1));
1221         meshDS->SetMeshElementOnShape(F, geomFaceID);
1222       }
1223       else {
1224         SMDS_MeshFace* F =
1225           myTool->AddFace(NodesC.Value(i,j), NodesC.Value(i,j+1),
1226                           NodesC.Value(i+1,j+1), NodesC.Value(i+1,j));
1227         meshDS->SetMeshElementOnShape(F, geomFaceID);
1228       }
1229     }
1230   }
1231
1232   bool isOk = true;
1233   return isOk;
1234 }
1235