1 // Copyright (C) 2007-2016 CEA/DEN, EDF R&D, OPEN CASCADE
3 // This library is free software; you can redistribute it and/or
4 // modify it under the terms of the GNU Lesser General Public
5 // License as published by the Free Software Foundation; either
6 // version 2.1 of the License, or (at your option) any later version.
8 // This library is distributed in the hope that it will be useful,
9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 // Lesser General Public License for more details.
13 // You should have received a copy of the GNU Lesser General Public
14 // License along with this library; if not, write to the Free Software
15 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
17 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
19 // File : SMESH_FreeBorders.cxx
20 // Created : Tue Sep 8 17:08:39 2015
21 // Author : Edward AGAPOV (eap)
23 //================================================================================
24 // Implementation of SMESH_MeshAlgos::FindCoincidentFreeBorders()
25 //================================================================================
27 #include "SMESH_MeshAlgos.hxx"
29 #include "SMDS_LinearEdge.hxx"
30 #include "SMDS_Mesh.hxx"
31 #include "SMDS_SetIterator.hxx"
38 #include <NCollection_DataMap.hxx>
41 using namespace SMESH_MeshAlgos;
48 * \brief Node on a free border
50 struct BNode : public SMESH_TNodeXYZ
52 mutable std::vector< BEdge* > myLinkedEdges;
53 mutable std::vector< std::pair < BEdge*, double > > myCloseEdges; // edge & U
55 BNode(const SMDS_MeshNode * node): SMESH_TNodeXYZ( node ) {}
56 const SMDS_MeshNode * Node() const { return _node; }
57 void AddLinked( BEdge* e ) const;
58 void AddClose ( const BEdge* e, double u ) const;
59 BEdge* GetCloseEdge( size_t i ) const { return myCloseEdges[i].first; }
60 double GetCloseU( size_t i ) const { return myCloseEdges[i].second; }
61 BEdge* GetCloseEdgeOfBorder( int borderID, double * u = 0 ) const;
62 bool HasCloseEdgeWithNode( const BNode* n ) const;
63 bool IsCloseEdge( const BEdge*, double * u = 0 ) const;
64 bool operator<(const BNode& other) const { return Node()->GetID() < other.Node()->GetID(); }
67 * \brief Edge of a free border
69 struct BEdge : public SMDS_LinearEdge
71 const BNode* myBNode1;
72 const BNode* myBNode2;
74 int myID; // within a border
77 const SMDS_MeshElement* myFace;
78 std::set< int > myCloseBorders;
81 BEdge():SMDS_LinearEdge( 0, 0 ), myBorderID(-1), myID(-1), myPrev(0), myNext(0), myInGroup(-1) {}
83 void Set( const BNode * node1,
85 const SMDS_MeshElement* face,
90 myNodes[0] = node1->Node();
91 myNodes[1] = node2->Node();
93 setId( ID ); // mesh element ID
95 bool IsInGroup() const
97 return myInGroup >= 0;
99 bool Contains( const BNode* n ) const
101 return ( n == myBNode1 || n == myBNode2 );
103 void AddLinked( BEdge* e )
105 if ( e->Contains( myBNode1 )) myPrev = e;
108 void RemoveLinked( BEdge* e )
110 if ( myPrev == e ) myPrev = 0;
111 if ( myNext == e ) myNext = 0;
115 std::swap( myBNode1, myBNode2 );
116 myNodes[0] = myBNode1->Node();
117 myNodes[1] = myBNode2->Node();
121 if (( myPrev && !myPrev->Contains( myBNode1 )) ||
122 ( myNext && !myNext->Contains( myBNode2 )))
123 std::swap( myPrev, myNext );
124 if ( myPrev && myPrev->myBNode2 != myBNode1 ) myPrev->Reverse();
125 if ( myNext && myNext->myBNode1 != myBNode2 ) myNext->Reverse();
133 myNext->SetID( id + 1 );
136 bool IsOut( const gp_XYZ& point, const double tol, double& u ) const
138 gp_XYZ me = *myBNode2 - *myBNode1;
139 gp_XYZ n1p = point - *myBNode1;
140 u = ( me * n1p ) / me.SquareModulus(); // param [0,1] on this
141 if ( u < 0. ) return ( n1p.SquareModulus() > tol * tol );
142 if ( u > 1. ) return ( ( point - *myBNode2 ).SquareModulus() > tol * tol );
144 gp_XYZ proj = ( 1. - u ) * *myBNode1 + u * *myBNode2; // projection of the point on this
145 double dist2 = ( point - proj ).SquareModulus();
146 return ( dist2 > tol * tol );
148 bool IsOverlappingProjection( const BEdge* toE, const double u, bool is1st ) const
150 // is1st shows which end of toE is projected on this at u
152 const double eps = 0.1;
153 if ( myBNode1->IsCloseEdge( toE, &u2 ) ||
154 myBNode2->IsCloseEdge( toE, &u2 ))
155 return (( 0 < u2 && u2 < 1 ) && // u2 is proj param of myBNode's on toE
156 ( Abs( u2 - int( !is1st )) > eps ));
158 const BNode* n = is1st ? toE->myBNode2 : toE->myBNode1;
159 if ( this == n->GetCloseEdgeOfBorder( this->myBorderID, &u2 ))
160 return Abs( u - u2 ) > eps;
163 bool GetRangeOfSameCloseBorders(BEdge* eRange[2], const std::set< int >& bordIDs)
165 if ( this->myCloseBorders != bordIDs )
168 if ( bordIDs.size() == 1 && bordIDs.count( myBorderID )) // border close to self
172 while ( eRange[0]->myBNode1->GetCloseEdgeOfBorder( myBorderID, &u ))
174 if ( eRange[0]->myPrev == this || u < 0 || u > 1 )
176 eRange[0] = eRange[0]->myPrev;
179 while ( eRange[1]->myBNode2->GetCloseEdgeOfBorder( myBorderID, &u ))
181 if ( eRange[1]->myNext == this || u < 0 || u > 1 )
183 eRange[1] = eRange[1]->myNext;
189 while ( eRange[0]->myPrev && eRange[0]->myPrev->myCloseBorders == bordIDs )
191 if ( eRange[0]->myPrev == this )
193 eRange[0] = eRange[0]->myPrev;
197 if ( eRange[0]->myPrev != this ) // not closed border
198 while ( eRange[1]->myNext && eRange[1]->myNext->myCloseBorders == bordIDs )
200 if ( eRange[1]->myNext == this )
202 eRange[1] = eRange[1]->myNext;
206 if ( eRange[0] == eRange[1] )
208 std::set<int>::iterator closeBord = eRange[0]->myCloseBorders.begin();
209 for ( ; closeBord != eRange[0]->myCloseBorders.end(); ++closeBord )
211 if ( BEdge* be = eRange[0]->myBNode1->GetCloseEdgeOfBorder( *closeBord ))
212 if ( be->myCloseBorders == eRange[0]->myCloseBorders )
214 if ( BEdge* be = eRange[0]->myBNode2->GetCloseEdgeOfBorder( *closeBord ))
215 if ( be->myCloseBorders == eRange[0]->myCloseBorders )
224 void extendPart( BEdge* & e1, BEdge* & e2, const std::set< int >& bordIDs, int groupID )
226 if (( e1->myPrev == e2 ) ||
227 ( e1 == e2 && e1->myPrev && e1->myPrev->myInGroup == groupID ))
228 return; // full free border already
232 std::set<int>::const_iterator bord;
235 for ( bord = bordIDs.begin(); bord != bordIDs.end(); ++bord )
236 if ((( be = e1->myBNode1->GetCloseEdgeOfBorder( *bord, &u ))) &&
237 ( be->myInGroup == groupID ) &&
238 ( 0 < u && u < 1 ) &&
239 ( be->IsOverlappingProjection( e1->myPrev, u, false )))
244 if ( bord == bordIDs.end() && // not extended
245 e1->myBNode1->HasCloseEdgeWithNode( e1->myPrev->myBNode1 ))
249 e1->myInGroup = groupID;
253 for ( bord = bordIDs.begin(); bord != bordIDs.end(); ++bord )
254 if ((( be = e2->myBNode2->GetCloseEdgeOfBorder( *bord, &u ))) &&
255 ( be->myInGroup == groupID ) &&
256 ( 0 < u && u < 1 ) &&
257 ( be->IsOverlappingProjection( e2->myNext, u, true )))
262 if ( bord == bordIDs.end() && // not extended
263 e2->myBNode2->HasCloseEdgeWithNode( e2->myNext->myBNode2 ))
267 e2->myInGroup = groupID;
271 void BNode::AddLinked( BEdge* e ) const
273 myLinkedEdges.reserve(2);
274 myLinkedEdges.push_back( e );
275 if ( myLinkedEdges.size() < 2 ) return;
277 if ( myLinkedEdges.size() == 2 )
279 myLinkedEdges[0]->AddLinked( myLinkedEdges[1] );
280 myLinkedEdges[1]->AddLinked( myLinkedEdges[0] );
284 for ( size_t i = 0; i < myLinkedEdges.size(); ++i )
285 for ( size_t j = 0; j < myLinkedEdges.size(); ++j )
287 myLinkedEdges[i]->RemoveLinked( myLinkedEdges[j] );
290 void BNode::AddClose ( const BEdge* e, double u ) const
292 if ( ! e->Contains( this ))
293 myCloseEdges.push_back( std::make_pair( const_cast< BEdge* >( e ), u ));
295 BEdge* BNode::GetCloseEdgeOfBorder( int borderID, double * uPtr ) const
299 for ( size_t i = 0; i < myCloseEdges.size(); ++i )
300 if ( borderID == GetCloseEdge( i )->myBorderID )
302 if ( e && Abs( u - 0.5 ) < Abs( GetCloseU( i ) - 0.5 ))
305 e = GetCloseEdge ( i );
307 if ( uPtr ) *uPtr = u;
310 bool BNode::HasCloseEdgeWithNode( const BNode* n ) const
312 for ( size_t i = 0; i < myCloseEdges.size(); ++i )
313 if ( GetCloseEdge( i )->Contains( n ) &&
314 0 < GetCloseU( i ) && GetCloseU( i ) < 1 )
318 bool BNode::IsCloseEdge( const BEdge* e, double * uPtr ) const
320 for ( size_t i = 0; i < myCloseEdges.size(); ++i )
321 if ( e == GetCloseEdge( i ) )
323 if ( uPtr ) *uPtr = GetCloseU( i );
329 /// Accessor to SMDS_MeshElement* inherited by BEdge
332 static const SMDS_MeshElement* value( std::vector< BEdge >::const_iterator it)
337 /// Iterator over a vector of BEdge's
338 static SMDS_ElemIteratorPtr getElemIterator( const std::vector< BEdge > & bedges )
340 typedef SMDS_SetIterator
341 < const SMDS_MeshElement*, std::vector< BEdge >::const_iterator, ElemAcess > BEIter;
342 return SMDS_ElemIteratorPtr( new BEIter( bedges.begin(), bedges.end() ));
347 //================================================================================
349 * Returns groups of TFreeBorder's coincident within the given tolerance.
350 * If the tolerance <= 0.0 then one tenth of an average size of elements adjacent
351 * to free borders being compared is used.
353 //================================================================================
355 void SMESH_MeshAlgos::FindCoincidentFreeBorders(SMDS_Mesh& mesh,
357 CoincidentFreeBorders & foundFreeBordes)
360 typedef NCollection_DataMap<SMESH_TLink, const SMDS_MeshElement*, SMESH_TLink > TLink2FaceMap;
361 TLink2FaceMap linkMap;
362 int nbSharedLinks = 0;
363 SMDS_FaceIteratorPtr faceIt = mesh.facesIterator();
364 while ( faceIt->more() )
366 const SMDS_MeshElement* face = faceIt->next();
367 if ( !face ) continue;
369 const SMDS_MeshNode* n0 = face->GetNode( face->NbNodes() - 1 );
370 SMDS_NodeIteratorPtr nodeIt = face->interlacedNodesIterator();
371 while ( nodeIt->more() )
373 const SMDS_MeshNode* n1 = nodeIt->next();
374 SMESH_TLink link( n0, n1 );
375 if ( const SMDS_MeshElement** faceInMap = linkMap.ChangeSeek( link ))
377 nbSharedLinks += bool( *faceInMap );
382 linkMap.Bind( link, face );
387 if ( linkMap.Extent() == nbSharedLinks )
391 std::set < BNode > bNodes;
392 std::vector< BEdge > bEdges( linkMap.Extent() - nbSharedLinks );
394 TLink2FaceMap::Iterator linkIt( linkMap );
395 for ( int iEdge = 0; linkIt.More(); linkIt.Next() )
397 if ( !linkIt.Value() ) continue;
398 const SMESH_TLink & link = linkIt.Key();
399 std::set< BNode >::iterator n1 = bNodes.insert( BNode( link.node1() )).first;
400 std::set< BNode >::iterator n2 = bNodes.insert( BNode( link.node2() )).first;
401 bEdges[ iEdge ].Set( &*n1, &*n2, linkIt.Value(), iEdge+1 );
402 n1->AddLinked( & bEdges[ iEdge ] );
403 n2->AddLinked( & bEdges[ iEdge ] );
408 // assign IDs to borders
409 std::vector< BEdge* > borders; // 1st of connected (via myPrev and myNext) edges
410 std::set< BNode >::iterator bn = bNodes.begin();
411 for ( ; bn != bNodes.end(); ++bn )
413 for ( size_t i = 0; i < bn->myLinkedEdges.size(); ++i )
415 if ( bn->myLinkedEdges[i]->myBorderID < 0 )
417 BEdge* be = bn->myLinkedEdges[i];
418 int borderID = borders.size();
419 borders.push_back( be );
420 for ( ; be && be->myBorderID < 0; be = be->myNext )
422 be->myBorderID = borderID;
425 bool isClosed = ( be == bn->myLinkedEdges[i] );
426 be = bn->myLinkedEdges[i]->myPrev;
427 for ( ; be && be->myBorderID < 0; be = be->myPrev )
429 be->myBorderID = borderID;
433 while ( borders.back()->myPrev )
434 borders.back() = borders.back()->myPrev;
436 borders.back()->SetID( 0 ); // set IDs to all edges of the border
441 // compute tolerance of each border
442 double maxTolerance = tolerance;
443 std::vector< double > bordToler( borders.size(), tolerance );
444 if ( maxTolerance < std::numeric_limits< double >::min() )
446 // no tolerance provided by the user; compute tolerance of each border
447 // as one tenth of an average size of faces adjacent to a border
448 for ( size_t i = 0; i < borders.size(); ++i )
450 double avgFaceSize = 0;
452 BEdge* be = borders[ i ];
454 double facePerimeter = 0;
455 gp_Pnt p0 = SMESH_TNodeXYZ( be->myFace->GetNode( be->myFace->NbNodes() - 1 ));
456 SMDS_NodeIteratorPtr nodeIt = be->myFace->interlacedNodesIterator();
457 while ( nodeIt->more() )
459 gp_Pnt p1 = SMESH_TNodeXYZ( nodeIt->next() );
460 facePerimeter += p0.Distance( p1 );
463 avgFaceSize += ( facePerimeter / be->myFace->NbCornerNodes() );
468 while ( be && be != borders[i] );
470 bordToler[ i ] = 0.1 * avgFaceSize / nbFaces;
471 maxTolerance = Max( maxTolerance, bordToler[ i ]);
475 // for every border node find close border edges
476 SMESH_ElementSearcher* searcher =
477 GetElementSearcher( mesh, getElemIterator( bEdges ), maxTolerance );
478 SMESHUtils::Deleter< SMESH_ElementSearcher > searcherDeleter( searcher );
479 std::vector< const SMDS_MeshElement* > candidateEdges;
480 for ( bn = bNodes.begin(); bn != bNodes.end(); ++bn )
482 searcher->FindElementsByPoint( *bn, SMDSAbs_Edge, candidateEdges );
483 if ( candidateEdges.size() <= bn->myLinkedEdges.size() )
486 double nodeTol = 0, u;
487 for ( size_t i = 0; i < bn->myLinkedEdges.size(); ++i )
488 nodeTol = Max( nodeTol, bordToler[ bn->myLinkedEdges[ i ]->myBorderID ]);
490 for ( size_t i = 0; i < candidateEdges.size(); ++i )
492 const BEdge* be = static_cast< const BEdge* >( candidateEdges[ i ]);
493 double tol = Max( nodeTol, bordToler[ be->myBorderID ]);
494 if ( !be->IsOut( *bn, tol, u ))
495 bn->AddClose( be, u );
499 // for every border edge find close borders
501 std::vector< BEdge* > closeEdges;
502 for ( size_t i = 0; i < bEdges.size(); ++i )
504 BEdge& be = bEdges[i];
505 if ( be.myBNode1->myCloseEdges.empty() ||
506 be.myBNode2->myCloseEdges.empty() )
510 for ( size_t iE1 = 0; iE1 < be.myBNode1->myCloseEdges.size(); ++iE1 )
512 // find edges of the same border close to both nodes of the edge
513 BEdge* closeE1 = be.myBNode1->GetCloseEdge( iE1 );
514 BEdge* closeE2 = be.myBNode2->GetCloseEdgeOfBorder( closeE1->myBorderID );
517 // check that edges connecting closeE1 and closeE2 (if any) are also close to 'be'
518 if ( closeE1 != closeE2 )
521 for ( int j = 0; j < 2; ++j ) // move closeE1 -> closeE2 or inversely
525 coincide = ( ce->myBNode2->GetCloseEdgeOfBorder( be.myBorderID ));
527 } while ( coincide && ce && ce != closeE2 );
529 if ( coincide && ce == closeE2 )
532 std::swap( closeE1, closeE2 );
537 closeEdges.push_back( closeE1 );
538 closeEdges.push_back( closeE2 );
542 closeEdges.push_back( closeE1 );
544 be.myCloseBorders.insert( closeE1->myBorderID );
546 if ( !closeEdges.empty() )
548 be.myCloseBorders.insert( be.myBorderID );
549 // for ( size_t iB = 0; iB < closeEdges.size(); ++iB )
550 // closeEdges[ iB ]->myCloseBorders.insert( be.myCloseBorders.begin(),
551 // be.myCloseBorders.end() );
555 // Fill in CoincidentFreeBorders
557 // save nodes of free borders
558 foundFreeBordes._borders.resize( borders.size() );
559 for ( size_t i = 0; i < borders.size(); ++i )
561 BEdge* be = borders[i];
562 foundFreeBordes._borders[i].push_back( be->myBNode1->Node() );
564 foundFreeBordes._borders[i].push_back( be->myBNode2->Node() );
567 while ( be && be != borders[i] );
570 // form groups of coincident parts of free borders
572 TFreeBorderPart part;
573 TCoincidentGroup group;
574 std::vector< BEdge* > ranges; // couples of edges delimiting parts
575 BEdge* be = 0; // a current edge
576 int skipGroup = bEdges.size(); // a group ID used to avoid repeating treatment of edges
578 for ( int i = 0, nbBords = borders.size(); i < nbBords; i += bool(!be) )
583 // look for an edge close to other borders
585 if ( !be->IsInGroup() && !be->myCloseBorders.empty() )
588 } while ( be && be != borders[i] );
590 if ( !be || be->IsInGroup() || be->myCloseBorders.empty() )
593 continue; // all edges of a border are treated or non-coincident
598 // look for the 1st and last edge of a coincident group
600 if ( !be->GetRangeOfSameCloseBorders( beRange, be->myCloseBorders ))
602 be->myInGroup = skipGroup;
607 ranges.push_back( beRange[0] );
608 ranges.push_back( beRange[1] );
610 int groupID = foundFreeBordes._coincidentGroups.size();
612 be->myInGroup = groupID;
613 while ( be != beRange[1] )
615 be->myInGroup = groupID;
618 beRange[1]->myInGroup = groupID;
620 // get starting edge of each close border
623 if ( be->myCloseBorders.empty() )
624 be = beRange[0]->myNext;
625 std::set<int>::iterator closeBord = be->myCloseBorders.begin();
626 for ( ; closeBord != be->myCloseBorders.end(); ++closeBord )
627 if ( BEdge* e = be->myBNode2->GetCloseEdgeOfBorder( *closeBord ))
628 closeEdges.push_back( e );
630 for ( size_t iE = 0; iE < closeEdges.size(); ++iE )
631 if ( be->myCloseBorders != closeEdges[iE]->myCloseBorders )
633 closeBord = closeEdges[iE]->myCloseBorders.begin();
634 for ( ; closeBord != closeEdges[iE]->myCloseBorders.end(); ++closeBord )
635 if ( !be->myCloseBorders.count( *closeBord ))
636 if ( BEdge* e = closeEdges[iE]->myBNode2->GetCloseEdgeOfBorder( *closeBord ))
637 if ( std::find( closeEdges.begin(), closeEdges.end(), e ) == closeEdges.end() )
638 closeEdges.push_back( e );
641 // add parts of other borders
643 BEdge* be1st = beRange[0];
644 for ( size_t iE = 0; iE < closeEdges.size(); ++iE )
646 be = closeEdges[ iE ];
649 bool ok = be->GetRangeOfSameCloseBorders( beRange, be->myCloseBorders );
650 // if ( !ok && be->myPrev )
651 // ok = be->myPrev->GetRangeOfSameCloseBorders( beRange, be1st->myCloseBorders );
652 // if ( !ok && be->myNext )
653 // ok = be->myNext->GetRangeOfSameCloseBorders( beRange, be1st->myCloseBorders );
659 ranges.push_back( beRange[0] );
660 ranges.push_back( beRange[1] );
662 be->myInGroup = groupID;
663 while ( be != beRange[1] )
665 be->myInGroup = groupID;
668 beRange[1]->myInGroup = groupID;
671 if ( ranges.size() > 2 )
673 for ( size_t iR = 1; iR < ranges.size(); iR += 2 )
674 extendPart( ranges[ iR-1 ], ranges[ iR ], be1st->myCloseBorders, groupID );
677 beRange[0] = ranges[0];
678 beRange[1] = ranges[1];
681 part._node1 = beRange[0]->myID;
682 part._node2 = beRange[0]->myID + 1;
683 part._nodeLast = beRange[1]->myID + 1;
684 group.push_back( part );
687 for ( size_t iR = 3; iR < ranges.size(); iR += 2 )
689 beRange[0] = ranges[iR-1];
690 beRange[1] = ranges[iR-0];
692 // find out mutual orientation of borders
694 be1st ->IsOut( *beRange[ 0 ]->myBNode1, maxTolerance, u1 );
695 beRange[ 0 ]->IsOut( *be1st->myBNode1, maxTolerance, u2 );
696 bool reverse = (( u1 < 0 || u1 > 1 ) && ( u2 < 0 || u2 > 1 ));
699 part._border = beRange[0]->myBorderID;
701 part._node1 = beRange[1]->myID + 1;
702 part._node2 = beRange[1]->myID;
703 part._nodeLast = beRange[0]->myID;
706 part._node1 = beRange[0]->myID;
707 part._node2 = beRange[0]->myID + 1;
708 part._nodeLast = beRange[1]->myID + 1;
710 // if ( group[0]._node2 != part._node2 )
711 group.push_back( part );
713 //if ( group.size() > 1 )
714 foundFreeBordes._coincidentGroups.push_back( group );
718 beRange[0] = ranges[0];
719 beRange[1] = ranges[1];
722 be->myInGroup = skipGroup;
723 while ( be != beRange[1] )
725 be->myInGroup = skipGroup;
728 beRange[1]->myInGroup = skipGroup;
733 } // loop on free borders
737 } // SMESH_MeshAlgos::FindCoincidentFreeBorders()