src/StdMeshers/StdMeshers_FaceSide.cxx

   1 // Copyright (C) 2007-2013  CEA/DEN, EDF R&D, OPEN CASCADE
   2 //
   3 // Copyright (C) 2003-2007  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 // File      : StdMeshers_FaceSide.hxx
  24 // Created   : Wed Jan 31 18:41:25 2007
  25 // Author    : Edward AGAPOV (eap)
  26 // Module    : SMESH
  27 //
  28 #include "StdMeshers_FaceSide.hxx"
  29
  30 #include "SMDS_EdgePosition.hxx"
  31 #include "SMDS_MeshNode.hxx"
  32 #include "SMESHDS_Mesh.hxx"
  33 #include "SMESHDS_SubMesh.hxx"
  34 #include "SMESH_Algo.hxx"
  35 #include "SMESH_Mesh.hxx"
  36 #include "SMESH_MesherHelper.hxx"
  37 #include "SMESH_ComputeError.hxx"
  38 #include "SMESH_Block.hxx"
  39
  40 #include <Adaptor2d_Curve2d.hxx>
  41 #include <BRepAdaptor_CompCurve.hxx>
  42 #include <BRep_Builder.hxx>
  43 #include <BRep_Tool.hxx>
  44 #include <GCPnts_AbscissaPoint.hxx>
  45 #include <Geom2dAdaptor_Curve.hxx>
  46 #include <TopExp.hxx>
  47 #include <TopExp_Explorer.hxx>
  48 #include <TopoDS.hxx>
  49 #include <TopoDS_Face.hxx>
  50 #include <TopoDS_Vertex.hxx>
  51 #include <TopoDS_Wire.hxx>
  52
  53 #include <map>
  54
  55 #include "utilities.h"
  56
  57 //================================================================================
  58 /*!
  59  * \brief Constructor of a side of one edge
  60   * \param theFace - the face
  61   * \param theEdge - the edge
  62  */
  63 //================================================================================
  64
  65 StdMeshers_FaceSide::StdMeshers_FaceSide(const TopoDS_Face&   theFace,
  66                                          const TopoDS_Edge&   theEdge,
  67                                          SMESH_Mesh*          theMesh,
  68                                          const bool           theIsForward,
  69                                          const bool           theIgnoreMediumNodes,
  70                                          SMESH_ProxyMesh::Ptr theProxyMesh)
  71 {
  72   list<TopoDS_Edge> edges(1,theEdge);
  73   *this = StdMeshers_FaceSide( theFace, edges, theMesh, theIsForward,
  74                                theIgnoreMediumNodes, theProxyMesh );
  75 }
  76
  77 //================================================================================
  78 /*!
  79  * \brief Constructor of a side of several edges
  80   * \param theFace - the face
  81   * \param theEdge - the edge
  82  */
  83 //================================================================================
  84
  85 StdMeshers_FaceSide::StdMeshers_FaceSide(const TopoDS_Face&   theFace,
  86                                          list<TopoDS_Edge>&   theEdges,
  87                                          SMESH_Mesh*          theMesh,
  88                                          const bool           theIsForward,
  89                                          const bool           theIgnoreMediumNodes,
  90                                          SMESH_ProxyMesh::Ptr theProxyMesh)
  91 {
  92   int nbEdges = theEdges.size();
  93   myEdge.resize      ( nbEdges );
  94   myEdgeID.resize    ( nbEdges );
  95   myC2d.resize       ( nbEdges );
  96   myC3dAdaptor.resize( nbEdges );
  97   myFirst.resize     ( nbEdges );
  98   myLast.resize      ( nbEdges );
  99   myNormPar.resize   ( nbEdges );
 100   myEdgeLength.resize( nbEdges );
 101   myIsUniform.resize ( nbEdges, true );
 102   myLength             = 0;
 103   myNbPonits           = myNbSegments = 0;
 104   myProxyMesh          = theProxyMesh;
 105   myMissingVertexNodes = false;
 106   myIgnoreMediumNodes  = theIgnoreMediumNodes;
 107   myDefaultPnt2d       = gp_Pnt2d( 1e+100, 1e+100 );
 108   if ( !myProxyMesh ) myProxyMesh.reset( new SMESH_ProxyMesh( *theMesh ));
 109   if ( nbEdges == 0 ) return;
 110
 111   SMESHDS_Mesh* meshDS = myProxyMesh->GetMeshDS();
 112
 113   int nbDegen = 0;
 114   list<TopoDS_Edge>::iterator edge = theEdges.begin();
 115   TopoDS_Iterator vExp;
 116   for ( int index = 0; edge != theEdges.end(); ++index, ++edge )
 117   {
 118     int i = theIsForward ? index : nbEdges-index-1;
 119     myEdgeLength[i] = SMESH_Algo::EdgeLength( *edge );
 120     if ( myEdgeLength[i] < DBL_MIN ) nbDegen++;
 121     myLength += myEdgeLength[i];
 122     myEdge[i] = *edge;
 123     myEdgeID[i] = meshDS->ShapeToIndex( *edge );
 124     if ( !theIsForward ) myEdge[i].Reverse();
 125
 126     if ( theFace.IsNull() )
 127       BRep_Tool::Range( *edge, myFirst[i], myLast[i] );
 128     else
 129       myC2d[i] = BRep_Tool::CurveOnSurface( *edge, theFace, myFirst[i], myLast[i] );
 130     if ( myEdge[i].Orientation() == TopAbs_REVERSED )
 131       std::swap( myFirst[i], myLast[i] );
 132
 133     if ( const SMESHDS_SubMesh* sm = myProxyMesh->GetSubMesh( *edge )) {
 134       int nbN = sm->NbNodes();
 135       if ( theIgnoreMediumNodes ) {
 136         SMDS_ElemIteratorPtr elemIt = sm->GetElements();
 137         if ( elemIt->more() && elemIt->next()->IsQuadratic() )
 138           nbN -= sm->NbElements();
 139       }
 140       myNbPonits += nbN;
 141       myNbSegments += sm->NbElements();
 142     }
 143
 144     // TopExp::FirstVertex() and TopExp::LastVertex() return NULL from INTERNAL edge
 145     vExp.Initialize( *edge );
 146     if ( vExp.Value().Orientation() == TopAbs_REVERSED ) vExp.Next();
 147     if ( SMESH_Algo::VertexNode( TopoDS::Vertex( vExp.Value()), meshDS ))
 148       myNbPonits += 1; // for the first end
 149     else
 150       myMissingVertexNodes = true;
 151
 152     // check if the edge has a non-uniform parametrization (issue 0020705)
 153     if ( !myC2d[i].IsNull() && myEdgeLength[i] > DBL_MIN)
 154     {
 155       Geom2dAdaptor_Curve A2dC( myC2d[i],
 156                                 std::min( myFirst[i], myLast[i] ),
 157                                 std::max( myFirst[i], myLast[i] ));
 158       double p2 = myFirst[i]+(myLast[i]-myFirst[i])/2., p4 = myFirst[i]+(myLast[i]-myFirst[i])/4.;
 159       double d2 = GCPnts_AbscissaPoint::Length( A2dC, myFirst[i], p2 );
 160       double d4 = GCPnts_AbscissaPoint::Length( A2dC, myFirst[i], p4 );
 161       //cout<<"len = "<<len<<"  d2 = "<<d2<<"  fabs(2*d2/len-1.0) = "<<fabs(2*d2/len-1.0)<<endl;
 162       myIsUniform[i] = !( fabs(2*d2/myEdgeLength[i]-1.0) > 0.01 || fabs(2*d4/d2-1.0) > 0.01 );
 163       //if ( !myIsUniform[i] ) to implement Value3d(u)
 164       {
 165         double fp,lp;
 166         Handle(Geom_Curve) C3d = BRep_Tool::Curve(myEdge[i],fp,lp);
 167         myC3dAdaptor[i].Load( C3d, fp,lp );
 168       }
 169     }
 170     // reverse a proxy submesh
 171     if ( !theIsForward )
 172       reverseProxySubmesh( myEdge[i] );
 173
 174   } // loop on edges
 175
 176   vExp.Initialize( theEdges.back() );
 177   if ( vExp.Value().Orientation() != TopAbs_REVERSED ) vExp.Next();
 178   if ( vExp.More() )
 179   {
 180     if ( SMESH_Algo::VertexNode( TopoDS::Vertex( vExp.Value()), meshDS ))
 181       myNbPonits++; // for the last end
 182     else
 183       myMissingVertexNodes = true;
 184   }
 185   if ( nbEdges > 1 && myLength > DBL_MIN ) {
 186     const double degenNormLen = 1.e-5;
 187     double totLength = myLength;
 188     if ( nbDegen )
 189       totLength += myLength * degenNormLen * nbDegen;
 190     double prevNormPar = 0;
 191     for ( int i = 0; i < nbEdges; ++i ) {
 192       if ( myEdgeLength[ i ] < DBL_MIN )
 193         myEdgeLength[ i ] = myLength * degenNormLen;
 194       myNormPar[ i ] = prevNormPar + myEdgeLength[i]/totLength;
 195       prevNormPar = myNormPar[ i ];
 196     }
 197   }
 198   myNormPar[nbEdges-1] = 1.;
 199   //dump();
 200 }
 201
 202 //================================================================================
 203 /*!
 204  * \brief Constructor of a side for vertex using data from other FaceSide
 205   * \param theVertex - the vertex
 206   * \param theSide - the side
 207  */
 208 //================================================================================
 209
 210 StdMeshers_FaceSide::StdMeshers_FaceSide(const SMDS_MeshNode*       theNode,
 211                                          const gp_Pnt2d             thePnt2d,
 212                                          const StdMeshers_FaceSide* theSide)
 213 {
 214   myC2d.resize(1);
 215   myLength       = 0;
 216   myProxyMesh    = theSide->myProxyMesh;
 217   myDefaultPnt2d = thePnt2d;
 218
 219   myPoints = theSide->GetUVPtStruct();
 220   myNbPonits = myPoints.size();
 221   myNbSegments = theSide->myNbSegments;
 222   std::vector<uvPtStruct>::iterator it = myPoints.begin();
 223   for(; it!=myPoints.end(); it++) {
 224     (*it).u = thePnt2d.X();
 225     (*it).v = thePnt2d.Y();
 226     (*it).y = 0.0;
 227     (*it).node = theNode;
 228   }
 229 }
 230
 231 //================================================================================
 232 /*!
 233  * \brief Return info on nodes on the side
 234   * \retval UVPtStruct* - array of data structures
 235  */
 236 //================================================================================
 237
 238 const vector<UVPtStruct>& StdMeshers_FaceSide::GetUVPtStruct(bool   isXConst,
 239                                                              double constValue) const
 240 {
 241   if ( myPoints.empty() ) {
 242
 243     if ( NbEdges() == 0 ) return myPoints;
 244
 245     SMESHDS_Mesh* meshDS = myProxyMesh->GetMeshDS();
 246     SMESH_MesherHelper helper(*myProxyMesh->GetMesh());
 247     bool paramOK;
 248     double eps = 1e-100;
 249
 250     // sort nodes of all edges putting them into a map
 251
 252     map< double, const SMDS_MeshNode*> u2node;
 253     vector< const SMESH_ProxyMesh::SubMesh* > proxySubMesh( myEdge.size());
 254     int nbProxyNodes = 0;
 255     for ( size_t iE = 0; iE < myEdge.size(); ++iE )
 256     {
 257       proxySubMesh[iE] = myProxyMesh->GetProxySubMesh( myEdge[iE] );
 258       if ( proxySubMesh[iE] )
 259       {
 260         if ( proxySubMesh[iE]->GetUVPtStructVec().empty() ) {
 261           proxySubMesh[iE] = 0;
 262         }
 263         else {
 264           nbProxyNodes += proxySubMesh[iE]->GetUVPtStructVec().size() - 1;
 265           if ( iE+1 == myEdge.size() )
 266             ++nbProxyNodes;
 267           continue;
 268         }
 269       }
 270       // Put 1st vertex node of a current edge
 271       TopoDS_Vertex VV[2]; // TopExp::FirstVertex() returns NULL for INTERNAL edge
 272       VV[0] = SMESH_MesherHelper::IthVertex( 0, myEdge[iE]);
 273       VV[1] = SMESH_MesherHelper::IthVertex( 1, myEdge[iE]);
 274       const SMDS_MeshNode* node = SMESH_Algo::VertexNode( VV[0], meshDS );
 275       double prevNormPar = ( iE == 0 ? 0 : myNormPar[ iE-1 ]); // normalized param
 276       if ( node ) { // nodes on internal vertices may be missing
 277         u2node.insert( u2node.end(), make_pair( prevNormPar, node ));
 278       }
 279       else if ( iE == 0 ) {
 280         MESSAGE(" NO NODE on VERTEX" );
 281         return myPoints;
 282       }
 283
 284       // Put internal nodes
 285       if ( const SMESHDS_SubMesh* sm = myProxyMesh->GetSubMesh( myEdge[iE] ))
 286       {
 287         vector< pair< double, const SMDS_MeshNode*> > u2nodeVec;
 288         u2nodeVec.reserve( sm->NbNodes() );
 289         SMDS_NodeIteratorPtr nItr = sm->GetNodes();
 290         double paramSize = myLast[iE] - myFirst[iE];
 291         double r         = myNormPar[iE] - prevNormPar;
 292         helper.SetSubShape( myEdge[iE] );
 293         helper.ToFixNodeParameters( true );
 294         if ( !myIsUniform[iE] )
 295           while ( nItr->more() )
 296           {
 297             const SMDS_MeshNode* node = nItr->next();
 298             if ( myIgnoreMediumNodes && SMESH_MeshEditor::IsMedium( node, SMDSAbs_Edge ))
 299               continue;
 300             double u = helper.GetNodeU( myEdge[iE], node, 0, &paramOK );
 301             double aLenU = GCPnts_AbscissaPoint::Length
 302               ( const_cast<GeomAdaptor_Curve&>( myC3dAdaptor[iE]), myFirst[iE], u );
 303             if ( myEdgeLength[iE] < aLenU ) // nonregression test "3D_mesh_NETGEN/G6"
 304             {
 305               u2nodeVec.clear();
 306               break;
 307             }
 308             double normPar = prevNormPar + r*aLenU/myEdgeLength[iE];
 309             u2nodeVec.push_back( make_pair( normPar, node ));
 310           }
 311         nItr = sm->GetNodes();
 312         if ( u2nodeVec.empty() )
 313           while ( nItr->more() )
 314           {
 315             const SMDS_MeshNode* node = nItr->next();
 316             if ( myIgnoreMediumNodes && SMESH_MeshEditor::IsMedium( node, SMDSAbs_Edge ))
 317               continue;
 318             double u = helper.GetNodeU( myEdge[iE], node, 0, &paramOK );
 319
 320             // paramSize is signed so orientation is taken into account
 321             double normPar = prevNormPar + r * ( u - myFirst[iE] ) / paramSize;
 322             u2nodeVec.push_back( make_pair( normPar, node ));
 323           }
 324         for ( size_t j = 0; j < u2nodeVec.size(); ++j )
 325           u2node.insert( u2node.end(), u2nodeVec[j] );
 326       }
 327
 328       // Put 2nd vertex node for a last edge
 329       if ( iE+1 == myEdge.size() ) {
 330         node = SMESH_Algo::VertexNode( VV[1], meshDS );
 331         if ( !node ) {
 332           MESSAGE(" NO NODE on VERTEX" );
 333           return myPoints;
 334         }
 335         u2node.insert( u2node.end(), make_pair( 1., node ));
 336       }
 337     } // loop on myEdge's
 338
 339     if ( u2node.size() + nbProxyNodes != myNbPonits &&
 340          u2node.size() + nbProxyNodes != NbPoints( /*update=*/true ))
 341     {
 342       MESSAGE("Wrong node parameters on edges, u2node.size():"
 343               <<u2node.size()<<" !=  myNbPonits:"<<myNbPonits);
 344       return myPoints;
 345     }
 346
 347     // fill array of UVPtStruct
 348
 349     UVPtStructVec& points = const_cast< UVPtStructVec& >( myPoints );
 350     points.resize( myNbPonits );
 351
 352     int iPt = 0;
 353     double prevNormPar = 0, paramSize = myNormPar[ 0 ];
 354     map< double, const SMDS_MeshNode*>::iterator u_node = u2node.begin();
 355     for ( size_t iE = 0; iE < myEdge.size(); ++iE )
 356     {
 357       if ( proxySubMesh[ iE ] ) // copy data from a proxy sub-mesh
 358       {
 359         const UVPtStructVec& edgeUVPtStruct = proxySubMesh[iE]->GetUVPtStructVec();
 360         std::copy( edgeUVPtStruct.begin(), edgeUVPtStruct.end(), & points[iPt] );
 361         // check orientation
 362         double du1 = edgeUVPtStruct.back().param - edgeUVPtStruct[0].param;
 363         double du2 = myLast[iE] - myFirst[iE];
 364         if ( du1 * du2 < 0 )
 365         {
 366           std::reverse( & points[iPt], & points[iPt + edgeUVPtStruct.size()]);
 367           for ( size_t i = 0; i < edgeUVPtStruct.size(); ++i )
 368             points[iPt+i].normParam = 1. - points[iPt+i].normParam;
 369         }
 370         // update normalized params
 371         if ( myEdge.size() > 1 ) {
 372           for ( size_t i = 0; i < edgeUVPtStruct.size(); ++i, ++iPt )
 373           {
 374             UVPtStruct & uvPt = points[iPt];
 375             uvPt.normParam    = prevNormPar + uvPt.normParam * paramSize;
 376             uvPt.x = uvPt.y   = uvPt.normParam;
 377           }
 378           --iPt; // to point to the 1st VERTEX of the next EDGE
 379         }
 380       }
 381       else
 382       {
 383         for ( ; u_node != u2node.end(); ++u_node, ++iPt )
 384         {
 385           if ( myNormPar[ iE ]-eps < u_node->first )
 386             break; // u_node is at VERTEX of the next EDGE
 387
 388           UVPtStruct & uvPt = points[iPt];
 389           uvPt.node       = u_node->second;
 390           // -- normParam, x, y --------------------------------
 391           uvPt.normParam  = u_node->first;
 392           uvPt.x = uvPt.y = uvPt.normParam;
 393           // -- U ----------------------------------------------
 394           const SMDS_EdgePosition* epos =
 395             dynamic_cast<const SMDS_EdgePosition*>(uvPt.node->GetPosition());
 396           if ( epos ) {
 397             uvPt.param = epos->GetUParameter();
 398           }
 399           else {
 400             double r = ( uvPt.normParam - prevNormPar )/ paramSize;
 401             uvPt.param = ( r > 0.5 ? myLast[iE] : myFirst[iE] );
 402           }
 403           // -- UV ---------------------------------------------
 404           if ( !myC2d[ iE ].IsNull() ) {
 405             gp_Pnt2d p = myC2d[ iE ]->Value( uvPt.param );
 406             uvPt.u = p.X();
 407             uvPt.v = p.Y();
 408           }
 409           else {
 410             uvPt.u = uvPt.v = 1e+100;
 411           }
 412         }
 413       }
 414       // prepare for the next EDGE
 415       if ( iE+1 < myEdge.size() )
 416       {
 417         prevNormPar = myNormPar[ iE ];
 418         paramSize   = myNormPar[ iE+1 ] - prevNormPar;
 419       }
 420     } // loop on myEdge's
 421
 422     // set <constValue>
 423     if ( isXConst )
 424       for ( iPt = 0; iPt < points.size(); ++iPt ) points[ iPt ].x = constValue;
 425     else
 426       for ( iPt = 0; iPt < points.size(); ++iPt ) points[ iPt ].y = constValue;
 427
 428   } // if ( myPoints.empty())
 429
 430   return myPoints;
 431 }
 432
 433 //================================================================================
 434 /*!
 435  * \brief Falsificate info on nodes
 436  * \param nbSeg - nb of segments on the side
 437  * \retval UVPtStruct* - array of data structures
 438  */
 439 //================================================================================
 440
 441 const vector<UVPtStruct>& StdMeshers_FaceSide::SimulateUVPtStruct(int    nbSeg,
 442                                                                   bool   isXConst,
 443                                                                   double constValue) const
 444 {
 445   if ( myFalsePoints.empty() ) {
 446
 447     if ( NbEdges() == 0 ) return myFalsePoints;
 448
 449     vector<uvPtStruct>* points = const_cast<vector<uvPtStruct>*>( &myFalsePoints );
 450     points->resize( nbSeg+1 );
 451
 452     int EdgeIndex = 0;
 453     double prevNormPar = 0, paramSize = myNormPar[ EdgeIndex ];
 454     for (int i = 0 ; i < myFalsePoints.size(); ++i ) {
 455       double normPar = double(i) / double(nbSeg);
 456       UVPtStruct & uvPt = (*points)[i];
 457       uvPt.node = 0;
 458       uvPt.x = uvPt.y = uvPt.param = uvPt.normParam = normPar;
 459       if ( isXConst ) uvPt.x = constValue;
 460       else            uvPt.y = constValue;
 461       if ( myNormPar[ EdgeIndex ] < normPar ) {
 462         prevNormPar = myNormPar[ EdgeIndex ];
 463         ++EdgeIndex;
 464         paramSize = myNormPar[ EdgeIndex ] - prevNormPar;
 465       }
 466       double r = ( normPar - prevNormPar )/ paramSize;
 467       uvPt.param = myFirst[EdgeIndex] * ( 1 - r ) + myLast[EdgeIndex] * r;
 468       if ( !myC2d[ EdgeIndex ].IsNull() ) {
 469         gp_Pnt2d p = myC2d[ EdgeIndex ]->Value( uvPt.param );
 470         uvPt.u = p.X();
 471         uvPt.v = p.Y();
 472       }
 473       else {
 474         uvPt.u = uvPt.v = 1e+100;
 475       }
 476     }
 477   }
 478   return myFalsePoints;
 479 }
 480
 481 //=======================================================================
 482 //function : GetOrderedNodes
 483 //purpose  : Return nodes in the order they encounter while walking along the side
 484 //=======================================================================
 485
 486 std::vector<const SMDS_MeshNode*> StdMeshers_FaceSide::GetOrderedNodes() const
 487 {
 488   vector<const SMDS_MeshNode*> resultNodes;
 489   if ( myPoints.empty() )
 490   {
 491     if ( NbEdges() == 0 ) return resultNodes;
 492
 493     SMESHDS_Mesh* meshDS = myProxyMesh->GetMeshDS();
 494     SMESH_MesherHelper helper(*myProxyMesh->GetMesh());
 495     bool paramOK;
 496
 497     // Sort nodes of all edges putting them into a map
 498
 499     map< double, const SMDS_MeshNode*> u2node;
 500     for ( int i = 0; i < myEdge.size(); ++i )
 501     {
 502       // Put 1st vertex node of a current edge
 503       TopoDS_Vertex VV[2]; // TopExp::FirstVertex() returns NULL for INTERNAL edge
 504       VV[0] = SMESH_MesherHelper::IthVertex( 0, myEdge[i]);
 505       VV[1] = SMESH_MesherHelper::IthVertex( 1, myEdge[i]);
 506       const SMDS_MeshNode* node = SMESH_Algo::VertexNode( VV[0], meshDS );
 507       double prevNormPar = ( i == 0 ? 0 : myNormPar[ i-1 ]); // normalized param
 508       if ( node ) { // nodes on internal vertices may be missing
 509         u2node.insert( make_pair( prevNormPar, node ));
 510       }
 511       else if ( i == 0 ) {
 512         MESSAGE(" NO NODE on VERTEX" );
 513         return resultNodes;
 514       }
 515
 516       // Put internal nodes
 517       if ( SMESHDS_SubMesh* sm = meshDS->MeshElements( myEdge[i] ))
 518       {
 519         SMDS_NodeIteratorPtr nItr = sm->GetNodes();
 520         double paramSize = myLast[i] - myFirst[i];
 521         double r         = myNormPar[i] - prevNormPar;
 522         helper.SetSubShape( myEdge[i] );
 523         helper.ToFixNodeParameters( true );
 524         while ( nItr->more() )
 525         {
 526           const SMDS_MeshNode* node = nItr->next();
 527           if ( myIgnoreMediumNodes && SMESH_MeshEditor::IsMedium( node, SMDSAbs_Edge ))
 528             continue;
 529           double u = helper.GetNodeU( myEdge[i], node, 0, &paramOK );
 530
 531           // paramSize is signed so orientation is taken into account
 532           double normPar = prevNormPar + r * ( u - myFirst[i] ) / paramSize;
 533           u2node.insert( u2node.end(), make_pair( normPar, node ));
 534         }
 535       }
 536
 537       // Put 2nd vertex node for a last edge
 538       if ( i+1 == myEdge.size() ) {
 539         node = SMESH_Algo::VertexNode( VV[1], meshDS );
 540         if ( !node ) {
 541           return resultNodes;
 542         }
 543         u2node.insert( u2node.end(), make_pair( 1., node ));
 544       }
 545     }
 546
 547     // Fill the result vector
 548
 549     if ( u2node.size() == myNbPonits )
 550     {
 551       resultNodes.reserve( u2node.size() );
 552       map< double, const SMDS_MeshNode*>::iterator u2n = u2node.begin();
 553       for ( ; u2n != u2node.end(); ++u2n )
 554         resultNodes.push_back( u2n->second );
 555     }
 556   }
 557   else
 558   {
 559     resultNodes.resize( myPoints.size() );
 560     for ( size_t i = 0; i < myPoints.size(); ++i )
 561       resultNodes[i] = myPoints[i].node;
 562   }
 563
 564   return resultNodes;
 565 }
 566
 567 //================================================================================
 568 /*!
 569  * \brief reverse order of vector elements
 570   * \param vec - vector to reverse
 571  */
 572 //================================================================================
 573
 574 template <typename T > void reverse(vector<T> & vec)
 575 {
 576   for ( int f=0, r=vec.size()-1; f < r; ++f, --r )
 577     std::swap( vec[f], vec[r] );
 578 }
 579
 580 //================================================================================
 581 /*!
 582  * \brief Change orientation of side geometry
 583  */
 584 //================================================================================
 585
 586 void StdMeshers_FaceSide::Reverse()
 587 {
 588   int nbEdges = myEdge.size();
 589   for ( int i = nbEdges-1; i >= 0; --i ) {
 590     std::swap( myFirst[i], myLast[i] );
 591     myEdge[i].Reverse();
 592     if ( i > 0 ) // at the first loop 1. is overwritten
 593       myNormPar[i] = 1 - myNormPar[i-1];
 594   }
 595   if ( nbEdges > 1 ) {
 596     reverse( myEdge );
 597     reverse( myEdgeID );
 598     reverse( myC2d );
 599     //reverse( myC3dAdaptor );
 600     reverse( myFirst );
 601     reverse( myLast );
 602     reverse( myNormPar );
 603     reverse( myEdgeLength );
 604     reverse( myIsUniform );
 605   }
 606   if ( nbEdges > 0 )
 607   {
 608     myNormPar[nbEdges-1]=1.;
 609     myPoints.clear();
 610     myFalsePoints.clear();
 611     for ( size_t i = 0; i < myEdge.size(); ++i )
 612       reverseProxySubmesh( myEdge[i] );
 613   }
 614   for ( size_t i = 0; i < myEdge.size(); ++i )
 615   {
 616     double fp,lp;
 617     Handle(Geom_Curve) C3d = BRep_Tool::Curve(myEdge[i],fp,lp);
 618     if ( !C3d.IsNull() )
 619       myC3dAdaptor[i].Load( C3d, fp,lp );
 620   }
 621 }
 622
 623 //=======================================================================
 624 //function : SetIgnoreMediumNodes
 625 //purpose  : Make ignore medium nodes
 626 //=======================================================================
 627
 628 void StdMeshers_FaceSide::SetIgnoreMediumNodes(bool toIgnore)
 629 {
 630   if ( myIgnoreMediumNodes != toIgnore )
 631   {
 632     myIgnoreMediumNodes = toIgnore;
 633
 634     if ( !myPoints.empty() )
 635     {
 636       UVPtStructVec newPoints;
 637       newPoints.reserve( myPoints.size()/2 + 1 );
 638       for ( size_t i = 0; i < myPoints.size(); i += 2 )
 639         newPoints.push_back( myPoints[i] );
 640
 641       myPoints.swap( newPoints );
 642     }
 643     else
 644     {
 645       NbPoints( /*update=*/true );
 646     }
 647   }
 648 }
 649
 650 //=======================================================================
 651 //function : NbPoints
 652 //purpose  : Return nb nodes on edges and vertices (+1 to be == GetUVPtStruct().size() )
 653 //           Call it with update == true if mesh of this side can be recomputed
 654 //           since creation of this side
 655 //=======================================================================
 656
 657 int StdMeshers_FaceSide::NbPoints(const bool update) const
 658 {
 659   if ( !myPoints.empty() )
 660     return myPoints.size();
 661
 662   // if ( !myFalsePoints.empty() )
 663   //   return myFalsePoints.size();
 664
 665   if ( update && myEdge.size() > 0 )
 666   {
 667     StdMeshers_FaceSide* me = (StdMeshers_FaceSide*) this;
 668     me->myNbPonits = 0;
 669     me->myNbSegments = 0;
 670     me->myMissingVertexNodes = false;
 671
 672     for ( int i = 0; i < NbEdges(); ++i )
 673     {
 674       TopoDS_Vertex v1 = SMESH_MesherHelper::IthVertex( 0, myEdge[i] );
 675       if ( SMESH_Algo::VertexNode( v1, myProxyMesh->GetMeshDS() ))
 676         me->myNbPonits += 1; // for the first end
 677       else
 678         me->myMissingVertexNodes = true;
 679
 680       if ( const SMESHDS_SubMesh* sm = myProxyMesh->GetSubMesh( Edge(i) )) {
 681         int nbN = sm->NbNodes();
 682         if ( myIgnoreMediumNodes ) {
 683           SMDS_ElemIteratorPtr elemIt = sm->GetElements();
 684           if ( elemIt->more() && elemIt->next()->IsQuadratic() )
 685             nbN -= sm->NbElements();
 686         }
 687         me->myNbPonits   += nbN;
 688         me->myNbSegments += sm->NbElements();
 689       }
 690     }
 691     TopoDS_Vertex v1 = SMESH_MesherHelper::IthVertex( 1, Edge( NbEdges()-1 ));
 692     if ( SMESH_Algo::VertexNode( v1, myProxyMesh->GetMeshDS() ))
 693       me->myNbPonits++; // for the last end
 694     else
 695       me->myMissingVertexNodes = true;
 696   }
 697   return myNbPonits;
 698 }
 699
 700 //=======================================================================
 701 //function : NbSegments
 702 //purpose  : Return nb edges
 703 //           Call it with update == true if mesh of this side can be recomputed
 704 //           since creation of this side
 705 //=======================================================================
 706
 707 int StdMeshers_FaceSide::NbSegments(const bool update) const
 708 {
 709   return NbPoints( update ), myNbSegments;
 710 }
 711
 712 //================================================================================
 713 /*!
 714  * \brief Reverse UVPtStructVec if a proxy sub-mesh of E
 715  */
 716 //================================================================================
 717
 718 void StdMeshers_FaceSide::reverseProxySubmesh( const TopoDS_Edge& E )
 719 {
 720   if ( !myProxyMesh ) return;
 721   if ( const SMESH_ProxyMesh::SubMesh* sm = myProxyMesh->GetProxySubMesh( E ))
 722   {
 723     UVPtStructVec& edgeUVPtStruct = (UVPtStructVec& ) sm->GetUVPtStructVec();
 724     for ( size_t i = 0; i < edgeUVPtStruct.size(); ++i )
 725     {
 726       UVPtStruct & uvPt = edgeUVPtStruct[i];
 727       uvPt.normParam = 1 - uvPt.normParam;
 728       uvPt.x         = 1 - uvPt.x;
 729       uvPt.y         = 1 - uvPt.y;
 730     }
 731     reverse( edgeUVPtStruct );
 732   }
 733 }
 734
 735 //================================================================================
 736 /*!
 737  * \brief Show side features
 738  */
 739 //================================================================================
 740
 741 void StdMeshers_FaceSide::dump(const char* msg) const
 742 {
 743 #ifdef _DEBUG_
 744   if (msg) MESSAGE ( std::endl << msg );
 745   MESSAGE_BEGIN ("NB EDGES: "<< myEdge.size() );
 746   MESSAGE_ADD ( "nbPoints: "<<myNbPonits<<" vecSize: " << myPoints.size()<<" "<<myFalsePoints.size() );
 747   for ( int i=0; i<myEdge.size(); ++i)
 748   {
 749     MESSAGE_ADD ( "\t"<<i+1 );
 750     MESSAGE_ADD ( "\tEDGE: " );
 751     if (myEdge[i].IsNull()) {
 752       MESSAGE_ADD ( "NULL" );
 753     }
 754     else {
 755       TopAbs::Print(myEdge[i].Orientation(),cout)<<" "<<myEdge[i].TShape().operator->()<<endl;
 756       MESSAGE_ADD ( "\tV1: " << TopExp::FirstVertex( myEdge[i], 1).TShape().operator->()
 757                  << "  V2: " << TopExp::LastVertex( myEdge[i], 1).TShape().operator->() );
 758     }
 759     MESSAGE_ADD ( "\tC2d: ");
 760
 761     if (myC2d[i].IsNull()) {
 762       MESSAGE_ADD ( "NULL" );
 763     }
 764     else {
 765       MESSAGE_ADD ( myC2d[i].operator->() );
 766     }
 767
 768     MESSAGE_ADD ( "\tF: "<<myFirst[i]<< " L: "<< myLast[i] );
 769     MESSAGE_END ( "\tnormPar: "<<myNormPar[i]<<endl );
 770   }
 771 #endif
 772 }
 773
 774 //================================================================================
 775 /*!
 776  * \brief Creates a Adaptor2d_Curve2d to be used in SMESH_Block
 777   * \retval Adaptor2d_Curve2d* -
 778  */
 779 //================================================================================
 780
 781 struct Adaptor2dCurve2d : public Adaptor2d_Curve2d
 782 {
 783   const StdMeshers_FaceSide* mySide;
 784   Adaptor2dCurve2d(const StdMeshers_FaceSide* faceSide):mySide(faceSide) {}
 785   gp_Pnt2d Value(const Standard_Real U) const { return mySide->Value2d( U ); }
 786   Standard_Real FirstParameter() const { return 0; }
 787   Standard_Real LastParameter() const { return 1; }
 788 };
 789
 790 Adaptor2d_Curve2d* StdMeshers_FaceSide::GetCurve2d() const
 791 {
 792   return new Adaptor2dCurve2d( this );
 793 }
 794
 795 //================================================================================
 796 /*!
 797  * \brief Creates a fully functional Adaptor_Curve
 798  */
 799 //================================================================================
 800
 801 BRepAdaptor_CompCurve* StdMeshers_FaceSide::GetCurve3d() const
 802 {
 803   if ( myEdge.empty() )
 804     return 0;
 805
 806   TopoDS_Wire aWire;
 807   BRep_Builder aBuilder;
 808   aBuilder.MakeWire(aWire);
 809   for ( int i=0; i<myEdge.size(); ++i )
 810     aBuilder.Add( aWire, myEdge[i] );
 811
 812   if ( myEdge.size() == 2 && FirstVertex().IsSame( LastVertex() ))
 813     aWire.Closed(true); // issue 0021141
 814
 815   return new BRepAdaptor_CompCurve( aWire );
 816 }
 817
 818 //================================================================================
 819 /*!
 820  * \brief Return 2D point by normalized parameter
 821   * \param U - normalized parameter value
 822   * \retval gp_Pnt2d - point
 823  */
 824 //================================================================================
 825
 826 gp_Pnt2d StdMeshers_FaceSide::Value2d(double U) const
 827 {
 828   if ( !myC2d[0].IsNull() ) {
 829     int i = EdgeIndex( U );
 830     double prevU = i ? myNormPar[ i-1 ] : 0;
 831     double r = ( U - prevU )/ ( myNormPar[ i ] - prevU );
 832
 833     double par = myFirst[i] * ( 1 - r ) + myLast[i] * r;
 834
 835     // check parametrization of curve
 836     if( !myIsUniform[i] )
 837     {
 838       double aLen3dU = r * myEdgeLength[i] * ( myFirst[i]>myLast[i] ? -1. : 1.);
 839       GCPnts_AbscissaPoint AbPnt
 840         ( const_cast<GeomAdaptor_Curve&>( myC3dAdaptor[i]), aLen3dU, myFirst[i] );
 841       if( AbPnt.IsDone() ) {
 842         par = AbPnt.Parameter();
 843       }
 844     }
 845     return myC2d[ i ]->Value(par);
 846
 847   }
 848   return myDefaultPnt2d;
 849 }
 850
 851 //================================================================================
 852 /*!
 853  * \brief Return XYZ by normalized parameter
 854   * \param U - normalized parameter value
 855   * \retval gp_Pnt - point
 856  */
 857 //================================================================================
 858
 859 gp_Pnt StdMeshers_FaceSide::Value3d(double U) const
 860 {
 861   int        i = EdgeIndex( U );
 862   double prevU = i ? myNormPar[ i-1 ] : 0;
 863   double     r = ( U - prevU )/ ( myNormPar[ i ] - prevU );
 864
 865   double par = myFirst[i] * ( 1 - r ) + myLast[i] * r;
 866
 867   // check parametrization of curve
 868   if( !myIsUniform[i] )
 869   {
 870     double aLen3dU = r * myEdgeLength[i] * ( myFirst[i]>myLast[i] ? -1. : 1.);
 871     GCPnts_AbscissaPoint AbPnt
 872       ( const_cast<GeomAdaptor_Curve&>( myC3dAdaptor[i]), aLen3dU, myFirst[i] );
 873     if( AbPnt.IsDone() ) {
 874       par = AbPnt.Parameter();
 875     }
 876   }
 877   return myC3dAdaptor[ i ].Value(par);
 878 }
 879
 880 //================================================================================
 881 /*!
 882  * \brief Return wires of a face as StdMeshers_FaceSide's
 883  */
 884 //================================================================================
 885
 886 TSideVector StdMeshers_FaceSide::GetFaceWires(const TopoDS_Face&   theFace,
 887                                               SMESH_Mesh &         theMesh,
 888                                               const bool           theIgnoreMediumNodes,
 889                                               TError &             theError,
 890                                               SMESH_ProxyMesh::Ptr theProxyMesh)
 891 {
 892   list< TopoDS_Edge > edges, internalEdges;
 893   list< int > nbEdgesInWires;
 894   int nbWires = SMESH_Block::GetOrderedEdges (theFace, edges, nbEdgesInWires);
 895
 896   // split list of all edges into separate wires
 897   TSideVector wires( nbWires );
 898   list< int >::iterator nbE = nbEdgesInWires.begin();
 899   list< TopoDS_Edge >::iterator from = edges.begin(), to = from;
 900   for ( int iW = 0; iW < nbWires; ++iW, ++nbE )
 901   {
 902     std::advance( to, *nbE );
 903     if ( *nbE == 0 ) // Issue 0020676
 904     {
 905       --nbWires;
 906       --iW;
 907       wires.resize( nbWires );
 908       continue;
 909     }
 910     list< TopoDS_Edge > wireEdges( from, to );
 911     // assure that there is a node on the first vertex
 912     // as StdMeshers_FaceSide::GetUVPtStruct() requires
 913     if ( wireEdges.front().Orientation() != TopAbs_INTERNAL ) // Issue 0020676
 914     {
 915       while ( !SMESH_Algo::VertexNode( TopExp::FirstVertex( wireEdges.front(), true),
 916                                        theMesh.GetMeshDS()))
 917       {
 918         wireEdges.splice(wireEdges.end(), wireEdges,
 919                          wireEdges.begin(), ++wireEdges.begin());
 920         if ( from->IsSame( wireEdges.front() )) {
 921           theError = TError
 922             ( new SMESH_ComputeError(COMPERR_BAD_INPUT_MESH,"No nodes on vertices"));
 923           return TSideVector(0);
 924         }
 925       }
 926     }
 927     else if ( *nbE > 1 ) // Issue 0020676 (Face_pb_netgen.brep) - several internal edges in a wire
 928     {
 929       internalEdges.splice( internalEdges.end(), wireEdges, ++wireEdges.begin(), wireEdges.end());
 930     }
 931
 932     StdMeshers_FaceSide* wire = new StdMeshers_FaceSide( theFace, wireEdges, &theMesh,
 933                                                          /*isForward=*/true, theIgnoreMediumNodes,
 934                                                          theProxyMesh );
 935     wires[ iW ] = StdMeshers_FaceSidePtr( wire );
 936     from = to;
 937   }
 938   while ( !internalEdges.empty() )
 939   {
 940     StdMeshers_FaceSide* wire = new StdMeshers_FaceSide( theFace, internalEdges.back(), &theMesh,
 941                                                          /*isForward=*/true, theIgnoreMediumNodes,
 942                                                          theProxyMesh );
 943     wires.push_back( StdMeshers_FaceSidePtr( wire ));
 944     internalEdges.pop_back();
 945   }
 946   return wires;
 947 }
 948
 949 //================================================================================
 950 /*!
 951  * \brief Return 1st vertex of the i-the edge
 952  */
 953 //================================================================================
 954
 955 TopoDS_Vertex StdMeshers_FaceSide::FirstVertex(int i) const
 956 {
 957   TopoDS_Vertex v;
 958   if ( i < NbEdges() )
 959   {
 960     v = myEdge[i].Orientation() <= TopAbs_REVERSED ? // FORWARD || REVERSED
 961         TopExp::FirstVertex( myEdge[i], 1 )        :
 962         TopoDS::Vertex( TopoDS_Iterator( myEdge[i] ).Value() );
 963   }
 964   return v;
 965 }
 966
 967 //================================================================================
 968 /*!
 969  * \brief Return last vertex of the i-the edge
 970  */
 971 //================================================================================
 972
 973 TopoDS_Vertex StdMeshers_FaceSide::LastVertex(int i) const
 974 {
 975   TopoDS_Vertex v;
 976   if ( i < NbEdges() )
 977   {
 978     const TopoDS_Edge& edge = i<0 ? myEdge[ NbEdges() + i ] : myEdge[i];
 979     if ( edge.Orientation() <= TopAbs_REVERSED ) // FORWARD || REVERSED
 980       v = TopExp::LastVertex( edge, 1 );
 981     else
 982       for ( TopoDS_Iterator vIt( edge ); vIt.More(); vIt.Next() )
 983         v = TopoDS::Vertex( vIt.Value() );
 984   }
 985   return v;
 986 }
 987