1 // Copyright (C) 2007-2010 CEA/DEN, EDF R&D, OPEN CASCADE
3 // Copyright (C) 2003-2007 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
4 // CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
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.
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.
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
20 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
23 // SMESH SMESH : implementaion of SMESH idl descriptions
24 // File : StdMeshers_Projection_2D.cxx
26 // Created : Fri Oct 20 11:37:07 2006
27 // Author : Edward AGAPOV (eap)
29 #include "StdMeshers_Projection_2D.hxx"
31 #include "StdMeshers_ProjectionSource2D.hxx"
32 #include "StdMeshers_ProjectionUtils.hxx"
33 #include "StdMeshers_FaceSide.hxx"
35 #include "SMDS_EdgePosition.hxx"
36 #include "SMDS_FacePosition.hxx"
37 #include "SMESHDS_Hypothesis.hxx"
38 #include "SMESHDS_SubMesh.hxx"
39 #include "SMESH_Block.hxx"
40 #include "SMESH_Comment.hxx"
41 #include "SMESH_Gen.hxx"
42 #include "SMESH_Mesh.hxx"
43 #include "SMESH_MesherHelper.hxx"
44 #include "SMESH_Pattern.hxx"
45 #include "SMESH_subMesh.hxx"
46 #include "SMESH_subMeshEventListener.hxx"
48 #include "utilities.h"
50 #include <BRep_Tool.hxx>
51 #include <Bnd_B2d.hxx>
53 #include <TopExp_Explorer.hxx>
54 #include <TopTools_ListIteratorOfListOfShape.hxx>
62 #define RETURN_BAD_RESULT(msg) { MESSAGE(")-: Error: " << msg); return false; }
64 typedef StdMeshers_ProjectionUtils TAssocTool;
66 //=======================================================================
67 //function : StdMeshers_Projection_2D
69 //=======================================================================
71 StdMeshers_Projection_2D::StdMeshers_Projection_2D(int hypId, int studyId, SMESH_Gen* gen)
72 :SMESH_2D_Algo(hypId, studyId, gen)
74 _name = "Projection_2D";
75 _shapeType = (1 << TopAbs_FACE); // 1 bit per shape type
77 _compatibleHypothesis.push_back("ProjectionSource2D");
81 //================================================================================
85 //================================================================================
87 StdMeshers_Projection_2D::~StdMeshers_Projection_2D()
90 //=======================================================================
91 //function : CheckHypothesis
93 //=======================================================================
95 bool StdMeshers_Projection_2D::CheckHypothesis(SMESH_Mesh& theMesh,
96 const TopoDS_Shape& theShape,
97 SMESH_Hypothesis::Hypothesis_Status& theStatus)
99 list <const SMESHDS_Hypothesis * >::const_iterator itl;
101 const list <const SMESHDS_Hypothesis * >&hyps = GetUsedHypothesis(theMesh, theShape);
102 if ( hyps.size() == 0 )
104 theStatus = HYP_MISSING;
105 return false; // can't work with no hypothesis
108 if ( hyps.size() > 1 )
110 theStatus = HYP_ALREADY_EXIST;
114 const SMESHDS_Hypothesis *theHyp = hyps.front();
116 string hypName = theHyp->GetName();
120 if (hypName == "ProjectionSource2D")
122 _sourceHypo = static_cast<const StdMeshers_ProjectionSource2D *>(theHyp);
124 // Check hypo parameters
126 SMESH_Mesh* srcMesh = _sourceHypo->GetSourceMesh();
127 SMESH_Mesh* tgtMesh = & theMesh;
132 if ( _sourceHypo->HasVertexAssociation() )
135 TopoDS_Shape edge = TAssocTool::GetEdgeByVertices
136 ( srcMesh, _sourceHypo->GetSourceVertex(1), _sourceHypo->GetSourceVertex(2) );
137 if ( edge.IsNull() ||
138 !SMESH_MesherHelper::IsSubShape( edge, srcMesh ) ||
139 !SMESH_MesherHelper::IsSubShape( edge, _sourceHypo->GetSourceFace() ))
141 theStatus = HYP_BAD_PARAMETER;
142 SCRUTE((edge.IsNull()));
143 SCRUTE((SMESH_MesherHelper::IsSubShape( edge, srcMesh )));
144 SCRUTE((SMESH_MesherHelper::IsSubShape( edge, _sourceHypo->GetSourceFace() )));
149 edge = TAssocTool::GetEdgeByVertices
150 ( tgtMesh, _sourceHypo->GetTargetVertex(1), _sourceHypo->GetTargetVertex(2) );
151 if ( edge.IsNull() || !SMESH_MesherHelper::IsSubShape( edge, tgtMesh ))
153 theStatus = HYP_BAD_PARAMETER;
154 SCRUTE((edge.IsNull()));
155 SCRUTE((SMESH_MesherHelper::IsSubShape( edge, tgtMesh )));
158 else if ( !_sourceHypo->IsCompoundSource() &&
159 !SMESH_MesherHelper::IsSubShape( edge, theShape ))
161 theStatus = HYP_BAD_PARAMETER;
162 SCRUTE((SMESH_MesherHelper::IsSubShape( edge, theShape )));
166 // check a source face
167 if ( !SMESH_MesherHelper::IsSubShape( _sourceHypo->GetSourceFace(), srcMesh ) ||
168 ( srcMesh == tgtMesh && theShape == _sourceHypo->GetSourceFace() ))
170 theStatus = HYP_BAD_PARAMETER;
171 SCRUTE((SMESH_MesherHelper::IsSubShape( _sourceHypo->GetSourceFace(), srcMesh )));
172 SCRUTE((srcMesh == tgtMesh));
173 SCRUTE(( theShape == _sourceHypo->GetSourceFace() ));
178 theStatus = HYP_INCOMPATIBLE;
180 return ( theStatus == HYP_OK );
185 //================================================================================
187 * \brief define if a node is new or old
188 * \param node - node to check
189 * \retval bool - true if the node existed before Compute() is called
191 //================================================================================
193 bool isOldNode( const SMDS_MeshNode* node )
195 // old nodes are shared by edges and new ones are shared
196 // only by faces created by mapper
197 SMDS_ElemIteratorPtr invEdge = node->GetInverseElementIterator(SMDSAbs_Edge);
198 bool isOld = invEdge->more();
202 //================================================================================
204 * \brief Class to remove mesh built by pattern mapper on edges
205 * and vertices in the case of failure of projection algo.
206 * It does it's job at destruction
208 //================================================================================
213 MeshCleaner( SMESH_subMesh* faceSubMesh ): sm(faceSubMesh) {}
214 ~MeshCleaner() { Clean(sm); }
215 void Release() { sm = 0; } // mesh will not be removed
216 static void Clean( SMESH_subMesh* sm, bool withSub=true )
219 // PAL16567, 18920. Remove face nodes as well
220 // switch ( sm->GetSubShape().ShapeType() ) {
221 // case TopAbs_VERTEX:
222 // case TopAbs_EDGE: {
223 SMDS_NodeIteratorPtr nIt = sm->GetSubMeshDS()->GetNodes();
224 SMESHDS_Mesh* mesh = sm->GetFather()->GetMeshDS();
225 while ( nIt->more() ) {
226 const SMDS_MeshNode* node = nIt->next();
227 if ( !isOldNode( node ) )
228 mesh->RemoveNode( node );
230 // do not break but iterate over DependsOn()
233 if ( !withSub ) return;
234 SMESH_subMeshIteratorPtr smIt = sm->getDependsOnIterator(false,false);
235 while ( smIt->more() )
236 Clean( smIt->next(), false );
241 //================================================================================
243 * \brief find new nodes belonging to one free border of mesh on face
244 * \param sm - submesh on edge or vertex containg nodes to choose from
245 * \param face - the face bound the submesh
246 * \param u2nodes - map to fill with nodes
247 * \param seamNodes - set of found nodes
248 * \retval bool - is a success
250 //================================================================================
252 bool getBoundaryNodes ( SMESH_subMesh* sm,
253 const TopoDS_Face& face,
254 map< double, const SMDS_MeshNode* > & u2nodes,
255 set< const SMDS_MeshNode* > & seamNodes)
259 if ( !sm || !sm->GetSubMeshDS() )
260 RETURN_BAD_RESULT("Null submesh");
262 SMDS_NodeIteratorPtr nIt = sm->GetSubMeshDS()->GetNodes();
263 switch ( sm->GetSubShape().ShapeType() ) {
265 case TopAbs_VERTEX: {
266 while ( nIt->more() ) {
267 const SMDS_MeshNode* node = nIt->next();
268 if ( isOldNode( node ) ) continue;
269 u2nodes.insert( make_pair( 0., node ));
270 seamNodes.insert( node );
277 // Get submeshes of sub-vertices
278 const map< int, SMESH_subMesh * >& subSM = sm->DependsOn();
279 if ( subSM.size() != 2 )
280 RETURN_BAD_RESULT("there must be 2 submeshes of sub-vertices"
281 " but we have " << subSM.size());
282 SMESH_subMesh* smV1 = subSM.begin()->second;
283 SMESH_subMesh* smV2 = subSM.rbegin()->second;
284 if ( !smV1->IsMeshComputed() || !smV2->IsMeshComputed() )
285 RETURN_BAD_RESULT("Empty vertex submeshes");
287 // Look for a new node on V1
288 nIt = smV1->GetSubMeshDS()->GetNodes();
289 const SMDS_MeshNode* nV1 = 0;
290 while ( nIt->more() && !nV1 ) {
291 const SMDS_MeshNode* node = nIt->next();
292 if ( !isOldNode( node ) ) nV1 = node;
295 RETURN_BAD_RESULT("No new node found on V1");
297 // Find a new node connected to nV1 and belonging to edge submesh;
298 const SMDS_MeshNode* nE = 0;
299 SMESHDS_SubMesh* smDS = sm->GetSubMeshDS();
300 SMDS_ElemIteratorPtr vElems = nV1->GetInverseElementIterator(SMDSAbs_Face);
301 while ( vElems->more() && !nE ) {
302 const SMDS_MeshElement* elem = vElems->next();
303 int nbNodes = elem->NbNodes();
304 if ( elem->IsQuadratic() )
306 int iV1 = elem->GetNodeIndex( nV1 );
307 // try next after nV1
308 int iE = SMESH_MesherHelper::WrapIndex( iV1 + 1, nbNodes );
309 if ( smDS->Contains( elem->GetNode( iE ) ))
310 nE = elem->GetNode( iE );
312 // try node before nV1
313 iE = SMESH_MesherHelper::WrapIndex( iV1 - 1, nbNodes );
314 if ( smDS->Contains( elem->GetNode( iE )))
315 nE = elem->GetNode( iE );
317 if ( nE && elem->IsQuadratic() ) { // find medium node between nV1 and nE
318 if ( Abs( iV1 - iE ) == 1 )
319 nE = elem->GetNode( Min ( iV1, iE ) + nbNodes );
321 nE = elem->GetNode( elem->NbNodes() - 1 );
325 RETURN_BAD_RESULT("new node on edge not found");
327 // Get the whole free border of a face
328 list< const SMDS_MeshNode* > bordNodes;
329 list< const SMDS_MeshElement* > bordFaces;
330 if ( !SMESH_MeshEditor::FindFreeBorder (nV1, nE, nV1, bordNodes, bordFaces ))
331 RETURN_BAD_RESULT("free border of a face not found by nodes " <<
332 nV1->GetID() << " " << nE->GetID() );
334 // Insert nodes of the free border to the map until node on V2 encountered
335 SMESHDS_SubMesh* v2smDS = smV2->GetSubMeshDS();
336 list< const SMDS_MeshNode* >::iterator bordIt = bordNodes.begin();
337 bordIt++; // skip nV1
338 for ( ; bordIt != bordNodes.end(); ++bordIt ) {
339 const SMDS_MeshNode* node = *bordIt;
340 if ( v2smDS->Contains( node ))
342 if ( node->GetPosition()->GetTypeOfPosition() != SMDS_TOP_EDGE )
343 RETURN_BAD_RESULT("Bad node position type: node " << node->GetID() <<
344 " pos type " << node->GetPosition()->GetTypeOfPosition());
345 const SMDS_EdgePosition* pos =
346 static_cast<const SMDS_EdgePosition*>(node->GetPosition());
347 u2nodes.insert( make_pair( pos->GetUParameter(), node ));
348 seamNodes.insert( node );
350 if ( u2nodes.size() != seamNodes.size() )
351 RETURN_BAD_RESULT("Bad node params on edge " << sm->GetId() <<
352 ", " << u2nodes.size() << " != " << seamNodes.size() );
357 RETURN_BAD_RESULT ("Unexpected submesh type");
359 } // bool getBoundaryNodes()
361 //================================================================================
363 * \brief Preform projection in case if tgtFace.IsPartner( srcFace ) and in case
364 * if projection by transformation is possible
366 //================================================================================
368 bool projectPartner(const TopoDS_Face& tgtFace,
369 const TopoDS_Face& srcFace,
370 SMESH_Mesh * tgtMesh,
371 SMESH_Mesh * srcMesh,
372 const TAssocTool::TShapeShapeMap& shape2ShapeMap)
374 MESSAGE("projectPartner");
375 const double tol = 1.e-7*srcMesh->GetMeshDS()->getMaxDim();
377 gp_Trsf trsf; // transformation to get location of target nodes from source ones
378 if ( tgtFace.IsPartner( srcFace ))
380 gp_Trsf srcTrsf = srcFace.Location();
381 gp_Trsf tgtTrsf = tgtFace.Location();
382 trsf = srcTrsf.Inverted() * tgtTrsf;
386 // Try to find the transformation
388 // make any local coord systems of src and tgt faces
389 vector<gp_Pnt> srcPP, tgtPP; // 3 points on face boundaries to make axes of CS
390 SMESH_subMesh * srcSM = srcMesh->GetSubMesh( srcFace );
391 SMESH_subMeshIteratorPtr smIt = srcSM->getDependsOnIterator(/*includeSelf=*/false,false);
392 srcSM = smIt->next(); // sm of a vertex
393 while ( smIt->more() && srcPP.size() < 3 )
395 srcSM = smIt->next();
396 SMESHDS_SubMesh* srcSmds = srcSM->GetSubMeshDS();
397 if ( !srcSmds ) continue;
398 SMDS_NodeIteratorPtr nIt = srcSmds->GetNodes();
399 while ( nIt->more() )
401 SMESH_TNodeXYZ p ( nIt->next());
403 switch ( srcPP.size() )
405 case 0: pOK = true; break;
407 case 1: pOK = ( srcPP[0].SquareDistance( p ) > 10*tol ); break;
411 gp_Vec p0p1( srcPP[0], srcPP[1] ), p0p( srcPP[0], p );
412 // pOK = !p0p1.IsParallel( p0p, tol );
413 pOK = !p0p1.IsParallel( p0p, 3.14/20 ); // angle min 18 degrees
420 // find corresponding point on target shape
423 const TopoDS_Shape& tgtShape = shape2ShapeMap( srcSM->GetSubShape() );
424 if ( tgtShape.ShapeType() == TopAbs_VERTEX )
426 tgtP = BRep_Tool::Pnt( TopoDS::Vertex( tgtShape ));
428 //cout << "V - nS " << p._node->GetID() << " - nT " << SMESH_Algo::VertexNode(TopoDS::Vertex( tgtShape),tgtMesh->GetMeshDS())->GetID() << endl;
430 else if ( tgtPP.size() > 0 )
432 if ( SMESHDS_SubMesh* tgtSmds = tgtMesh->GetMeshDS()->MeshElements( tgtShape ))
434 double srcDist = srcPP[0].Distance( p );
435 double eTol = BRep_Tool::Tolerance( TopoDS::Edge( tgtShape ));
436 if (eTol < tol) eTol = tol;
437 SMDS_NodeIteratorPtr nItT = tgtSmds->GetNodes();
438 while ( nItT->more() && !pOK )
440 const SMDS_MeshNode* n = nItT->next();
441 tgtP = SMESH_TNodeXYZ( n );
442 pOK = ( fabs( srcDist - tgtPP[0].Distance( tgtP )) < 2*eTol );
443 //cout << "E - nS " << p._node->GetID() << " - nT " << n->GetID()<< " OK - " << pOK<< " " << fabs( srcDist - tgtPP[0].Distance( tgtP ))<< " tol " << eTol<< endl;
450 srcPP.push_back( p );
451 tgtPP.push_back( tgtP );
454 if ( srcPP.size() != 3 )
457 // make transformation
458 gp_Trsf fromTgtCS, toSrcCS; // from/to global CS
459 gp_Ax2 srcCS( srcPP[0], gp_Vec( srcPP[0], srcPP[1] ), gp_Vec( srcPP[0], srcPP[2]));
460 gp_Ax2 tgtCS( tgtPP[0], gp_Vec( tgtPP[0], tgtPP[1] ), gp_Vec( tgtPP[0], tgtPP[2]));
461 toSrcCS .SetTransformation( gp_Ax3( srcCS ));
462 fromTgtCS.SetTransformation( gp_Ax3( tgtCS ));
465 trsf = fromTgtCS * toSrcCS;
468 // Fill map of src to tgt nodes with nodes on edges
470 map<const SMDS_MeshNode* , const SMDS_MeshNode*> src2tgtNodes;
471 map<const SMDS_MeshNode* , const SMDS_MeshNode*>::iterator srcN_tgtN;
473 for ( TopExp_Explorer srcEdge( srcFace, TopAbs_EDGE); srcEdge.More(); srcEdge.Next() )
475 const TopoDS_Shape& tgtEdge = shape2ShapeMap( srcEdge.Current() );
477 map< double, const SMDS_MeshNode* > srcNodes, tgtNodes;
478 if ( !SMESH_Algo::GetSortedNodesOnEdge( srcMesh->GetMeshDS(),
479 TopoDS::Edge( srcEdge.Current() ),
480 /*ignoreMediumNodes = */true,
483 !SMESH_Algo::GetSortedNodesOnEdge( tgtMesh->GetMeshDS(),
484 TopoDS::Edge( tgtEdge ),
485 /*ignoreMediumNodes = */true,
488 srcNodes.size() != tgtNodes.size())
491 if ( !tgtEdge.IsPartner( srcEdge.Current() ))
493 // check that transformation is OK by three nodes
494 gp_Pnt p0S = SMESH_TNodeXYZ( (srcNodes.begin()) ->second);
495 gp_Pnt p1S = SMESH_TNodeXYZ( (srcNodes.rbegin()) ->second);
496 gp_Pnt p2S = SMESH_TNodeXYZ( (++srcNodes.begin())->second);
498 gp_Pnt p0T = SMESH_TNodeXYZ( (tgtNodes.begin()) ->second);
499 gp_Pnt p1T = SMESH_TNodeXYZ( (tgtNodes.rbegin()) ->second);
500 gp_Pnt p2T = SMESH_TNodeXYZ( (++tgtNodes.begin())->second);
502 // transform source points, they must coincide with target ones
503 if ( p0T.SquareDistance( p0S.Transformed( trsf )) > tol ||
504 p1T.SquareDistance( p1S.Transformed( trsf )) > tol ||
505 p2T.SquareDistance( p2S.Transformed( trsf )) > tol )
507 //cout << "KO trsf, 3 dist: "
508 //<< p0T.SquareDistance( p0S.Transformed( trsf ))<< ", "
509 //<< p1T.SquareDistance( p1S.Transformed( trsf ))<< ", "
510 //<< p2T.SquareDistance( p2S.Transformed( trsf ))<< ", "<<endl;
515 map< double, const SMDS_MeshNode* >::iterator u_tn = tgtNodes.begin();
516 map< double, const SMDS_MeshNode* >::iterator u_sn = srcNodes.begin();
517 for ( ; u_tn != tgtNodes.end(); ++u_tn, ++u_sn)
518 src2tgtNodes.insert( make_pair( u_sn->second, u_tn->second ));
523 // prepare the helper adding quadratic elements if necessary
524 SMESH_MesherHelper helper( *tgtMesh );
525 helper.SetSubShape( tgtFace );
526 helper.IsQuadraticSubMesh( tgtFace );
527 helper.SetElementsOnShape( true );
529 SMESH_MesherHelper srcHelper( *srcMesh );
530 srcHelper.SetSubShape( srcFace );
532 const SMDS_MeshNode* nullNode = 0;
534 SMESHDS_SubMesh* srcSubDS = srcMesh->GetMeshDS()->MeshElements( srcFace );
535 SMDS_ElemIteratorPtr elemIt = srcSubDS->GetElements();
536 vector< const SMDS_MeshNode* > tgtNodes;
537 while ( elemIt->more() ) // loop on all mesh faces on srcFace
539 const SMDS_MeshElement* elem = elemIt->next();
540 const int nbN = elem->NbCornerNodes();
541 tgtNodes.resize( nbN );
542 for ( int i = 0; i < nbN; ++i ) // loop on nodes of the source element
544 const SMDS_MeshNode* srcNode = elem->GetNode(i);
545 srcN_tgtN = src2tgtNodes.insert( make_pair( srcNode, nullNode )).first;
546 if ( srcN_tgtN->second == nullNode )
549 gp_Pnt tgtP = gp_Pnt(srcNode->X(),srcNode->Y(),srcNode->Z()).Transformed( trsf );
550 SMDS_MeshNode* n = helper.AddNode( tgtP.X(), tgtP.Y(), tgtP.Z() );
551 srcN_tgtN->second = n;
553 gp_Pnt2d srcUV = srcHelper.GetNodeUV( srcFace, srcNode,
554 elem->GetNode( helper.WrapIndex(i+1,nbN)));
555 n->SetPosition( new SMDS_FacePosition( srcUV.X(), srcUV.Y() ));
557 tgtNodes[i] = srcN_tgtN->second;
559 // create a new face (with reversed orientation)
562 case 3: helper.AddFace(tgtNodes[0], tgtNodes[2], tgtNodes[1]); break;
563 case 4: helper.AddFace(tgtNodes[0], tgtNodes[3], tgtNodes[2], tgtNodes[1]); break;
568 } // bool projectPartner()
570 //================================================================================
572 * \brief Preform projection in case if the faces are similar in 2D space
574 //================================================================================
576 bool projectBy2DSimilarity(const TopoDS_Face& tgtFace,
577 const TopoDS_Face& srcFace,
578 SMESH_Mesh * tgtMesh,
579 SMESH_Mesh * srcMesh,
580 const TAssocTool::TShapeShapeMap& shape2ShapeMap)
584 // get ordered src EDGEs
586 TSideVector srcWires =
587 StdMeshers_FaceSide::GetFaceWires( srcFace, *srcMesh,/*theIgnoreMediumNodes = */false, err);
588 if ( err && !err->IsOK() )
591 // make corresponding sequence of tgt EDGEs
592 TSideVector tgtWires( srcWires.size() );
593 for ( unsigned iW = 0; iW < srcWires.size(); ++iW )
595 list< TopoDS_Edge > tgtEdges;
596 StdMeshers_FaceSidePtr srcWire = srcWires[iW];
597 for ( int iE = 0; iE < srcWire->NbEdges(); ++iE )
598 tgtEdges.push_back( TopoDS::Edge( shape2ShapeMap( srcWire->Edge( iE ))));
600 tgtWires[ iW ].reset( new StdMeshers_FaceSide( tgtFace, tgtEdges, tgtMesh,
601 /*theIsForward = */ true,
602 /*theIgnoreMediumNodes = */false));
603 if ( srcWires[iW]->GetUVPtStruct().size() !=
604 tgtWires[iW]->GetUVPtStruct().size())
608 // 2) Find transformation
612 // get ordered nodes data
613 const vector<UVPtStruct>& srcUVs = srcWires[0]->GetUVPtStruct();
614 const vector<UVPtStruct>& tgtUVs = tgtWires[0]->GetUVPtStruct();
616 // get 2 pairs of corresponding UVs
617 gp_XY srcP0( srcUVs[0].u, srcUVs[0].v );
618 gp_XY srcP1( srcUVs[1].u, srcUVs[1].v );
619 gp_XY tgtP0( tgtUVs[0].u, tgtUVs[0].v );
620 gp_XY tgtP1( tgtUVs[1].u, tgtUVs[1].v );
622 // make transformation
623 gp_Trsf2d fromTgtCS, toSrcCS; // from/to global CS
624 gp_Ax2d srcCS( srcP0, gp_Vec2d( srcP0, srcP1 ));
625 gp_Ax2d tgtCS( tgtP0, gp_Vec2d( tgtP0, tgtP1 ));
626 toSrcCS .SetTransformation( srcCS );
627 fromTgtCS.SetTransformation( tgtCS );
630 trsf = fromTgtCS * toSrcCS;
632 // check transformation
633 const double tol = 1e-5 * gp_Vec2d( srcP0, srcP1 ).Magnitude();
634 const int nbCheckPnt = Min( 10, srcUVs.size()-2 );
635 const int dP = ( srcUVs.size()-2 ) / nbCheckPnt;
636 for ( unsigned iP = 2; iP < srcUVs.size(); iP += dP )
638 gp_Pnt2d srcUV( srcUVs[iP].u, srcUVs[iP].v );
639 gp_Pnt2d tgtUV( tgtUVs[iP].u, tgtUVs[iP].v );
640 gp_Pnt2d tgtUV2 = srcUV.Transformed( trsf );
641 if ( tgtUV.Distance( tgtUV2 ) > tol )
648 typedef map<const SMDS_MeshNode* , const SMDS_MeshNode*, TIDCompare> TN2NMap;
649 TN2NMap src2tgtNodes;
650 TN2NMap::iterator srcN_tgtN;
652 // fill src2tgtNodes in with nodes on EDGEs
653 for ( unsigned iW = 0; iW < srcWires.size(); ++iW )
655 const vector<UVPtStruct>& srcUVs = srcWires[iW]->GetUVPtStruct();
656 const vector<UVPtStruct>& tgtUVs = tgtWires[iW]->GetUVPtStruct();
657 for ( unsigned i = 0; i < srcUVs.size(); ++i )
658 src2tgtNodes.insert( make_pair( srcUVs[i].node, tgtUVs[i].node ));
662 SMESH_MesherHelper helper( *tgtMesh );
663 helper.SetSubShape( tgtFace );
664 helper.IsQuadraticSubMesh( tgtFace );
665 helper.SetElementsOnShape( true );
666 Handle(Geom_Surface) tgtSurface = BRep_Tool::Surface( tgtFace );
668 SMESH_MesherHelper srcHelper( *srcMesh );
669 srcHelper.SetSubShape( srcFace );
671 const SMDS_MeshNode* nullNode = 0;
673 SMESHDS_SubMesh* srcSubDS = srcMesh->GetMeshDS()->MeshElements( srcFace );
674 SMDS_ElemIteratorPtr elemIt = srcSubDS->GetElements();
675 vector< const SMDS_MeshNode* > tgtNodes;
677 while ( elemIt->more() ) // loop on all mesh faces on srcFace
679 const SMDS_MeshElement* elem = elemIt->next();
680 const int nbN = elem->NbCornerNodes();
681 tgtNodes.resize( nbN );
682 for ( int i = 0; i < nbN; ++i ) // loop on nodes of the source element
684 const SMDS_MeshNode* srcNode = elem->GetNode(i);
685 srcN_tgtN = src2tgtNodes.insert( make_pair( srcNode, nullNode )).first;
686 if ( srcN_tgtN->second == nullNode )
689 gp_Pnt2d srcUV = srcHelper.GetNodeUV( srcFace, srcNode,
690 elem->GetNode( helper.WrapIndex(i+1,nbN)), &uvOK);
692 gp_Pnt2d tgtUV = srcUV.Transformed( trsf );
693 gp_Pnt tgtP = tgtSurface->Value( tgtUV.X(), tgtUV.Y() );
694 SMDS_MeshNode* n = helper.AddNode( tgtP.X(), tgtP.Y(), tgtP.Z() );
695 n->SetPosition( new SMDS_FacePosition( tgtUV.X(), tgtUV.Y() ));
696 srcN_tgtN->second = n;
698 tgtNodes[i] = srcN_tgtN->second;
700 // create a new face (with reversed orientation)
703 case 3: helper.AddFace(tgtNodes[0], tgtNodes[2], tgtNodes[1]); break;
704 case 4: helper.AddFace(tgtNodes[0], tgtNodes[3], tgtNodes[2], tgtNodes[1]); break;
709 } // bool projectBy2DSimilarity()
715 //=======================================================================
718 //=======================================================================
720 bool StdMeshers_Projection_2D::Compute(SMESH_Mesh& theMesh, const TopoDS_Shape& theShape)
722 MESSAGE("Projection_2D Compute");
726 SMESH_Mesh * srcMesh = _sourceHypo->GetSourceMesh();
727 SMESH_Mesh * tgtMesh = & theMesh;
731 SMESHDS_Mesh * meshDS = theMesh.GetMeshDS();
733 // ---------------------------
734 // Make subshapes association
735 // ---------------------------
737 TopoDS_Face tgtFace = TopoDS::Face( theShape.Oriented(TopAbs_FORWARD));
738 TopoDS_Shape srcShape = _sourceHypo->GetSourceFace().Oriented(TopAbs_FORWARD);
740 TAssocTool::TShapeShapeMap shape2ShapeMap;
741 TAssocTool::InitVertexAssociation( _sourceHypo, shape2ShapeMap, tgtFace );
742 if ( !TAssocTool::FindSubShapeAssociation( tgtFace, tgtMesh, srcShape, srcMesh,
744 !shape2ShapeMap.IsBound( tgtFace ))
745 return error(COMPERR_BAD_SHAPE,"Topology of source and target faces seems different" );
747 TopoDS_Face srcFace = TopoDS::Face( shape2ShapeMap( tgtFace ).Oriented(TopAbs_FORWARD));
749 // ----------------------------------------------
750 // Assure that mesh on a source Face is computed
751 // ----------------------------------------------
753 SMESH_subMesh* srcSubMesh = srcMesh->GetSubMesh( srcFace );
754 SMESH_subMesh* tgtSubMesh = tgtMesh->GetSubMesh( tgtFace );
756 if ( tgtMesh == srcMesh ) {
757 if ( !TAssocTool::MakeComputed( srcSubMesh ))
758 return error(COMPERR_BAD_INPUT_MESH,"Source mesh not computed");
761 if ( !srcSubMesh->IsMeshComputed() )
762 return error(COMPERR_BAD_INPUT_MESH,"Source mesh not computed");
765 // try to project from same face with different location
766 if ( projectPartner( tgtFace, srcFace, tgtMesh, srcMesh, shape2ShapeMap ))
769 if ( projectBy2DSimilarity( tgtFace, srcFace, tgtMesh, srcMesh, shape2ShapeMap ))
772 // --------------------
773 // Prepare to mapping
774 // --------------------
776 SMESH_MesherHelper helper( theMesh );
777 helper.SetSubShape( tgtFace );
779 // Check if node projection to a face is needed
781 SMDS_ElemIteratorPtr faceIt = srcSubMesh->GetSubMeshDS()->GetElements();
783 for ( ; nbFaceNodes < 3 && faceIt->more(); ) {
784 const SMDS_MeshElement* face = faceIt->next();
785 SMDS_ElemIteratorPtr nodeIt = face->nodesIterator();
786 while ( nodeIt->more() ) {
787 const SMDS_MeshNode* node = static_cast<const SMDS_MeshNode*>( nodeIt->next() );
788 if ( node->GetPosition()->GetTypeOfPosition() == SMDS_TOP_FACE ) {
790 uvBox.Add( helper.GetNodeUV( srcFace, node ));
794 const bool toProjectNodes =
795 ( nbFaceNodes > 0 && ( uvBox.IsVoid() || uvBox.SquareExtent() < DBL_MIN ));
797 // Load pattern from the source face
798 SMESH_Pattern mapper;
799 mapper.Load( srcMesh, srcFace, toProjectNodes );
800 if ( mapper.GetErrorCode() != SMESH_Pattern::ERR_OK )
801 return error(COMPERR_BAD_INPUT_MESH,"Can't load mesh pattern from the source face");
803 // Find the first target vertex corresponding to first vertex of the <mapper>
804 // and <theReverse> flag needed to call mapper.Apply()
806 TopoDS_Vertex srcV1 = TopoDS::Vertex( mapper.GetSubShape( 1 ));
807 if ( srcV1.IsNull() )
808 RETURN_BAD_RESULT("Mesh is not bound to the face");
809 if ( !shape2ShapeMap.IsBound( srcV1 ))
810 RETURN_BAD_RESULT("Not associated vertices, srcV1 " << srcV1.TShape().operator->() );
811 TopoDS_Vertex tgtV1 = TopoDS::Vertex( shape2ShapeMap( srcV1 ));
813 if ( !SMESH_MesherHelper::IsSubShape( srcV1, srcFace ))
814 RETURN_BAD_RESULT("Wrong srcV1 " << srcV1.TShape().operator->());
815 if ( !SMESH_MesherHelper::IsSubShape( tgtV1, tgtFace ))
816 RETURN_BAD_RESULT("Wrong tgtV1 " << tgtV1.TShape().operator->());
818 // try to find out orientation by order of edges
819 bool reverse = false;
820 list< TopoDS_Edge > tgtEdges, srcEdges;
821 list< int > nbEdgesInWires;
822 SMESH_Block::GetOrderedEdges( tgtFace, tgtV1, tgtEdges, nbEdgesInWires);
823 SMESH_Block::GetOrderedEdges( srcFace, srcV1, srcEdges, nbEdgesInWires);
824 if ( nbEdgesInWires.front() > 1 ) // possible to find out
826 TopoDS_Edge srcE1 = srcEdges.front(), tgtE1 = tgtEdges.front();
827 TopoDS_Shape srcE1bis = shape2ShapeMap( tgtE1 );
828 reverse = ( ! srcE1.IsSame( srcE1bis ));
830 else if ( nbEdgesInWires.front() == 1 )
832 // TODO::Compare orientation of curves in a sole edge
833 //RETURN_BAD_RESULT("Not implemented case");
837 RETURN_BAD_RESULT("Bad result from SMESH_Block::GetOrderedEdges()");
840 // --------------------
841 // Perform 2D mapping
842 // --------------------
844 // Compute mesh on a target face
846 mapper.Apply( tgtFace, tgtV1, reverse );
847 if ( mapper.GetErrorCode() != SMESH_Pattern::ERR_OK )
848 return error("Can't apply source mesh pattern to the face");
852 const bool toCreatePolygons = false, toCreatePolyedrs = false;
853 mapper.MakeMesh( tgtMesh, toCreatePolygons, toCreatePolyedrs );
854 if ( mapper.GetErrorCode() != SMESH_Pattern::ERR_OK )
855 return error("Can't make mesh by source mesh pattern");
857 // it will remove mesh built by pattern mapper on edges and vertices
859 MeshCleaner cleaner( tgtSubMesh );
861 // -------------------------------------------------------------------------
862 // mapper doesn't take care of nodes already existing on edges and vertices,
863 // so we must merge nodes created by it with existing ones
864 // -------------------------------------------------------------------------
866 SMESH_MeshEditor editor( tgtMesh );
867 SMESH_MeshEditor::TListOfListOfNodes groupsOfNodes;
869 // Make groups of nodes to merge
871 // loop on edge and vertex submeshes of a target face
872 SMESH_subMeshIteratorPtr smIt = tgtSubMesh->getDependsOnIterator(false,false);
873 while ( smIt->more() )
875 SMESH_subMesh* sm = smIt->next();
876 SMESHDS_SubMesh* smDS = sm->GetSubMeshDS();
878 // Sort new and old nodes of a submesh separately
880 bool isSeam = helper.IsRealSeam( sm->GetId() );
882 enum { NEW_NODES = 0, OLD_NODES };
883 map< double, const SMDS_MeshNode* > u2nodesMaps[2], u2nodesOnSeam;
884 map< double, const SMDS_MeshNode* >::iterator u_oldNode, u_newNode, u_newOnSeam, newEnd;
885 set< const SMDS_MeshNode* > seamNodes;
887 // mapper puts on a seam edge nodes from 2 edges
888 if ( isSeam && ! getBoundaryNodes ( sm, tgtFace, u2nodesOnSeam, seamNodes ))
889 RETURN_BAD_RESULT("getBoundaryNodes() failed");
891 SMDS_NodeIteratorPtr nIt = smDS->GetNodes();
892 while ( nIt->more() )
894 const SMDS_MeshNode* node = nIt->next();
895 bool isOld = isOldNode( node );
897 if ( !isOld && isSeam ) { // new node on a seam edge
898 if ( seamNodes.find( node ) != seamNodes.end())
899 continue; // node is already in the map
902 // sort nodes on edges by their position
903 map< double, const SMDS_MeshNode* > & pos2nodes = u2nodesMaps[isOld ? OLD_NODES : NEW_NODES];
904 switch ( node->GetPosition()->GetTypeOfPosition() )
906 case SMDS_TOP_VERTEX: {
907 pos2nodes.insert( make_pair( 0, node ));
910 case SMDS_TOP_EDGE: {
911 const SMDS_EdgePosition* pos =
912 static_cast<const SMDS_EdgePosition*>(node->GetPosition());
913 pos2nodes.insert( make_pair( pos->GetUParameter(), node ));
917 RETURN_BAD_RESULT("Wrong node position type: "<<
918 node->GetPosition()->GetTypeOfPosition());
921 if ( u2nodesMaps[ NEW_NODES ].size() != u2nodesMaps[ OLD_NODES ].size() )
923 if ( u2nodesMaps[ NEW_NODES ].size() == 0 &&
924 sm->GetSubShape().ShapeType() == TopAbs_EDGE &&
925 helper.IsDegenShape( sm->GetId() ) )
926 // NPAL15894 (tt88bis.py) - project mesh built by NETGEN_1d_2D that
927 // does not make segments/nodes on degenerated edges
930 RETURN_BAD_RESULT("Different nb of old and new nodes on shape #"<< sm->GetId() <<" "<<
931 u2nodesMaps[ OLD_NODES ].size() << " != " <<
932 u2nodesMaps[ NEW_NODES ].size());
934 if ( isSeam && u2nodesMaps[ OLD_NODES ].size() != u2nodesOnSeam.size() ) {
935 RETURN_BAD_RESULT("Different nb of old and seam nodes " <<
936 u2nodesMaps[ OLD_NODES ].size() << " != " << u2nodesOnSeam.size());
938 // Make groups of nodes to merge
939 u_oldNode = u2nodesMaps[ OLD_NODES ].begin();
940 u_newNode = u2nodesMaps[ NEW_NODES ].begin();
941 newEnd = u2nodesMaps[ NEW_NODES ].end();
942 u_newOnSeam = u2nodesOnSeam.begin();
943 for ( ; u_newNode != newEnd; ++u_newNode, ++u_oldNode ) {
944 groupsOfNodes.push_back( list< const SMDS_MeshNode* >() );
945 groupsOfNodes.back().push_back( u_oldNode->second );
946 groupsOfNodes.back().push_back( u_newNode->second );
948 groupsOfNodes.back().push_back( (u_newOnSeam++)->second );
954 int nbFaceBeforeMerge = tgtSubMesh->GetSubMeshDS()->NbElements();
955 editor.MergeNodes( groupsOfNodes );
956 int nbFaceAtferMerge = tgtSubMesh->GetSubMeshDS()->NbElements();
957 if ( nbFaceBeforeMerge != nbFaceAtferMerge )
958 return error(COMPERR_BAD_INPUT_MESH, "Probably invalid node parameters on geom faces");
960 // ---------------------------
961 // Check elements orientation
962 // ---------------------------
964 TopoDS_Face face = tgtFace;
965 if ( !theMesh.IsMainShape( tgtFace ))
967 // find the main shape
968 TopoDS_Shape mainShape = meshDS->ShapeToMesh();
969 switch ( mainShape.ShapeType() ) {
971 case TopAbs_SOLID: break;
973 TopTools_ListIteratorOfListOfShape ancestIt = theMesh.GetAncestors( face );
974 for ( ; ancestIt.More(); ancestIt.Next() ) {
975 TopAbs_ShapeEnum type = ancestIt.Value().ShapeType();
976 if ( type == TopAbs_SOLID ) {
977 mainShape = ancestIt.Value();
979 } else if ( type == TopAbs_SHELL ) {
980 mainShape = ancestIt.Value();
984 // find tgtFace in the main solid or shell to know it's true orientation.
985 TopExp_Explorer exp( mainShape, TopAbs_FACE );
986 for ( ; exp.More(); exp.Next() ) {
987 if ( tgtFace.IsSame( exp.Current() )) {
988 face = TopoDS::Face( exp.Current() );
994 if ( SMESH_Algo::IsReversedSubMesh( face, meshDS ))
996 SMDS_ElemIteratorPtr eIt = meshDS->MeshElements( face )->GetElements();
997 while ( eIt->more() ) {
998 const SMDS_MeshElement* e = eIt->next();
999 if ( e->GetType() == SMDSAbs_Face && !editor.Reorient( e ))
1000 RETURN_BAD_RESULT("Pb of SMESH_MeshEditor::Reorient()");
1004 cleaner.Release(); // do not remove mesh
1010 //=======================================================================
1011 //function : Evaluate
1013 //=======================================================================
1015 bool StdMeshers_Projection_2D::Evaluate(SMESH_Mesh& theMesh,
1016 const TopoDS_Shape& theShape,
1017 MapShapeNbElems& aResMap)
1022 SMESH_Mesh * srcMesh = _sourceHypo->GetSourceMesh();
1023 SMESH_Mesh * tgtMesh = & theMesh;
1027 // ---------------------------
1028 // Make subshapes association
1029 // ---------------------------
1031 TopoDS_Face tgtFace = TopoDS::Face( theShape.Oriented(TopAbs_FORWARD));
1032 TopoDS_Shape srcShape = _sourceHypo->GetSourceFace().Oriented(TopAbs_FORWARD);
1034 TAssocTool::TShapeShapeMap shape2ShapeMap;
1035 TAssocTool::InitVertexAssociation( _sourceHypo, shape2ShapeMap, tgtFace );
1036 if ( !TAssocTool::FindSubShapeAssociation( tgtFace, tgtMesh, srcShape, srcMesh,
1038 !shape2ShapeMap.IsBound( tgtFace ))
1039 return error(COMPERR_BAD_SHAPE,"Topology of source and target faces seems different" );
1041 TopoDS_Face srcFace = TopoDS::Face( shape2ShapeMap( tgtFace ).Oriented(TopAbs_FORWARD));
1043 // ----------------------------------------------
1044 // Assure that mesh on a source Face is computed
1045 // ----------------------------------------------
1047 SMESH_subMesh* srcSubMesh = srcMesh->GetSubMesh( srcFace );
1049 if ( !srcSubMesh->IsMeshComputed() )
1050 return error(COMPERR_BAD_INPUT_MESH,"Source mesh not computed");
1053 std::vector<int> aVec(SMDSEntity_Last);
1054 for(int i=SMDSEntity_Node; i<SMDSEntity_Last; i++) aVec[i] = 0;
1056 aVec[SMDSEntity_Node] = srcSubMesh->GetSubMeshDS()->NbNodes();
1058 //bool quadratic = false;
1059 SMDS_ElemIteratorPtr elemIt = srcSubMesh->GetSubMeshDS()->GetElements();
1060 while ( elemIt->more() ) {
1061 const SMDS_MeshElement* E = elemIt->next();
1062 if( E->NbNodes()==3 ) {
1063 aVec[SMDSEntity_Triangle]++;
1065 else if( E->NbNodes()==4 ) {
1066 aVec[SMDSEntity_Quadrangle]++;
1068 else if( E->NbNodes()==6 && E->IsQuadratic() ) {
1069 aVec[SMDSEntity_Quad_Triangle]++;
1071 else if( E->NbNodes()==8 && E->IsQuadratic() ) {
1072 aVec[SMDSEntity_Quad_Quadrangle]++;
1075 aVec[SMDSEntity_Polygon]++;
1079 SMESH_subMesh * sm = theMesh.GetSubMesh(theShape);
1080 aResMap.insert(std::make_pair(sm,aVec));
1086 //=============================================================================
1088 * \brief Sets a default event listener to submesh of the source face
1089 * \param subMesh - submesh where algo is set
1091 * This method is called when a submesh gets HYP_OK algo_state.
1092 * After being set, event listener is notified on each event of a submesh.
1093 * Arranges that CLEAN event is translated from source submesh to
1096 //=============================================================================
1098 void StdMeshers_Projection_2D::SetEventListener(SMESH_subMesh* subMesh)
1100 TAssocTool::SetEventListener( subMesh,
1101 _sourceHypo->GetSourceFace(),
1102 _sourceHypo->GetSourceMesh() );