+ struct QuadMesh : public SMESH_SequentialMesh
+ {
+ ObjectPool< TriaCoordSys > _traiLCSPool;
+ SMESH_ElementSearcher* _elemSearcher;
+ SMESH_Gen _sgen;
+ SMESH_MesherHelper _helper;
+
+ QuadMesh(const TopoDS_Face& face):
+ _elemSearcher( nullptr ), _helper( *this )
+ {
+ _meshDS = new SMESHDS_Mesh( 0, true );
+ _gen = &_sgen;
+ ShapeToMesh( face );
+ }
+ ~QuadMesh() { delete _elemSearcher; }
+
+ // --------------------------------------------------------------------------------
+ /*!
+ * \brief Compute quadrangle mesh and prepare for face search
+ */
+ bool Compute( const TSideVector& wires, int nbSeg1, int nbSeg2, bool isSourceMesh )
+ {
+ if ( wires.size() > 1 || wires[0]->NbEdges() != 4 )
+ return false;
+
+ // compute quadrangle mesh
+
+ SMESH_Hypothesis* algo1D = new StdMeshers_Regular_1D( _sgen.GetANewId(), &_sgen );
+ AddHypothesis( GetShapeToMesh(), algo1D->GetID() );
+
+ StdMeshers_NumberOfSegments * nbHyp1, *nbHyp2;
+ nbHyp1 = new StdMeshers_NumberOfSegments( _sgen.GetANewId(), &_sgen );
+ nbHyp1->SetNumberOfSegments( nbSeg1 );
+ AddHypothesis( wires[0]->Edge(0), nbHyp1->GetID() );
+ AddHypothesis( wires[0]->Edge(2), nbHyp1->GetID() );
+
+ nbHyp2 = new StdMeshers_NumberOfSegments( _sgen.GetANewId(), &_sgen );
+ nbHyp2->SetNumberOfSegments( nbSeg2 );
+ AddHypothesis( wires[0]->Edge(1), nbHyp2->GetID() );
+ AddHypothesis( wires[0]->Edge(3), nbHyp2->GetID() );
+
+ if ( !_sgen.Compute( *this, GetShapeToMesh(), SMESH_Gen::SHAPE_ONLY_UPWARD ))
+ return false;
+
+ QuadAlgo algo2D( _sgen.GetANewId(), &_sgen );
+ if ( !algo2D.Compute( _helper, wires[0] ))
+ return false;
+
+ // remove edges
+ // for ( SMDS_ElemIteratorPtr eIt = _meshDS->elementsIterator( SMDSAbs_Edge ); eIt->more(); )
+ // _meshDS->RemoveFreeElement( eIt->next(), /*sm=*/0, /*groups=*/false );
+
+ // _meshDS->Modified(); // setMyModified();
+ // _meshDS->CompactMesh();
+
+ // create TriaCoordSys for every triangle
+ if ( isSourceMesh )
+ {
+ for ( SMDS_ElemIteratorPtr fIt = _meshDS->elementsIterator( SMDSAbs_Face ); fIt->more(); )
+ {
+ const SMDS_MeshElement* tria = fIt->next();
+ TriaCoordSys* triaLCS = _traiLCSPool.getNew();
+ triaLCS->Init( SMESH_NodeXYZ( tria->GetNode( 0 )),
+ SMESH_NodeXYZ( tria->GetNode( 1 )),
+ SMESH_NodeXYZ( tria->GetNode( 2 )));
+ // int i= tria->GetID() - NbEdges() - 1;
+ // cout << "ID from TRIA " << i << " - poolSize " << _traiLCSPool.nbElements() <<
+ // ( _traiLCSPool[i]!= triaLCS ? " KO" : "" ) << endl;
+ }
+ _elemSearcher = SMESH_MeshAlgos::GetElementSearcher( *_meshDS );
+ }
+ return true;
+ }
+ // --------------------------------------------------------------------------------
+ /*!
+ * \brief Find a source triangle including a point and return its barycentric coordinates
+ */
+ const SMDS_MeshElement* FindFaceByPoint( const gp_Pnt p,
+ double & bc1, double & bc2, double & bc3 )
+ {
+ const SMDS_MeshElement* tria = nullptr;
+ gp_XYZ projPnt = _elemSearcher->Project( p, SMDSAbs_Face, &tria );
+
+ int lcsID = tria->GetID() - NbEdges() - 1;
+ const TriaCoordSys* triaLCS = _traiLCSPool[ lcsID ];
+ triaLCS->GetBaryCoords( projPnt, bc1, bc2, bc3 );
+
+ return tria;
+ }
+ // --------------------------------------------------------------------------------
+ /*!
+ * \brief Return a point lying on a corresponding target triangle
+ */
+ gp_Pnt GetPoint( const SMDS_MeshElement* srcTria, double & bc1, double & bc2, double & bc3 )
+ {
+ const SMDS_MeshElement* tgtTria = _meshDS->FindElement( srcTria->GetID() );
+ gp_Pnt p = ( bc1 * SMESH_NodeXYZ( tgtTria->GetNode(0) ) +
+ bc2 * SMESH_NodeXYZ( tgtTria->GetNode(1) ) +
+ bc3 * SMESH_NodeXYZ( tgtTria->GetNode(2) ) );
+ return p;
+ }
+ // --------------------------------------------------------------------------------
+ /*!
+ * \brief Return an UV of point lying on a corresponding target triangle
+ */
+ gp_XY GetUV( const SMDS_MeshElement* srcTria,
+ double & bc1, double & bc2, double & bc3 )
+ {
+ const SMDS_MeshElement* tgtTria = _meshDS->FindElement( srcTria->GetID() );
+ TopoDS_Shape tgtShape = GetShapeToMesh();
+ const TopoDS_Face& face = TopoDS::Face( tgtShape );
+
+ gp_XY p = ( bc1 * _helper.GetNodeUV( face, tgtTria->GetNode(0) ) +
+ bc2 * _helper.GetNodeUV( face, tgtTria->GetNode(1) ) +
+ bc3 * _helper.GetNodeUV( face, tgtTria->GetNode(2) ) );
+ return p;
+ }
+ };
+
+ //================================================================================
+ /*!
+ * \brief Calculate average size of faces
+ * Actually calculate average of min and max face size
+ */
+ //================================================================================
+
+ double calcAverageFaceSize( SMESHDS_SubMesh* sm )
+ {
+ double minLen = Precision::Infinite(), maxLen = 0;
+ for ( SMDS_ElemIteratorPtr fIt = sm->GetElements(); fIt->more(); )
+ {
+ const SMDS_MeshElement* face = fIt->next();
+ int nbNodes = face->NbCornerNodes();
+ gp_XYZ pPrev = SMESH_NodeXYZ( face->GetNode( nbNodes - 1 ));
+ for ( int i = 0; i < nbNodes; ++i )
+ {
+ SMESH_NodeXYZ p( face->GetNode( i ));
+ double len = ( p - pPrev ).SquareModulus();
+ minLen = Min( len, minLen );
+ maxLen = Max( len, maxLen );
+ pPrev = p;
+ }
+ }
+ return 0.5 * ( Sqrt( minLen ) + Sqrt( maxLen ));
+ }
+
+ //================================================================================
+ /*!
+ * \brief Perform projection from a quadrilateral FACE to another quadrilateral one
+ */
+ //================================================================================
+
+ bool projectQuads(const TopoDS_Face& tgtFace,
+ const TopoDS_Face& srcFace,
+ const TSideVector& tgtWires,
+ const TSideVector& srcWires,
+ const TAssocTool::TShapeShapeMap& shape2ShapeMap,
+ TAssocTool::TNodeNodeMap& src2tgtNodes,
+ const bool is1DComputed)
+ {
+ SMESH_Mesh * tgtMesh = tgtWires[0]->GetMesh();
+ SMESH_Mesh * srcMesh = srcWires[0]->GetMesh();
+ SMESHDS_Mesh * tgtMeshDS = tgtMesh->GetMeshDS();
+ SMESHDS_Mesh * srcMeshDS = srcMesh->GetMeshDS();
+
+ if ( srcWires.size() != 1 || // requirements below can be weaken
+ SMESH_MesherHelper::Count( tgtFace, TopAbs_EDGE, /*ignoreSame=*/true) != 4 ||
+ SMESH_MesherHelper::Count( srcFace, TopAbs_EDGE, /*ignoreSame=*/true) != 4 )
+ return false;
+
+ // make auxiliary structured meshes that will be used to get corresponding
+ // points on the target FACE
+ QuadMesh srcQuadMesh( srcFace ), tgtQuadMesh( tgtFace );
+ double avgSize = calcAverageFaceSize( srcMeshDS->MeshElements( srcFace ));
+ int nbSeg1 = (int) Max( 2., Max( srcWires[0]->EdgeLength(0),
+ srcWires[0]->EdgeLength(2)) / avgSize );
+ int nbSeg2 = (int) Max( 2., Max( srcWires[0]->EdgeLength(1),
+ srcWires[0]->EdgeLength(3)) / avgSize );
+ if ( !srcQuadMesh.Compute( srcWires, nbSeg1, nbSeg2, /*isSrc=*/true ) ||
+ !tgtQuadMesh.Compute( tgtWires, nbSeg1, nbSeg2, /*isSrc=*/false ))
+ return false;
+
+ // Make new faces
+
+ // prepare the helper to adding quadratic elements if necessary
+ SMESH_MesherHelper* helper = tgtWires[0]->FaceHelper();
+ helper->IsQuadraticSubMesh( tgtFace );
+
+ SMESHDS_SubMesh* srcSubDS = srcMeshDS->MeshElements( srcFace );
+ if ( !is1DComputed && srcSubDS->NbElements() )
+ helper->SetIsQuadratic( srcSubDS->GetElements()->next()->IsQuadratic() );
+
+ SMESH_MesherHelper* srcHelper = srcWires[0]->FaceHelper();
+ SMESH_MesherHelper edgeHelper( *tgtMesh );
+ edgeHelper.ToFixNodeParameters( true );
+
+ const SMDS_MeshNode* nullNode = 0;
+ TAssocTool::TNodeNodeMap::iterator srcN_tgtN;
+
+ SMDS_ElemIteratorPtr elemIt = srcSubDS->GetElements();
+ vector< const SMDS_MeshNode* > tgtNodes;
+ while ( elemIt->more() ) // loop on all mesh faces on srcFace
+ {
+ const SMDS_MeshElement* elem = elemIt->next();
+ const int nbN = elem->NbCornerNodes();
+ tgtNodes.resize( nbN );
+ helper->SetElementsOnShape( false );
+ for ( int i = 0; i < nbN; ++i ) // loop on nodes of the source element
+ {
+ const SMDS_MeshNode* srcNode = elem->GetNode(i);
+ srcN_tgtN = src2tgtNodes.insert( make_pair( srcNode, nullNode )).first;
+ if ( srcN_tgtN->second == nullNode )
+ {
+ // create a new node
+ gp_Pnt srcP = SMESH_TNodeXYZ( srcNode );
+ double bc[3];
+ const SMDS_MeshElement* auxF = srcQuadMesh.FindFaceByPoint( srcP, bc[0], bc[1], bc[2] );
+ gp_Pnt tgtP = tgtQuadMesh.GetPoint( auxF, bc[0], bc[1], bc[2] );
+ SMDS_MeshNode* n = helper->AddNode( tgtP.X(), tgtP.Y(), tgtP.Z() );
+ srcN_tgtN->second = n;
+ switch ( srcNode->GetPosition()->GetTypeOfPosition() )
+ {
+ case SMDS_TOP_FACE:
+ {
+ gp_XY tgtUV = tgtQuadMesh.GetUV( auxF, bc[0], bc[1], bc[2] );
+ tgtMeshDS->SetNodeOnFace( n, helper->GetSubShapeID(), tgtUV.X(), tgtUV.Y() );
+ break;
+ }
+ case SMDS_TOP_EDGE:
+ {
+ const TopoDS_Edge& srcE = TopoDS::Edge( srcMeshDS->IndexToShape( srcNode->GetShapeID()));
+ const TopoDS_Edge& tgtE = TopoDS::Edge( shape2ShapeMap( srcE, /*isSrc=*/true ));
+ double srcU = srcHelper->GetNodeU( srcE, srcNode );
+ tgtMeshDS->SetNodeOnEdge( n, tgtE, srcU );
+ edgeHelper.SetSubShape( tgtE );
+ double tol = BRep_Tool::MaxTolerance( tgtE, TopAbs_VERTEX ), distXYZ[4];
+ /*isOk = */edgeHelper.CheckNodeU( tgtE, n, srcU, 2 * tol, /*force=*/true, distXYZ );
+ //if ( isOk )
+ tgtMeshDS->MoveNode( n, distXYZ[1], distXYZ[2], distXYZ[3] );
+ SMDS_EdgePositionPtr( n->GetPosition() )->SetUParameter( srcU );
+ break;
+ }
+ case SMDS_TOP_VERTEX:
+ {
+ const TopoDS_Shape & srcV = srcMeshDS->IndexToShape( srcNode->getshapeId() );
+ const TopoDS_Shape & tgtV = shape2ShapeMap( srcV, /*isSrc=*/true );
+ tgtP = BRep_Tool::Pnt( TopoDS::Vertex( tgtV ));
+ tgtMeshDS->MoveNode( n, tgtP.X(), tgtP.Y(), tgtP.Z() );
+ tgtMeshDS->SetNodeOnVertex( n, TopoDS::Vertex( tgtV ));
+ break;
+ }
+ default:;
+ }
+ }
+ tgtNodes[i] = srcN_tgtN->second;
+ }
+ // create a new face
+ helper->SetElementsOnShape( true );
+ switch ( nbN )
+ {
+ case 3: helper->AddFace(tgtNodes[0], tgtNodes[1], tgtNodes[2]); break;
+ case 4: helper->AddFace(tgtNodes[0], tgtNodes[1], tgtNodes[2], tgtNodes[3]); break;
+ default: helper->AddPolygonalFace( tgtNodes );
+ }
+ } // // loop on all mesh faces on srcFace
+
+ return true;
+
+ // below is projection of a structured source mesh
+
+ // if ( !is1DComputed )
+ // return false;
+ // for ( int iE = 0; iE < 4; ++iE )
+ // {
+ // SMESHDS_SubMesh* sm = srcMeshDS->MeshElements( srcWires[0]->Edge( iE ));
+ // if ( !sm ) return false;
+ // if ( sm->NbNodes() + sm->NbElements() == 0 ) return false;
+ // }
+ // if ( BRepAdaptor_Surface( tgtFace ).GetType() != GeomAbs_Plane )
+ // return false;
+ // // if ( BRepAdaptor_Surface( tgtFace ).GetType() == GeomAbs_Plane &&
+ // // BRepAdaptor_Surface( srcFace ).GetType() == GeomAbs_Plane )
+ // // return false; // too easy
+
+ // // load EDGEs to SMESH_Block
+
+ // SMESH_Block block;
+ // TopTools_IndexedMapOfOrientedShape blockSubShapes;
+ // {
+ // const TopoDS_Solid& box = srcMesh->PseudoShape();
+ // TopoDS_Shell shell = TopoDS::Shell( TopExp_Explorer( box, TopAbs_SHELL ).Current() );
+ // TopoDS_Vertex v;
+ // block.LoadBlockShapes( shell, v, v, blockSubShapes ); // fill all since operator[] is missing
+ // }
+ // const SMESH_Block::TShapeID srcFaceBID = SMESH_Block::ID_Fxy0;
+ // const SMESH_Block::TShapeID tgtFaceBID = SMESH_Block::ID_Fxy1;
+ // vector< int > edgeBID;
+ // block.GetFaceEdgesIDs( srcFaceBID, edgeBID ); // u0, u1, 0v, 1v
+ // blockSubShapes.Substitute( edgeBID[0], srcWires[0]->Edge(0) );
+ // blockSubShapes.Substitute( edgeBID[1], srcWires[0]->Edge(2) );
+ // blockSubShapes.Substitute( edgeBID[2], srcWires[0]->Edge(3) );
+ // blockSubShapes.Substitute( edgeBID[3], srcWires[0]->Edge(1) );
+ // block.GetFaceEdgesIDs( tgtFaceBID, edgeBID ); // u0, u1, 0v, 1v
+ // blockSubShapes.Substitute( edgeBID[0], tgtWires[0]->Edge(0) );
+ // blockSubShapes.Substitute( edgeBID[1], tgtWires[0]->Edge(2) );
+ // blockSubShapes.Substitute( edgeBID[2], tgtWires[0]->Edge(3) );
+ // blockSubShapes.Substitute( edgeBID[3], tgtWires[0]->Edge(1) );
+ // block.LoadFace( srcFace, srcFaceBID, blockSubShapes );
+ // block.LoadFace( tgtFace, tgtFaceBID, blockSubShapes );
+
+ // // remember connectivity of new faces in terms of ( node-or-XY )
+
+ // typedef std::pair< const SMDS_MeshNode*, gp_XYZ > TNodeOrXY; // node-or-XY
+ // typedef std::vector< TNodeOrXY* > TFaceConn; // face connectivity
+ // std::vector< TFaceConn > newFacesVec; // connectivity of all faces
+ // std::map< const SMDS_MeshNode*, TNodeOrXY > srcNode2tgtNXY; // src node -> node-or-XY
+
+ // TAssocTool::TNodeNodeMap::iterator srcN_tgtN;
+ // std::map< const SMDS_MeshNode*, TNodeOrXY >::iterator srcN_tgtNXY;
+ // std::pair< std::map< const SMDS_MeshNode*, TNodeOrXY >::iterator, bool > n2n_isNew;
+ // TNodeOrXY nullNXY( (SMDS_MeshNode*)NULL, gp_XYZ(0,0,0) );
+
+ // SMESHDS_SubMesh* srcSubDS = srcMeshDS->MeshElements( srcFace );
+ // newFacesVec.resize( srcSubDS->NbElements() );
+ // int iFaceSrc = 0;
+
+ // SMDS_ElemIteratorPtr elemIt = srcSubDS->GetElements();
+ // while ( elemIt->more() ) // loop on all mesh faces on srcFace
+ // {
+ // const SMDS_MeshElement* elem = elemIt->next();
+ // TFaceConn& tgtNodes = newFacesVec[ iFaceSrc++ ];
+
+ // const int nbN = elem->NbCornerNodes();
+ // tgtNodes.resize( nbN );
+ // for ( int i = 0; i < nbN; ++i ) // loop on nodes of the source element
+ // {
+ // const SMDS_MeshNode* srcNode = elem->GetNode(i);
+ // n2n_isNew = srcNode2tgtNXY.insert( make_pair( srcNode, nullNXY ));
+ // TNodeOrXY & tgtNodeOrXY = n2n_isNew.first->second;
+ // if ( n2n_isNew.second ) // new src node encounters
+ // {
+ // srcN_tgtN = src2tgtNodes.find( srcNode );
+ // if ( srcN_tgtN != src2tgtNodes.end() )
+ // {
+ // tgtNodeOrXY.first = srcN_tgtN->second; // tgt node exists
+ // }
+ // else
+ // {
+ // // find XY of src node within the quadrilateral srcFace
+ // if ( !block.ComputeParameters( SMESH_TNodeXYZ( srcNode ),
+ // tgtNodeOrXY.second, srcFaceBID ))
+ // return false;
+ // }
+ // }
+ // tgtNodes[ i ] = & tgtNodeOrXY;
+ // }
+ // }
+
+ // // as all XY are computed, create tgt nodes and faces
+
+ // SMESH_MesherHelper helper = *tgtWires[0]->FaceHelper();
+ // if ( is1DComputed )
+ // helper.IsQuadraticSubMesh( tgtFace );
+ // else
+ // helper.SetIsQuadratic( srcSubDS->GetElements()->next()->IsQuadratic() );
+ // helper.SetElementsOnShape( true );
+ // Handle(Geom_Surface) tgtSurface = BRep_Tool::Surface( tgtFace );
+
+ // SMESH_MesherHelper srcHelper = *srcWires[0]->FaceHelper();
+
+ // vector< const SMDS_MeshNode* > tgtNodes;
+ // gp_XY uv;
+
+ // for ( size_t iFaceTgt = 0; iFaceTgt < newFacesVec.size(); ++iFaceTgt )
+ // {
+ // TFaceConn& tgtConn = newFacesVec[ iFaceTgt ];
+ // tgtNodes.resize( tgtConn.size() );
+ // for ( size_t iN = 0; iN < tgtConn.size(); ++iN )
+ // {
+ // const SMDS_MeshNode* & tgtN = tgtConn[ iN ]->first;
+ // if ( !tgtN ) // create a node
+ // {
+ // if ( !block.FaceUV( tgtFaceBID, tgtConn[iN]->second, uv ))
+ // return false;
+ // gp_Pnt p = tgtSurface->Value( uv.X(), uv.Y() );
+ // tgtN = helper.AddNode( p.X(), p.Y(), p.Z(), uv.X(), uv.Y() );
+ // }
+ // tgtNodes[ tgtNodes.size() - iN - 1] = tgtN; // reversed orientation
+ // }
+ // switch ( tgtNodes.size() )
+ // {
+ // case 3: helper.AddFace(tgtNodes[0], tgtNodes[1], tgtNodes[2]); break;
+ // case 4: helper.AddFace(tgtNodes[0], tgtNodes[1], tgtNodes[2], tgtNodes[3]); break;
+ // default:
+ // if ( tgtNodes.size() > 4 )
+ // helper.AddPolygonalFace( tgtNodes );
+ // }
+ // }
+ return false; //true;
+
+ } // bool projectQuads(...)
+
+ //================================================================================
+ /*!
+ * \brief Fix bad faces by smoothing
+ */
+ //================================================================================
+
+ bool fixDistortedFaces( SMESH_MesherHelper& helper,
+ TSideVector& tgtWires )
+ {
+ SMESH_subMesh* faceSM = helper.GetMesh()->GetSubMesh( helper.GetSubShape() );
+
+ //if ( helper.IsDistorted2D( faceSM, /*checkUV=*/true ))
+ {
+ SMESH_MeshEditor editor( helper.GetMesh() );
+ SMESHDS_SubMesh* smDS = faceSM->GetSubMeshDS();
+ const TopoDS_Face& F = TopoDS::Face( faceSM->GetSubShape() );
+
+ TIDSortedElemSet faces;
+ SMDS_ElemIteratorPtr faceIt = smDS->GetElements();
+ for ( faceIt = smDS->GetElements(); faceIt->more(); )
+ faces.insert( faces.end(), faceIt->next() );
+
+ // choose smoothing algo
+ //SMESH_MeshEditor:: SmoothMethod algo = SMESH_MeshEditor::CENTROIDAL;
+ bool isConcaveBoundary = false;
+ for ( size_t iW = 0; iW < tgtWires.size() && !isConcaveBoundary; ++iW )
+ {
+ TopoDS_Edge prevEdge = tgtWires[iW]->Edge( tgtWires[iW]->NbEdges() - 1 );
+ for ( int iE = 0; iE < tgtWires[iW]->NbEdges() && !isConcaveBoundary; ++iE )
+ {
+ double angle = helper.GetAngle( prevEdge, tgtWires[iW]->Edge( iE ),
+ F, tgtWires[iW]->FirstVertex( iE ));
+ isConcaveBoundary = ( angle < -5. * M_PI / 180. );
+
+ prevEdge = tgtWires[iW]->Edge( iE );
+ }
+ }
+ SMESH_MeshEditor:: SmoothMethod algo =
+ isConcaveBoundary ? SMESH_MeshEditor::CENTROIDAL : SMESH_MeshEditor::LAPLACIAN;
+
+ // smooth in 2D or 3D?
+ TopLoc_Location loc;
+ Handle(Geom_Surface) surface = BRep_Tool::Surface( F, loc );
+ bool isPlanar = GeomLib_IsPlanarSurface( surface ).IsPlanar();
+
+ // smoothing
+ set<const SMDS_MeshNode*> fixedNodes;
+ editor.Smooth( faces, fixedNodes, algo, /*nbIterations=*/ 10,
+ /*theTgtAspectRatio=*/1.0, /*the2D=*/!isPlanar);
+
+ helper.ToFixNodeParameters( true );
+
+ return !helper.IsDistorted2D( faceSM, /*checkUV=*/true );
+ }
+ return true;
+ }
+
+ //=======================================================================
+ /*
+ * Set initial association of VERTEXes for the case of projection
+ * from a quadrangle FACE to a closed FACE, where opposite src EDGEs
+ * have different nb of segments
+ */
+ //=======================================================================
+
+ void initAssoc4Quad2Closed(const TopoDS_Shape& tgtFace,
+ SMESH_MesherHelper& tgtHelper,
+ const TopoDS_Shape& srcFace,
+ SMESH_Mesh* srcMesh,
+ TAssocTool::TShapeShapeMap & assocMap)
+ {
+ if ( !tgtHelper.HasRealSeam() || srcFace.ShapeType() != TopAbs_FACE )
+ return; // no seam edge
+ list< TopoDS_Edge > tgtEdges, srcEdges;
+ list< int > tgtNbEW, srcNbEW;
+ int tgtNbW = SMESH_Block::GetOrderedEdges( TopoDS::Face( tgtFace ), tgtEdges, tgtNbEW );
+ int srcNbW = SMESH_Block::GetOrderedEdges( TopoDS::Face( srcFace ), srcEdges, srcNbEW );
+ if ( tgtNbW != 1 || srcNbW != 1 ||
+ tgtNbEW.front() != 4 || srcNbEW.front() != 4 )
+ return; // not quads
+
+ smIdType srcNbSeg[4];
+ list< TopoDS_Edge >::iterator edgeS = srcEdges.begin(), edgeT = tgtEdges.begin();
+ for ( int i = 0; edgeS != srcEdges.end(); ++i, ++edgeS )
+ if ( SMESHDS_SubMesh* sm = srcMesh->GetMeshDS()->MeshElements( *edgeS ))
+ srcNbSeg[ i ] = sm->NbNodes();
+ else
+ return; // not meshed
+ if ( srcNbSeg[0] == srcNbSeg[2] && srcNbSeg[1] == srcNbSeg[3] )
+ return; // same nb segments
+ if ( srcNbSeg[0] != srcNbSeg[2] && srcNbSeg[1] != srcNbSeg[3] )
+ return; // all different nb segments
+
+ edgeS = srcEdges.begin();
+ if ( srcNbSeg[0] != srcNbSeg[2] )
+ ++edgeS;
+ TAssocTool::InsertAssociation( tgtHelper.IthVertex( 0,*edgeT ),
+ tgtHelper.IthVertex( 0,*edgeS ), assocMap );
+ TAssocTool::InsertAssociation( tgtHelper.IthVertex( 1,*edgeT ),
+ tgtHelper.IthVertex( 1,*edgeS ), assocMap );
+ }
+
+ //================================================================================
+ /*!
+ * \brief Find sub-shape association such that corresponding VERTEXes of
+ * two corresponding FACEs lie on lines parallel to thePiercingLine
+ */
+ //================================================================================
+
+ bool findSubShapeAssociationByPiercing( const TopoDS_Face& theTgtFace,
+ SMESH_Mesh * /*theTgtMesh*/,
+ const TopoDS_Shape& theSrcShape,
+ SMESH_Mesh* theSrcMesh,
+ TAssocTool::TShapeShapeMap& theShape2ShapeMap,
+ Handle(Geom_Line) & thePiercingLine )
+ {
+ list< TopoDS_Edge > tgtEdges, srcEdges;
+ list< int > tgtNbEW, srcNbEW;
+ int tgtNbW = SMESH_Block::GetOrderedEdges( TopoDS::Face( theTgtFace ), tgtEdges, tgtNbEW );
+
+ TopTools_IndexedMapOfShape tgtVV, srcVV;
+ for ( const TopoDS_Edge& tgtEdge : tgtEdges )
+ tgtVV.Add( SMESH_MesherHelper::IthVertex( 0, tgtEdge ));
+ // if ( tgtVV.Size() < 2 )
+ // return false;
+
+ const int nbVV = tgtVV.Size();
+ const gp_Pnt tgtP0 = BRep_Tool::Pnt( TopoDS::Vertex( tgtVV( 1 )));
+ double minVertexDist = Precision::Infinite(), assocTol;
+ gp_Lin piercingLine;
+ TopoDS_Face assocSrcFace;
+ double tol;
+
+ for ( TopExp_Explorer faceExp( theSrcShape, TopAbs_FACE ); faceExp.More(); faceExp.Next())
+ {
+ const TopoDS_Face& srcFace = TopoDS::Face( faceExp.Current() );
+
+ int srcNbW = SMESH_Block::GetOrderedEdges( srcFace, srcEdges, srcNbEW );
+ if ( tgtNbW != srcNbW )
+ continue;
+
+ srcVV.Clear( false );
+ for ( const TopoDS_Edge& srcEdge : srcEdges )
+ srcVV.Add( SMESH_MesherHelper::IthVertex( 0, srcEdge ));
+ if ( srcVV.Extent() != tgtVV.Extent() )
+ continue;
+
+ // make srcFace computed
+ SMESH_subMesh* srcFaceSM = theSrcMesh->GetSubMesh( srcFace );
+ if ( !TAssocTool::MakeComputed( srcFaceSM ))
+ continue;
+
+ // compute tolerance
+ double sumLen = 0, nbEdges = 0;
+ for ( const TopoDS_Edge& srcEdge : srcEdges )
+ {
+ SMESH_subMesh* srcSM = theSrcMesh->GetSubMesh( srcEdge );
+ if ( !srcSM->GetSubMeshDS() )
+ continue;
+ SMDS_ElemIteratorPtr edgeIt = srcSM->GetSubMeshDS()->GetElements();
+ while ( edgeIt->more() )
+ {
+ const SMDS_MeshElement* edge = edgeIt->next();
+ sumLen += SMESH_NodeXYZ( edge->GetNode( 0 )).Distance( edge->GetNode( 1 ));
+ nbEdges += 1;
+ }
+ }
+ if ( nbEdges == 0 )
+ continue;
+
+ tol = 0.1 * sumLen / nbEdges;
+
+ // try to find corresponding VERTEXes
+
+ gp_Lin line;
+ double vertexDist;
+ for ( int iSrcV0 = 1; iSrcV0 <= srcVV.Size(); ++iSrcV0 )
+ {
+ const gp_Pnt srcP0 = BRep_Tool::Pnt( TopoDS::Vertex( srcVV( iSrcV0 )));
+ try {
+ line.SetDirection( gp_Vec( srcP0, tgtP0 ));
+ }
+ catch (...) {
+ continue;
+ }
+ bool correspond;
+ for ( int iDir : { -1, 1 }) // move connected VERTEX forward and backward
+ {
+ correspond = true;
+ vertexDist = 0;
+ int iTgtV = 0, iSrcV = iSrcV0 - 1;
+ for ( int i = 1; i < tgtVV.Size() && correspond; ++i )
+ {
+ iTgtV = ( iTgtV + 1 ) % nbVV;
+ iSrcV = ( iSrcV + iDir + nbVV ) % nbVV;
+ gp_Pnt tgtP = BRep_Tool::Pnt( TopoDS::Vertex( tgtVV( iTgtV + 1 )));
+ gp_Pnt srcP = BRep_Tool::Pnt( TopoDS::Vertex( srcVV( iSrcV + 1 )));
+ line.SetLocation( tgtP );
+ correspond = ( line.SquareDistance( srcP ) < tol * tol );
+ vertexDist += tgtP.SquareDistance( srcP );
+ }
+ if ( correspond )
+ break;
+ }
+ if ( correspond )
+ {
+ if ( vertexDist < minVertexDist )
+ {
+ minVertexDist = vertexDist;
+ piercingLine = line;
+ assocSrcFace = srcFace;
+ assocTol = tol;
+ }
+ break;
+ }
+ }
+ continue;
+
+ } // loop on src FACEs
+
+ if ( Precision::IsInfinite( minVertexDist ))
+ return false; // no correspondence found
+
+ thePiercingLine = new Geom_Line( piercingLine );
+
+ // fill theShape2ShapeMap
+
+ TAssocTool::InsertAssociation( theTgtFace, assocSrcFace, theShape2ShapeMap );
+
+ for ( const TopoDS_Shape& tgtV : tgtVV ) // fill theShape2ShapeMap with VERTEXes
+ {
+ gp_Pnt tgtP = BRep_Tool::Pnt( TopoDS::Vertex( tgtV ));
+ piercingLine.SetLocation( tgtP );
+ bool found = false;
+ for ( const TopoDS_Shape& srcV : srcVV )
+ {
+ gp_Pnt srcP = BRep_Tool::Pnt( TopoDS::Vertex( srcV ));
+ if ( piercingLine.SquareDistance( srcP ) < assocTol * assocTol )
+ {
+ TAssocTool::InsertAssociation( tgtV, srcV, theShape2ShapeMap );
+ found = true;
+ break;
+ }
+ }
+ if ( !found )
+ return false;
+ }
+
+ TopoDS_Vertex vvT[2], vvS[2], vvMapped[2];
+ for ( const TopoDS_Edge& tgtEdge : tgtEdges ) // fill theShape2ShapeMap with EDGEs
+ {
+ if ( SMESH_Algo::isDegenerated( tgtEdge ))
+ continue;
+
+ TopExp::Vertices( tgtEdge, vvT[0], vvT[1], true );
+ if ( !theShape2ShapeMap.IsBound( vvT[0] ) ||
+ !theShape2ShapeMap.IsBound( vvT[1] ))
+ return false;
+
+ vvMapped[0] = TopoDS::Vertex( theShape2ShapeMap( vvT[0] ));
+ vvMapped[1] = TopoDS::Vertex( theShape2ShapeMap( vvT[1] ));
+
+ bool found = false;
+ for ( TopExp_Explorer eExp( assocSrcFace, TopAbs_EDGE ); eExp.More(); eExp.Next())
+ {
+ TopoDS_Edge srcEdge = TopoDS::Edge( eExp.Current() );
+ TopExp::Vertices( srcEdge, vvS[0], vvS[1], true );
+ found = (( vvMapped[0].IsSame( vvS[0] ) && vvMapped[1].IsSame( vvS[1] )) ||
+ ( vvMapped[0].IsSame( vvS[1] ) && vvMapped[1].IsSame( vvS[0] )));
+
+ if ( found && nbVV < 3 )
+ {
+ BRepAdaptor_Curve tgtCurve( tgtEdge );
+ gp_Pnt tgtP = tgtCurve.Value( 0.5 * ( tgtCurve.FirstParameter() +
+ tgtCurve.LastParameter() ));
+ thePiercingLine->SetLocation( tgtP );
+
+ double f,l;
+ Handle(Geom_Curve) srcCurve = BRep_Tool::Curve( srcEdge, f,l );
+ if ( srcCurve.IsNull() )
+ {
+ found = false;
+ continue;
+ }
+ GeomAPI_ExtremaCurveCurve extrema( thePiercingLine, srcCurve );
+ if ( !extrema.Extrema().IsDone() ||
+ extrema.Extrema().IsParallel() ||
+ extrema.NbExtrema() == 0 ||
+ extrema.LowerDistance() > tol )
+ found = false;
+ }
+ if ( found )
+ {
+ if ( !vvMapped[0].IsSame( vvS[0] ))
+ srcEdge.Reverse();
+ TAssocTool::InsertAssociation( tgtEdge, srcEdge, theShape2ShapeMap );
+ break;
+ }
+ }
+ if ( !found )
+ return false;
+ }
+
+ return true;
+
+ } // findSubShapeAssociationByPiercing()
+
+ //================================================================================
+ /*!
+ * \brief Project by piercing theTgtFace by lines parallel to thePiercingLine
+ */
+ //================================================================================
+
+ bool projectByPiercing(Handle(Geom_Line) thePiercingLine,
+ const TopoDS_Face& theTgtFace,
+ const TopoDS_Face& theSrcFace,
+ const TSideVector& theTgtWires,
+ const TSideVector& theSrcWires,
+ const TAssocTool::TShapeShapeMap& theShape2ShapeMap,
+ TAssocTool::TNodeNodeMap& theSrc2tgtNodes,
+ const bool theIs1DComputed)
+ {
+ SMESH_Mesh * tgtMesh = theTgtWires[0]->GetMesh();
+ SMESH_Mesh * srcMesh = theSrcWires[0]->GetMesh();
+
+ if ( thePiercingLine.IsNull() )
+ {
+ // try to set thePiercingLine by VERTEX association of theShape2ShapeMap
+
+ const double tol = 0.1 * theSrcWires[0]->Length() / theSrcWires[0]->NbSegments();
+
+ for ( TopExp_Explorer vExp( theTgtFace, TopAbs_VERTEX ); vExp.More(); vExp.Next() )
+ {
+ const TopoDS_Vertex & tgtV = TopoDS::Vertex( vExp.Current() );
+ const TopoDS_Vertex & srcV = TopoDS::Vertex( theShape2ShapeMap( tgtV ));
+ gp_Pnt tgtP = BRep_Tool::Pnt( tgtV );
+ gp_Pnt srcP = BRep_Tool::Pnt( srcV );
+ if ( thePiercingLine.IsNull() ) // set thePiercingLine
+ {
+ gp_Lin line;
+ try {
+ line.SetDirection( gp_Vec( srcP, tgtP ));
+ line.SetLocation( tgtP );
+ thePiercingLine = new Geom_Line( line );
+ }
+ catch ( ... )
+ {
+ continue;
+ }
+ }
+ else // check thePiercingLine
+ {
+ thePiercingLine->SetLocation( tgtP );
+ if ( thePiercingLine->Lin().SquareDistance( srcP ) > tol * tol )
+ return false;
+ }
+ }
+
+ for ( TopExp_Explorer eExp( theTgtFace, TopAbs_EDGE ); eExp.More(); eExp.Next() )
+ {
+ BRepAdaptor_Curve tgtCurve( TopoDS::Edge( eExp.Current() ));
+ gp_Pnt tgtP = tgtCurve.Value( 0.5 * ( tgtCurve.FirstParameter() +
+ tgtCurve.LastParameter() ));
+ thePiercingLine->SetLocation( tgtP );
+
+ double f,l;
+ TopoDS_Edge srcEdge = TopoDS::Edge( theShape2ShapeMap( eExp.Current() ));
+ Handle(Geom_Curve) srcCurve = BRep_Tool::Curve( srcEdge, f,l );
+ if ( srcCurve.IsNull() )
+ continue;
+ GeomAPI_ExtremaCurveCurve extrema( thePiercingLine, srcCurve,
+ -Precision::Infinite(), Precision::Infinite(), f, l );
+ if ( !extrema.Extrema().IsDone() ||
+ extrema.Extrema().IsParallel() ||
+ extrema.NbExtrema() == 0 ||
+ extrema.LowerDistance() > tol )
+ return false;
+ }
+ } // if ( thePiercingLine.IsNull() )
+
+ SMESHDS_SubMesh* srcSubDS = srcMesh->GetMeshDS()->MeshElements( theSrcFace );
+
+ SMESH_MesherHelper* helper = theTgtWires[0]->FaceHelper();
+ if ( theIs1DComputed )
+ helper->IsQuadraticSubMesh( theTgtFace );
+ else
+ helper->SetIsQuadratic( srcSubDS->GetElements()->next()->IsQuadratic() );
+ helper->SetElementsOnShape( true );
+ SMESHDS_Mesh* tgtMeshDS = tgtMesh->GetMeshDS();
+
+ Handle(Geom_Surface) tgtSurface = BRep_Tool::Surface( theTgtFace );
+#if OCC_VERSION_LARGE < 0x07070000
+ Handle(GeomAdaptor_HSurface) tgtSurfAdaptor = new GeomAdaptor_HSurface( tgtSurface );
+ Handle(GeomAdaptor_HCurve) piercingCurve = new GeomAdaptor_HCurve( thePiercingLine );
+#else
+ Handle(GeomAdaptor_Surface) tgtSurfAdaptor = new GeomAdaptor_Surface( tgtSurface );
+ Handle(GeomAdaptor_Curve) piercingCurve = new GeomAdaptor_Curve( thePiercingLine );
+#endif
+ IntCurveSurface_HInter intersect;
+
+ SMESH_MesherHelper* srcHelper = theSrcWires[0]->FaceHelper();
+
+ const SMDS_MeshNode* nullNode = 0;
+ TAssocTool::TNodeNodeMap::iterator srcN_tgtN;
+ vector< const SMDS_MeshNode* > tgtNodes;
+
+ SMDS_ElemIteratorPtr elemIt = srcSubDS->GetElements();
+ while ( elemIt->more() ) // loop on all mesh faces on srcFace
+ {
+ const SMDS_MeshElement* elem = elemIt->next();
+ const int nbN = elem->NbCornerNodes();
+ tgtNodes.resize( nbN );
+ for ( int i = 0; i < nbN; ++i ) // loop on nodes of the source element
+ {
+ const SMDS_MeshNode* srcNode = elem->GetNode(i);
+ srcN_tgtN = theSrc2tgtNodes.insert( make_pair( srcNode, nullNode )).first;
+ if ( srcN_tgtN->second == nullNode )
+ {
+ // create a new node
+ thePiercingLine->SetLocation( SMESH_NodeXYZ( srcNode ));
+ intersect.Perform( piercingCurve, tgtSurfAdaptor );
+ bool pierced = ( intersect.IsDone() && intersect.NbPoints() > 0 );
+ double U, V;
+ const SMDS_MeshNode* n = nullNode;
+ if ( pierced )
+ {
+ double W, minW = Precision::Infinite();
+ gp_Pnt tgtP;
+ for ( int iInt = 1; iInt <= intersect.NbPoints(); ++iInt )
+ {
+ W = intersect.Point( iInt ).W();
+ if ( 0 < W && W < minW )
+ {
+ U = intersect.Point( iInt ).U();
+ V = intersect.Point( iInt ).V();
+ tgtP = intersect.Point( iInt ).Pnt();
+ minW = W;
+ }
+ }
+ n = tgtMeshDS->AddNode( tgtP.X(), tgtP.Y(), tgtP.Z() );
+ }
+
+ SMDS_TypeOfPosition shapeType = srcNode->GetPosition()->GetTypeOfPosition();
+ TopoDS_Shape srcShape;
+ if ( shapeType != SMDS_TOP_FACE )
+ {
+ srcShape = srcHelper->GetSubShapeByNode( srcNode, srcHelper->GetMeshDS() );
+ if ( !theShape2ShapeMap.IsBound( srcShape, /*isSrc=*/true ))
+ {
+ if ( n ) // INTERNAL shape w/o corresponding target shape (3D_mesh_Extrusion_02/E0)
+ shapeType = SMDS_TOP_FACE;
+ else
+ return false;
+ }
+ }
+
+ switch ( shapeType )
+ {
+ case SMDS_TOP_FACE: {
+ if ( !n )
+ return false;
+ tgtMeshDS->SetNodeOnFace( n, helper->GetSubShapeID(), U, V );
+ break;
+ }
+ case SMDS_TOP_EDGE: {
+ TopoDS_Edge tgtEdge = TopoDS::Edge( theShape2ShapeMap( srcShape, /*isSrc=*/true ));
+ if ( n )
+ {
+ U = Precision::Infinite();
+ helper->CheckNodeU( tgtEdge, n, U, Precision::PConfusion());
+ }
+ else
+ {
+ Handle(Geom_Curve) tgtCurve = BRep_Tool::Curve( tgtEdge, U,V );
+ if ( tgtCurve.IsNull() )
+ return false;
+ GeomAPI_ExtremaCurveCurve extrema( thePiercingLine, tgtCurve );
+ if ( !extrema.Extrema().IsDone() ||
+ extrema.Extrema().IsParallel() ||
+ extrema.NbExtrema() == 0 )
+ return false;
+ gp_Pnt pOnLine, pOnEdge;
+ extrema.NearestPoints( pOnLine, pOnEdge );
+ extrema.LowerDistanceParameters( V, U );
+ n = tgtMeshDS->AddNode( pOnEdge.X(), pOnEdge.Y(), pOnEdge.Z() );
+ }
+ tgtMeshDS->SetNodeOnEdge( n, tgtEdge, U );
+ break;
+ }
+ case SMDS_TOP_VERTEX: {
+ TopoDS_Shape tgtV = theShape2ShapeMap( srcShape, /*isSrc=*/true );
+ if ( !n )
+ {
+ gp_Pnt tgtP = BRep_Tool::Pnt( TopoDS::Vertex( tgtV ));
+ n = tgtMeshDS->AddNode( tgtP.X(), tgtP.Y(), tgtP.Z() );
+ }
+ tgtMeshDS->SetNodeOnVertex( n, TopoDS::Vertex( tgtV ));
+ break;
+ }
+ default:;
+ }
+ srcN_tgtN->second = n;
+ }
+ tgtNodes[i] = srcN_tgtN->second;
+ }
+ // create a new face (with reversed orientation)
+ switch ( nbN )
+ {
+ case 3: helper->AddFace(tgtNodes[0], tgtNodes[2], tgtNodes[1]); break;
+ case 4: helper->AddFace(tgtNodes[0], tgtNodes[3], tgtNodes[2], tgtNodes[1]); break;
+ }
+ } // loop on all mesh faces on srcFace
+
+ return true;
+
+ } // projectByPiercing()
+
+
+
+} // namespace
+
+
+//=======================================================================
+//function : Compute
+//purpose :
+//=======================================================================
+
+bool StdMeshers_Projection_2D::Compute(SMESH_Mesh& theMesh, const TopoDS_Shape& theShape)
+{
+ _src2tgtNodes.clear();
+
+ if ( !_sourceHypo )
+ return false;
+
+ SMESH_Mesh * srcMesh = _sourceHypo->GetSourceMesh();
+ SMESH_Mesh * tgtMesh = & theMesh;
+ if ( !srcMesh )
+ srcMesh = tgtMesh;
+
+ SMESHDS_Mesh * meshDS = theMesh.GetMeshDS();
+ SMESH_MesherHelper helper( theMesh );
+
+ // ---------------------------
+ // Make sub-shapes association
+ // ---------------------------
+
+ TopoDS_Face tgtFace = TopoDS::Face( theShape.Oriented(TopAbs_FORWARD));
+ TopoDS_Shape srcShape = _sourceHypo->GetSourceFace().Oriented(TopAbs_FORWARD);
+
+ helper.SetSubShape( tgtFace );
+
+ TAssocTool::TShapeShapeMap shape2ShapeMap;
+ TAssocTool::InitVertexAssociation( _sourceHypo, shape2ShapeMap );
+ if ( shape2ShapeMap.IsEmpty() )
+ initAssoc4Quad2Closed( tgtFace, helper, srcShape, srcMesh, shape2ShapeMap );
+
+ Handle(Geom_Line) piercingLine;
+ bool piercingTried = false;
+
+ if ( !TAssocTool::FindSubShapeAssociation( tgtFace, tgtMesh, srcShape, srcMesh,
+ shape2ShapeMap) ||
+ !shape2ShapeMap.IsBound( tgtFace ))
+ {
+ piercingTried = true;
+ if ( !findSubShapeAssociationByPiercing( tgtFace, tgtMesh, srcShape, srcMesh,
+ shape2ShapeMap, piercingLine ))
+ {
+ if ( srcShape.ShapeType() == TopAbs_FACE )
+ {
+ int nbE1 = helper.Count( tgtFace, TopAbs_EDGE, /*ignoreSame=*/true );
+ int nbE2 = helper.Count( srcShape, TopAbs_EDGE, /*ignoreSame=*/true );
+ if ( nbE1 != nbE2 )
+ return error(COMPERR_BAD_SHAPE,
+ SMESH_Comment("Different number of edges in source and target faces: ")
+ << nbE2 << " and " << nbE1 );
+ }
+ return error(COMPERR_BAD_SHAPE,"Topology of source and target faces seems different" );
+ }
+ }
+ TopoDS_Face srcFace = TopoDS::Face( shape2ShapeMap( tgtFace ).Oriented(TopAbs_FORWARD));
+
+ // ----------------------------------------------
+ // Assure that mesh on a source Face is computed
+ // ----------------------------------------------
+
+ SMESH_subMesh* srcSubMesh = srcMesh->GetSubMesh( srcFace );
+ SMESH_subMesh* tgtSubMesh = tgtMesh->GetSubMesh( tgtFace );
+
+ string srcMeshError;
+ if ( tgtMesh == srcMesh ) {
+ if ( !TAssocTool::MakeComputed( srcSubMesh ))
+ srcMeshError = TAssocTool::SourceNotComputedError( srcSubMesh, this );