src/StdMeshers/StdMeshers_FaceSide.cxx

   1 // Copyright (C) 2007-2012  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         // update normalized params
 362         if ( myEdge.size() > 1 ) {
 363           for ( size_t i = 0; i < edgeUVPtStruct.size(); ++i, ++iPt )
 364           {
 365             UVPtStruct & uvPt = points[iPt];
 366             uvPt.normParam = prevNormPar + uvPt.normParam * paramSize;
 367             uvPt.x = uvPt.y = uvPt.normParam;
 368           }
 369           --iPt; // to point to the 1st VERTEX of the next EDGE
 370         }
 371       }
 372       else
 373       {
 374         for ( ; u_node != u2node.end(); ++u_node, ++iPt )
 375         {
 376           if ( myNormPar[ iE ]-eps < u_node->first )
 377             break; // u_node is at VERTEX of the next EDGE
 378
 379           UVPtStruct & uvPt = points[iPt];
 380           uvPt.node       = u_node->second;
 381           // -- normParam, x, y --------------------------------
 382           uvPt.normParam  = u_node->first;
 383           uvPt.x = uvPt.y = uvPt.normParam;
 384           // -- U ----------------------------------------------
 385           const SMDS_EdgePosition* epos =
 386             dynamic_cast<const SMDS_EdgePosition*>(uvPt.node->GetPosition());
 387           if ( epos ) {
 388             uvPt.param = epos->GetUParameter();
 389           }
 390           else {
 391             double r = ( uvPt.normParam - prevNormPar )/ paramSize;
 392             uvPt.param = ( r > 0.5 ? myLast[iE] : myFirst[iE] );
 393           }
 394           // -- UV ---------------------------------------------
 395           if ( !myC2d[ iE ].IsNull() ) {
 396             gp_Pnt2d p = myC2d[ iE ]->Value( uvPt.param );
 397             uvPt.u = p.X();
 398             uvPt.v = p.Y();
 399           }
 400           else {
 401             uvPt.u = uvPt.v = 1e+100;
 402           }
 403         }
 404       }
 405       // prepare for the next EDGE
 406       if ( iE+1 < myEdge.size() )
 407       {
 408         prevNormPar = myNormPar[ iE ];
 409         paramSize   = myNormPar[ iE+1 ] - prevNormPar;
 410       }
 411     } // loop on myEdge's
 412
 413     // set <constValue>
 414     if ( isXConst )
 415       for ( iPt = 0; iPt < points.size(); ++iPt ) points[ iPt ].x = constValue;
 416     else
 417       for ( iPt = 0; iPt < points.size(); ++iPt ) points[ iPt ].y = constValue;
 418
 419   } // if ( myPoints.empty())
 420
 421   return myPoints;
 422 }
 423
 424 //================================================================================
 425 /*!
 426  * \brief Falsificate info on nodes
 427  * \param nbSeg - nb of segments on the side
 428  * \retval UVPtStruct* - array of data structures
 429  */
 430 //================================================================================
 431
 432 const vector<UVPtStruct>& StdMeshers_FaceSide::SimulateUVPtStruct(int    nbSeg,
 433                                                                   bool   isXConst,
 434                                                                   double constValue) const
 435 {
 436   if ( myFalsePoints.empty() ) {
 437
 438     if ( NbEdges() == 0 ) return myFalsePoints;
 439
 440     vector<uvPtStruct>* points = const_cast<vector<uvPtStruct>*>( &myFalsePoints );
 441     points->resize( nbSeg+1 );
 442
 443     int EdgeIndex = 0;
 444     double prevNormPar = 0, paramSize = myNormPar[ EdgeIndex ];
 445     for (int i = 0 ; i < myFalsePoints.size(); ++i ) {
 446       double normPar = double(i) / double(nbSeg);
 447       UVPtStruct & uvPt = (*points)[i];
 448       uvPt.node = 0;
 449       uvPt.x = uvPt.y = uvPt.param = uvPt.normParam = normPar;
 450       if ( isXConst ) uvPt.x = constValue;
 451       else            uvPt.y = constValue;
 452       if ( myNormPar[ EdgeIndex ] < normPar ) {
 453         prevNormPar = myNormPar[ EdgeIndex ];
 454         ++EdgeIndex;
 455         paramSize = myNormPar[ EdgeIndex ] - prevNormPar;
 456       }
 457       double r = ( normPar - prevNormPar )/ paramSize;
 458       uvPt.param = myFirst[EdgeIndex] * ( 1 - r ) + myLast[EdgeIndex] * r;
 459       if ( !myC2d[ EdgeIndex ].IsNull() ) {
 460         gp_Pnt2d p = myC2d[ EdgeIndex ]->Value( uvPt.param );
 461         uvPt.u = p.X();
 462         uvPt.v = p.Y();
 463       }
 464       else {
 465         uvPt.u = uvPt.v = 1e+100;
 466       }
 467     }
 468   }
 469   return myFalsePoints;
 470 }
 471
 472 //=======================================================================
 473 //function : GetOrderedNodes
 474 //purpose  : Return nodes in the order they encounter while walking along the side
 475 //=======================================================================
 476
 477 std::vector<const SMDS_MeshNode*> StdMeshers_FaceSide::GetOrderedNodes() const
 478 {
 479   vector<const SMDS_MeshNode*> resultNodes;
 480   if ( myPoints.empty() )
 481   {
 482     if ( NbEdges() == 0 ) return resultNodes;
 483
 484     SMESHDS_Mesh* meshDS = myProxyMesh->GetMeshDS();
 485     SMESH_MesherHelper helper(*myProxyMesh->GetMesh());
 486     bool paramOK;
 487
 488     // Sort nodes of all edges putting them into a map
 489
 490     map< double, const SMDS_MeshNode*> u2node;
 491     for ( int i = 0; i < myEdge.size(); ++i )
 492     {
 493       // Put 1st vertex node of a current edge
 494       TopoDS_Vertex VV[2]; // TopExp::FirstVertex() returns NULL for INTERNAL edge
 495       VV[0] = SMESH_MesherHelper::IthVertex( 0, myEdge[i]);
 496       VV[1] = SMESH_MesherHelper::IthVertex( 1, myEdge[i]);
 497       const SMDS_MeshNode* node = SMESH_Algo::VertexNode( VV[0], meshDS );
 498       double prevNormPar = ( i == 0 ? 0 : myNormPar[ i-1 ]); // normalized param
 499       if ( node ) { // nodes on internal vertices may be missing
 500         u2node.insert( make_pair( prevNormPar, node ));
 501       }
 502       else if ( i == 0 ) {
 503         MESSAGE(" NO NODE on VERTEX" );
 504         return resultNodes;
 505       }
 506
 507       // Put internal nodes
 508       if ( SMESHDS_SubMesh* sm = meshDS->MeshElements( myEdge[i] ))
 509       {
 510         SMDS_NodeIteratorPtr nItr = sm->GetNodes();
 511         double paramSize = myLast[i] - myFirst[i];
 512         double r         = myNormPar[i] - prevNormPar;
 513         helper.SetSubShape( myEdge[i] );
 514         helper.ToFixNodeParameters( true );
 515         while ( nItr->more() )
 516         {
 517           const SMDS_MeshNode* node = nItr->next();
 518           if ( myIgnoreMediumNodes && SMESH_MeshEditor::IsMedium( node, SMDSAbs_Edge ))
 519             continue;
 520           double u = helper.GetNodeU( myEdge[i], node, 0, &paramOK );
 521
 522           // paramSize is signed so orientation is taken into account
 523           double normPar = prevNormPar + r * ( u - myFirst[i] ) / paramSize;
 524           u2node.insert( u2node.end(), make_pair( normPar, node ));
 525         }
 526       }
 527
 528       // Put 2nd vertex node for a last edge
 529       if ( i+1 == myEdge.size() ) {
 530         node = SMESH_Algo::VertexNode( VV[1], meshDS );
 531         if ( !node ) {
 532           return resultNodes;
 533         }
 534         u2node.insert( u2node.end(), make_pair( 1., node ));
 535       }
 536     }
 537
 538     // Fill the result vector
 539
 540     if ( u2node.size() == myNbPonits )
 541     {
 542       resultNodes.reserve( u2node.size() );
 543       map< double, const SMDS_MeshNode*>::iterator u2n = u2node.begin();
 544       for ( ; u2n != u2node.end(); ++u2n )
 545         resultNodes.push_back( u2n->second );
 546     }
 547   }
 548   else
 549   {
 550     resultNodes.resize( myPoints.size() );
 551     for ( size_t i = 0; i < myPoints.size(); ++i )
 552       resultNodes[i] = myPoints[i].node;
 553   }
 554
 555   return resultNodes;
 556 }
 557
 558 //================================================================================
 559 /*!
 560  * \brief reverse order of vector elements
 561   * \param vec - vector to reverse
 562  */
 563 //================================================================================
 564
 565 template <typename T > void reverse(vector<T> & vec)
 566 {
 567   for ( int f=0, r=vec.size()-1; f < r; ++f, --r )
 568     std::swap( vec[f], vec[r] );
 569 }
 570
 571 //================================================================================
 572 /*!
 573  * \brief Change orientation of side geometry
 574  */
 575 //================================================================================
 576
 577 void StdMeshers_FaceSide::Reverse()
 578 {
 579   int nbEdges = myEdge.size();
 580   for ( int i = nbEdges-1; i >= 0; --i ) {
 581     std::swap( myFirst[i], myLast[i] );
 582     myEdge[i].Reverse();
 583     if ( i > 0 ) // at the first loop 1. is overwritten
 584       myNormPar[i] = 1 - myNormPar[i-1];
 585   }
 586   if ( nbEdges > 1 ) {
 587     reverse( myEdge );
 588     reverse( myEdgeID );
 589     reverse( myC2d );
 590     //reverse( myC3dAdaptor );
 591     reverse( myFirst );
 592     reverse( myLast );
 593     reverse( myNormPar );
 594     reverse( myEdgeLength );
 595     reverse( myIsUniform );
 596   }
 597   if ( nbEdges > 0 )
 598   {
 599     myNormPar[nbEdges-1]=1.;
 600     myPoints.clear();
 601     myFalsePoints.clear();
 602     for ( size_t i = 0; i < myEdge.size(); ++i )
 603       reverseProxySubmesh( myEdge[i] );
 604   }
 605   for ( size_t i = 0; i < myEdge.size(); ++i )
 606   {
 607     double fp,lp;
 608     Handle(Geom_Curve) C3d = BRep_Tool::Curve(myEdge[i],fp,lp);
 609     if ( !C3d.IsNull() )
 610       myC3dAdaptor[i].Load( C3d, fp,lp );
 611   }
 612 }
 613
 614 //=======================================================================
 615 //function : SetIgnoreMediumNodes
 616 //purpose  : Make ignore medium nodes
 617 //=======================================================================
 618
 619 void StdMeshers_FaceSide::SetIgnoreMediumNodes(bool toIgnore)
 620 {
 621   if ( myIgnoreMediumNodes != toIgnore )
 622   {
 623     myIgnoreMediumNodes = toIgnore;
 624
 625     if ( !myPoints.empty() )
 626     {
 627       UVPtStructVec newPoints;
 628       newPoints.reserve( myPoints.size()/2 + 1 );
 629       for ( size_t i = 0; i < myPoints.size(); i += 2 )
 630         newPoints.push_back( myPoints[i] );
 631
 632       myPoints.swap( newPoints );
 633     }
 634     else
 635     {
 636       NbPoints( /*update=*/true );
 637     }
 638   }
 639 }
 640
 641 //=======================================================================
 642 //function : NbPoints
 643 //purpose  : Return nb nodes on edges and vertices (+1 to be == GetUVPtStruct().size() )
 644 //           Call it with update == true if mesh of this side can be recomputed
 645 //           since creation of this side
 646 //=======================================================================
 647
 648 int StdMeshers_FaceSide::NbPoints(const bool update) const
 649 {
 650   if ( !myPoints.empty() )
 651     return myPoints.size();
 652
 653   // if ( !myFalsePoints.empty() )
 654   //   return myFalsePoints.size();
 655
 656   if ( update && myEdge.size() > 0 )
 657   {
 658     StdMeshers_FaceSide* me = (StdMeshers_FaceSide*) this;
 659     me->myNbPonits = 0;
 660     me->myNbSegments = 0;
 661     me->myMissingVertexNodes = false;
 662
 663     for ( int i = 0; i < NbEdges(); ++i )
 664     {
 665       TopoDS_Vertex v1 = SMESH_MesherHelper::IthVertex( 0, myEdge[i] );
 666       if ( SMESH_Algo::VertexNode( v1, myProxyMesh->GetMeshDS() ))
 667         me->myNbPonits += 1; // for the first end
 668       else
 669         me->myMissingVertexNodes = true;
 670
 671       if ( const SMESHDS_SubMesh* sm = myProxyMesh->GetSubMesh( Edge(i) )) {
 672         int nbN = sm->NbNodes();
 673         if ( myIgnoreMediumNodes ) {
 674           SMDS_ElemIteratorPtr elemIt = sm->GetElements();
 675           if ( elemIt->more() && elemIt->next()->IsQuadratic() )
 676             nbN -= sm->NbElements();
 677         }
 678         me->myNbPonits   += nbN;
 679         me->myNbSegments += sm->NbElements();
 680       }
 681     }
 682     TopoDS_Vertex v1 = SMESH_MesherHelper::IthVertex( 1, Edge( NbEdges()-1 ));
 683     if ( SMESH_Algo::VertexNode( v1, myProxyMesh->GetMeshDS() ))
 684       me->myNbPonits++; // for the last end
 685     else
 686       me->myMissingVertexNodes = true;
 687   }
 688   return myNbPonits;
 689 }
 690
 691 //=======================================================================
 692 //function : NbSegments
 693 //purpose  : Return nb edges
 694 //           Call it with update == true if mesh of this side can be recomputed
 695 //           since creation of this side
 696 //=======================================================================
 697
 698 int StdMeshers_FaceSide::NbSegments(const bool update) const
 699 {
 700   return NbPoints( update ), myNbSegments;
 701 }
 702
 703 //================================================================================
 704 /*!
 705  * \brief Reverse UVPtStructVec if a proxy sub-mesh of E
 706  */
 707 //================================================================================
 708
 709 void StdMeshers_FaceSide::reverseProxySubmesh( const TopoDS_Edge& E )
 710 {
 711   if ( !myProxyMesh ) return;
 712   if ( const SMESH_ProxyMesh::SubMesh* sm = myProxyMesh->GetProxySubMesh( E ))
 713   {
 714     UVPtStructVec& edgeUVPtStruct = (UVPtStructVec& ) sm->GetUVPtStructVec();
 715     for ( size_t i = 0; i < edgeUVPtStruct.size(); ++i )
 716     {
 717       UVPtStruct & uvPt = edgeUVPtStruct[i];
 718       uvPt.normParam = 1 - uvPt.normParam;
 719       uvPt.x         = 1 - uvPt.x;
 720       uvPt.y         = 1 - uvPt.y;
 721     }
 722     reverse( edgeUVPtStruct );
 723   }
 724 }
 725
 726 //================================================================================
 727 /*!
 728  * \brief Show side features
 729  */
 730 //================================================================================
 731
 732 void StdMeshers_FaceSide::dump(const char* msg) const
 733 {
 734 #ifdef _DEBUG_
 735   if (msg) MESSAGE ( std::endl << msg );
 736   MESSAGE_BEGIN ("NB EDGES: "<< myEdge.size() );
 737   MESSAGE_ADD ( "nbPoints: "<<myNbPonits<<" vecSize: " << myPoints.size()<<" "<<myFalsePoints.size() );
 738   for ( int i=0; i<myEdge.size(); ++i)
 739   {
 740     MESSAGE_ADD ( "\t"<<i+1 );
 741     MESSAGE_ADD ( "\tEDGE: " );
 742     if (myEdge[i].IsNull()) {
 743       MESSAGE_ADD ( "NULL" );
 744     }
 745     else {
 746       TopAbs::Print(myEdge[i].Orientation(),cout)<<" "<<myEdge[i].TShape().operator->()<<endl;
 747       MESSAGE_ADD ( "\tV1: " << TopExp::FirstVertex( myEdge[i], 1).TShape().operator->()
 748                  << "  V2: " << TopExp::LastVertex( myEdge[i], 1).TShape().operator->() );
 749     }
 750     MESSAGE_ADD ( "\tC2d: ");
 751
 752     if (myC2d[i].IsNull()) {
 753       MESSAGE_ADD ( "NULL" );
 754     }
 755     else {
 756       MESSAGE_ADD ( myC2d[i].operator->() );
 757     }
 758
 759     MESSAGE_ADD ( "\tF: "<<myFirst[i]<< " L: "<< myLast[i] );
 760     MESSAGE_END ( "\tnormPar: "<<myNormPar[i]<<endl );
 761   }
 762 #endif
 763 }
 764
 765 //================================================================================
 766 /*!
 767  * \brief Creates a Adaptor2d_Curve2d to be used in SMESH_Block
 768   * \retval Adaptor2d_Curve2d* -
 769  */
 770 //================================================================================
 771
 772 struct Adaptor2dCurve2d : public Adaptor2d_Curve2d
 773 {
 774   const StdMeshers_FaceSide* mySide;
 775   Adaptor2dCurve2d(const StdMeshers_FaceSide* faceSide):mySide(faceSide) {}
 776   gp_Pnt2d Value(const Standard_Real U) const { return mySide->Value2d( U ); }
 777   Standard_Real FirstParameter() const { return 0; }
 778   Standard_Real LastParameter() const { return 1; }
 779 };
 780
 781 Adaptor2d_Curve2d* StdMeshers_FaceSide::GetCurve2d() const
 782 {
 783   return new Adaptor2dCurve2d( this );
 784 }
 785
 786 //================================================================================
 787 /*!
 788  * \brief Creates a fully functional Adaptor_Curve
 789  */
 790 //================================================================================
 791
 792 BRepAdaptor_CompCurve* StdMeshers_FaceSide::GetCurve3d() const
 793 {
 794   if ( myEdge.empty() )
 795     return 0;
 796
 797   TopoDS_Wire aWire;
 798   BRep_Builder aBuilder;
 799   aBuilder.MakeWire(aWire);
 800   for ( int i=0; i<myEdge.size(); ++i )
 801     aBuilder.Add( aWire, myEdge[i] );
 802
 803   if ( myEdge.size() == 2 && FirstVertex().IsSame( LastVertex() ))
 804     aWire.Closed(true); // issue 0021141
 805
 806   return new BRepAdaptor_CompCurve( aWire );
 807 }
 808
 809 //================================================================================
 810 /*!
 811  * \brief Return 2D point by normalized parameter
 812   * \param U - normalized parameter value
 813   * \retval gp_Pnt2d - point
 814  */
 815 //================================================================================
 816
 817 gp_Pnt2d StdMeshers_FaceSide::Value2d(double U) const
 818 {
 819   if ( !myC2d[0].IsNull() ) {
 820     int i = EdgeIndex( U );
 821     double prevU = i ? myNormPar[ i-1 ] : 0;
 822     double r = ( U - prevU )/ ( myNormPar[ i ] - prevU );
 823
 824     double par = myFirst[i] * ( 1 - r ) + myLast[i] * r;
 825
 826     // check parametrization of curve
 827     if( !myIsUniform[i] )
 828     {
 829       double aLen3dU = r * myEdgeLength[i] * ( myFirst[i]>myLast[i] ? -1. : 1.);
 830       GCPnts_AbscissaPoint AbPnt
 831         ( const_cast<GeomAdaptor_Curve&>( myC3dAdaptor[i]), aLen3dU, myFirst[i] );
 832       if( AbPnt.IsDone() ) {
 833         par = AbPnt.Parameter();
 834       }
 835     }
 836     return myC2d[ i ]->Value(par);
 837
 838   }
 839   return myDefaultPnt2d;
 840 }
 841
 842 //================================================================================
 843 /*!
 844  * \brief Return XYZ by normalized parameter
 845   * \param U - normalized parameter value
 846   * \retval gp_Pnt - point
 847  */
 848 //================================================================================
 849
 850 gp_Pnt StdMeshers_FaceSide::Value3d(double U) const
 851 {
 852   int        i = EdgeIndex( U );
 853   double prevU = i ? myNormPar[ i-1 ] : 0;
 854   double     r = ( U - prevU )/ ( myNormPar[ i ] - prevU );
 855
 856   double par = myFirst[i] * ( 1 - r ) + myLast[i] * r;
 857
 858   // check parametrization of curve
 859   if( !myIsUniform[i] )
 860   {
 861     double aLen3dU = r * myEdgeLength[i] * ( myFirst[i]>myLast[i] ? -1. : 1.);
 862     GCPnts_AbscissaPoint AbPnt
 863       ( const_cast<GeomAdaptor_Curve&>( myC3dAdaptor[i]), aLen3dU, myFirst[i] );
 864     if( AbPnt.IsDone() ) {
 865       par = AbPnt.Parameter();
 866     }
 867   }
 868   return myC3dAdaptor[ i ].Value(par);
 869 }
 870
 871 //================================================================================
 872 /*!
 873  * \brief Return wires of a face as StdMeshers_FaceSide's
 874  */
 875 //================================================================================
 876
 877 TSideVector StdMeshers_FaceSide::GetFaceWires(const TopoDS_Face&   theFace,
 878                                               SMESH_Mesh &         theMesh,
 879                                               const bool           theIgnoreMediumNodes,
 880                                               TError &             theError,
 881                                               SMESH_ProxyMesh::Ptr theProxyMesh)
 882 {
 883   list< TopoDS_Edge > edges, internalEdges;
 884   list< int > nbEdgesInWires;
 885   int nbWires = SMESH_Block::GetOrderedEdges (theFace, edges, nbEdgesInWires);
 886
 887   // split list of all edges into separate wires
 888   TSideVector wires( nbWires );
 889   list< int >::iterator nbE = nbEdgesInWires.begin();
 890   list< TopoDS_Edge >::iterator from = edges.begin(), to = from;
 891   for ( int iW = 0; iW < nbWires; ++iW, ++nbE )
 892   {
 893     std::advance( to, *nbE );
 894     if ( *nbE == 0 ) // Issue 0020676
 895     {
 896       --nbWires;
 897       --iW;
 898       wires.resize( nbWires );
 899       continue;
 900     }
 901     list< TopoDS_Edge > wireEdges( from, to );
 902     // assure that there is a node on the first vertex
 903     // as StdMeshers_FaceSide::GetUVPtStruct() requires
 904     if ( wireEdges.front().Orientation() != TopAbs_INTERNAL ) // Issue 0020676
 905     {
 906       while ( !SMESH_Algo::VertexNode( TopExp::FirstVertex( wireEdges.front(), true),
 907                                        theMesh.GetMeshDS()))
 908       {
 909         wireEdges.splice(wireEdges.end(), wireEdges,
 910                          wireEdges.begin(), ++wireEdges.begin());
 911         if ( from->IsSame( wireEdges.front() )) {
 912           theError = TError
 913             ( new SMESH_ComputeError(COMPERR_BAD_INPUT_MESH,"No nodes on vertices"));
 914           return TSideVector(0);
 915         }
 916       }
 917     }
 918     else if ( *nbE > 1 ) // Issue 0020676 (Face_pb_netgen.brep) - several internal edges in a wire
 919     {
 920       internalEdges.splice( internalEdges.end(), wireEdges, ++wireEdges.begin(), wireEdges.end());
 921     }
 922
 923     StdMeshers_FaceSide* wire = new StdMeshers_FaceSide( theFace, wireEdges, &theMesh,
 924                                                          /*isForward=*/true, theIgnoreMediumNodes,
 925                                                          theProxyMesh );
 926     wires[ iW ] = StdMeshers_FaceSidePtr( wire );
 927     from = to;
 928   }
 929   while ( !internalEdges.empty() )
 930   {
 931     StdMeshers_FaceSide* wire = new StdMeshers_FaceSide( theFace, internalEdges.back(), &theMesh,
 932                                                          /*isForward=*/true, theIgnoreMediumNodes,
 933                                                          theProxyMesh );
 934     wires.push_back( StdMeshers_FaceSidePtr( wire ));
 935     internalEdges.pop_back();
 936   }
 937   return wires;
 938 }
 939
 940 //================================================================================
 941 /*!
 942  * \brief Return 1st vertex of the i-the edge
 943  */
 944 //================================================================================
 945
 946 TopoDS_Vertex StdMeshers_FaceSide::FirstVertex(int i) const
 947 {
 948   TopoDS_Vertex v;
 949   if ( i < NbEdges() )
 950   {
 951     v = myEdge[i].Orientation() <= TopAbs_REVERSED ? // FORWARD || REVERSED
 952         TopExp::FirstVertex( myEdge[i], 1 )        :
 953         TopoDS::Vertex( TopoDS_Iterator( myEdge[i] ).Value() );
 954   }
 955   return v;
 956 }
 957
 958 //================================================================================
 959 /*!
 960  * \brief Return last vertex of the i-the edge
 961  */
 962 //================================================================================
 963
 964 TopoDS_Vertex StdMeshers_FaceSide::LastVertex(int i) const
 965 {
 966   TopoDS_Vertex v;
 967   if ( i < NbEdges() )
 968   {
 969     const TopoDS_Edge& edge = i<0 ? myEdge[ NbEdges() + i ] : myEdge[i];
 970     if ( edge.Orientation() <= TopAbs_REVERSED ) // FORWARD || REVERSED
 971       v = TopExp::LastVertex( edge, 1 );
 972     else
 973       for ( TopoDS_Iterator vIt( edge ); vIt.More(); vIt.Next() )
 974         v = TopoDS::Vertex( vIt.Value() );
 975   }
 976   return v;
 977 }
 978