1 // Copyright (C) 2007-2008 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
22 // SMESH SMESH : implementaion of SMESH idl descriptions
23 // File : SMESH_Algo.cxx
24 // Author : Paul RASCLE, EDF
28 #include "SMESH_Algo.hxx"
29 #include "SMESH_Comment.hxx"
30 #include "SMESH_Gen.hxx"
31 #include "SMESH_Mesh.hxx"
32 #include "SMESH_HypoFilter.hxx"
33 #include "SMDS_FacePosition.hxx"
34 #include "SMDS_EdgePosition.hxx"
35 #include "SMDS_MeshElement.hxx"
36 #include "SMDS_MeshNode.hxx"
37 #include "SMESHDS_Mesh.hxx"
38 #include "SMESHDS_SubMesh.hxx"
40 #include <BRepAdaptor_Curve.hxx>
41 #include <BRepLProp.hxx>
42 #include <BRep_Tool.hxx>
43 #include <GCPnts_AbscissaPoint.hxx>
44 #include <GeomAdaptor_Curve.hxx>
45 #include <Geom_Surface.hxx>
47 #include <TopLoc_Location.hxx>
48 #include <TopTools_ListIteratorOfListOfShape.hxx>
49 #include <TopTools_ListOfShape.hxx>
51 #include <TopoDS_Edge.hxx>
52 #include <TopoDS_Face.hxx>
53 #include <TopoDS_Vertex.hxx>
55 #include <gp_Pnt2d.hxx>
58 #include <Standard_ErrorHandler.hxx>
59 #include <Standard_Failure.hxx>
61 #include "utilities.h"
67 //=============================================================================
71 //=============================================================================
73 SMESH_Algo::SMESH_Algo (int hypId, int studyId, SMESH_Gen * gen)
74 : SMESH_Hypothesis(hypId, studyId, gen)
76 gen->_mapAlgo[hypId] = this;
78 _onlyUnaryInput = _requireDescretBoundary = _requireShape = true;
79 _quadraticMesh = _supportSubmeshes = false;
83 //=============================================================================
87 //=============================================================================
89 SMESH_Algo::~SMESH_Algo()
93 //=============================================================================
95 * Usually an algoritm has nothing to save
97 //=============================================================================
99 ostream & SMESH_Algo::SaveTo(ostream & save) { return save; }
100 istream & SMESH_Algo::LoadFrom(istream & load) { return load; }
102 //=============================================================================
106 //=============================================================================
108 const vector < string > &SMESH_Algo::GetCompatibleHypothesis()
110 return _compatibleHypothesis;
113 //=============================================================================
115 * List the hypothesis used by the algorithm associated to the shape.
116 * Hypothesis associated to father shape -are- taken into account (see
117 * GetAppliedHypothesis). Relevant hypothesis have a name (type) listed in
118 * the algorithm. This method could be surcharged by specific algorithms, in
119 * case of several hypothesis simultaneously applicable.
121 //=============================================================================
123 const list <const SMESHDS_Hypothesis *> &
124 SMESH_Algo::GetUsedHypothesis(SMESH_Mesh & aMesh,
125 const TopoDS_Shape & aShape,
126 const bool ignoreAuxiliary)
128 _usedHypList.clear();
129 SMESH_HypoFilter filter;
130 if ( InitCompatibleHypoFilter( filter, ignoreAuxiliary ))
132 aMesh.GetHypotheses( aShape, filter, _usedHypList, true );
133 if ( ignoreAuxiliary && _usedHypList.size() > 1 )
134 _usedHypList.clear(); //only one compatible hypothesis allowed
139 //=============================================================================
141 * List the relevant hypothesis associated to the shape. Relevant hypothesis
142 * have a name (type) listed in the algorithm. Hypothesis associated to
143 * father shape -are not- taken into account (see GetUsedHypothesis)
145 //=============================================================================
147 const list<const SMESHDS_Hypothesis *> &
148 SMESH_Algo::GetAppliedHypothesis(SMESH_Mesh & aMesh,
149 const TopoDS_Shape & aShape,
150 const bool ignoreAuxiliary)
152 _appliedHypList.clear();
153 SMESH_HypoFilter filter;
154 if ( InitCompatibleHypoFilter( filter, ignoreAuxiliary ))
155 aMesh.GetHypotheses( aShape, filter, _appliedHypList, false );
157 return _appliedHypList;
160 //=============================================================================
162 * Compute length of an edge
164 //=============================================================================
166 double SMESH_Algo::EdgeLength(const TopoDS_Edge & E)
168 double UMin = 0, UMax = 0;
169 if (BRep_Tool::Degenerated(E))
172 Handle(Geom_Curve) C = BRep_Tool::Curve(E, L, UMin, UMax);
173 GeomAdaptor_Curve AdaptCurve(C);
174 double length = GCPnts_AbscissaPoint::Length(AdaptCurve, UMin, UMax);
178 //================================================================================
180 * \brief Calculate normal of a mesh face
182 //================================================================================
184 bool SMESH_Algo::FaceNormal(const SMDS_MeshElement* F, gp_XYZ& normal, bool normalized)
186 if ( !F || F->GetType() != SMDSAbs_Face )
189 normal.SetCoord(0,0,0);
190 int nbNodes = F->IsQuadratic() ? F->NbNodes()/2 : F->NbNodes();
191 for ( int i = 0; i < nbNodes-2; ++i )
194 for ( int n = 0; n < 3; ++n )
196 const SMDS_MeshNode* node = F->GetNode( n );
197 p[n].SetCoord( node->X(), node->Y(), node->Z() );
199 normal += ( p[0] - p[1] ) ^ ( p[2] - p[1] );
201 double size2 = normal.SquareModulus();
202 bool ok = ( size2 > numeric_limits<double>::min() * numeric_limits<double>::min());
203 if ( normalized && ok )
204 normal /= sqrt( size2 );
209 //================================================================================
211 * \brief Find out elements orientation on a geometrical face
212 * \param theFace - The face correctly oriented in the shape being meshed
213 * \param theMeshDS - The mesh data structure
214 * \retval bool - true if the face normal and the normal of first element
215 * in the correspoding submesh point in different directions
217 //================================================================================
219 bool SMESH_Algo::IsReversedSubMesh (const TopoDS_Face& theFace,
220 SMESHDS_Mesh* theMeshDS)
222 if ( theFace.IsNull() || !theMeshDS )
225 // find out orientation of a meshed face
226 int faceID = theMeshDS->ShapeToIndex( theFace );
227 TopoDS_Shape aMeshedFace = theMeshDS->IndexToShape( faceID );
228 bool isReversed = ( theFace.Orientation() != aMeshedFace.Orientation() );
230 const SMESHDS_SubMesh * aSubMeshDSFace = theMeshDS->MeshElements( faceID );
231 if ( !aSubMeshDSFace )
234 // find element with node located on face and get its normal
235 const SMDS_FacePosition* facePos = 0;
239 bool normalOK = false;
240 SMDS_ElemIteratorPtr iteratorElem = aSubMeshDSFace->GetElements();
241 while ( iteratorElem->more() ) // loop on elements on theFace
243 const SMDS_MeshElement* elem = iteratorElem->next();
244 if ( elem && elem->NbNodes() > 2 ) {
245 SMDS_ElemIteratorPtr nodesIt = elem->nodesIterator();
246 const SMDS_FacePosition* fPos = 0;
248 while ( nodesIt->more() ) { // loop on nodes
249 const SMDS_MeshNode* node
250 = static_cast<const SMDS_MeshNode *>(nodesIt->next());
252 nPnt[ i++ ].SetCoord( node->X(), node->Y(), node->Z() );
254 const SMDS_PositionPtr& pos = node->GetPosition();
255 if ( !pos ) continue;
256 if ( pos->GetTypeOfPosition() == SMDS_TOP_FACE ) {
257 fPos = dynamic_cast< const SMDS_FacePosition* >( pos.get() );
259 else if ( pos->GetTypeOfPosition() == SMDS_TOP_VERTEX ) {
260 vID = pos->GetShapeId();
263 if ( fPos || ( !normalOK && vID )) {
265 gp_Vec v01( nPnt[0], nPnt[1] ), v02( nPnt[0], nPnt[2] );
266 if ( v01.SquareMagnitude() > RealSmall() &&
267 v02.SquareMagnitude() > RealSmall() )
270 normalOK = ( Ne.SquareMagnitude() > RealSmall() );
272 // we need position on theFace or at least on vertex
275 if ((facePos = fPos))
284 // node position on face
287 u = facePos->GetUParameter();
288 v = facePos->GetVParameter();
290 else if ( vertexID ) {
291 TopoDS_Shape V = theMeshDS->IndexToShape( vertexID );
292 if ( V.IsNull() || V.ShapeType() != TopAbs_VERTEX )
294 gp_Pnt2d uv = BRep_Tool::Parameters( TopoDS::Vertex( V ), theFace );
303 // face normal at node position
305 Handle(Geom_Surface) surf = BRep_Tool::Surface( theFace, loc );
306 if ( surf.IsNull() || surf->Continuity() < GeomAbs_C1 ) return isReversed;
308 surf->D1( u, v, nPnt[0], d1u, d1v );
309 gp_Vec Nf = (d1u ^ d1v).Transformed( loc );
311 if ( theFace.Orientation() == TopAbs_REVERSED )
317 //================================================================================
319 * \brief Just return false as the algorithm does not hold parameters values
321 //================================================================================
323 bool SMESH_Algo::SetParametersByMesh(const SMESH_Mesh* /*theMesh*/,
324 const TopoDS_Shape& /*theShape*/)
328 bool SMESH_Algo::SetParametersByDefaults(const TDefaults& , const SMESH_Mesh*)
332 //================================================================================
334 * \brief Fill vector of node parameters on geometrical edge, including vertex nodes
335 * \param theMesh - The mesh containing nodes
336 * \param theEdge - The geometrical edge of interest
337 * \param theParams - The resulting vector of sorted node parameters
338 * \retval bool - false if not all parameters are OK
340 //================================================================================
342 bool SMESH_Algo::GetNodeParamOnEdge(const SMESHDS_Mesh* theMesh,
343 const TopoDS_Edge& theEdge,
344 vector< double > & theParams)
348 if ( !theMesh || theEdge.IsNull() )
351 SMESHDS_SubMesh * eSubMesh = theMesh->MeshElements( theEdge );
352 if ( !eSubMesh || !eSubMesh->GetElements()->more() )
353 return false; // edge is not meshed
355 //int nbEdgeNodes = 0;
356 set < double > paramSet;
359 // loop on nodes of an edge: sort them by param on edge
360 SMDS_NodeIteratorPtr nIt = eSubMesh->GetNodes();
361 while ( nIt->more() )
363 const SMDS_MeshNode* node = nIt->next();
364 const SMDS_PositionPtr& pos = node->GetPosition();
365 if ( pos->GetTypeOfPosition() != SMDS_TOP_EDGE )
367 const SMDS_EdgePosition* epos =
368 static_cast<const SMDS_EdgePosition*>(node->GetPosition().get());
369 if ( !paramSet.insert( epos->GetUParameter() ).second )
370 return false; // equal parameters
373 // add vertex nodes params
375 TopExp::Vertices( theEdge, V1, V2);
376 if ( VertexNode( V1, theMesh ) &&
377 !paramSet.insert( BRep_Tool::Parameter(V1,theEdge) ).second )
378 return false; // there are equal parameters
379 if ( VertexNode( V2, theMesh ) &&
380 !paramSet.insert( BRep_Tool::Parameter(V2,theEdge) ).second )
381 return false; // there are equal parameters
384 theParams.resize( paramSet.size() );
385 set < double >::iterator par = paramSet.begin();
386 vector< double >::iterator vecPar = theParams.begin();
387 for ( ; par != paramSet.end(); ++par, ++vecPar )
390 return theParams.size() > 1;
393 //================================================================================
395 * \brief Fill vector of node parameters on geometrical edge, including vertex nodes
396 * \param theMesh - The mesh containing nodes
397 * \param theEdge - The geometrical edge of interest
398 * \param theParams - The resulting vector of sorted node parameters
399 * \retval bool - false if not all parameters are OK
401 //================================================================================
403 bool SMESH_Algo::GetSortedNodesOnEdge(const SMESHDS_Mesh* theMesh,
404 const TopoDS_Edge& theEdge,
405 const bool ignoreMediumNodes,
406 map< double, const SMDS_MeshNode* > & theNodes)
410 if ( !theMesh || theEdge.IsNull() )
413 SMESHDS_SubMesh * eSubMesh = theMesh->MeshElements( theEdge );
414 if ( !eSubMesh || !eSubMesh->GetElements()->more() )
415 return false; // edge is not meshed
418 set < double > paramSet;
421 // loop on nodes of an edge: sort them by param on edge
422 SMDS_NodeIteratorPtr nIt = eSubMesh->GetNodes();
423 while ( nIt->more() )
425 const SMDS_MeshNode* node = nIt->next();
426 if ( ignoreMediumNodes ) {
427 SMDS_ElemIteratorPtr elemIt = node->GetInverseElementIterator();
428 if ( elemIt->more() && elemIt->next()->IsMediumNode( node ))
431 const SMDS_PositionPtr& pos = node->GetPosition();
432 if ( pos->GetTypeOfPosition() != SMDS_TOP_EDGE )
434 const SMDS_EdgePosition* epos =
435 static_cast<const SMDS_EdgePosition*>(node->GetPosition().get());
436 theNodes.insert( make_pair( epos->GetUParameter(), node ));
441 TopoDS_Vertex v1, v2;
442 TopExp::Vertices(theEdge, v1, v2);
443 const SMDS_MeshNode* n1 = VertexNode( v1, (SMESHDS_Mesh*) theMesh );
444 const SMDS_MeshNode* n2 = VertexNode( v2, (SMESHDS_Mesh*) theMesh );
446 BRep_Tool::Range(theEdge, f, l);
447 if ( v1.Orientation() != TopAbs_FORWARD )
449 if ( n1 && ++nbNodes )
450 theNodes.insert( make_pair( f, n1 ));
451 if ( n2 && ++nbNodes )
452 theNodes.insert( make_pair( l, n2 ));
454 return theNodes.size() == nbNodes;
457 //================================================================================
459 * \brief Make filter recognize only compatible hypotheses
460 * \param theFilter - the filter to initialize
461 * \param ignoreAuxiliary - make filter ignore compatible auxiliary hypotheses
463 //================================================================================
465 bool SMESH_Algo::InitCompatibleHypoFilter( SMESH_HypoFilter & theFilter,
466 const bool ignoreAuxiliary) const
468 if ( !_compatibleHypothesis.empty() )
470 theFilter.Init( theFilter.HasName( _compatibleHypothesis[0] ));
471 for ( int i = 1; i < _compatibleHypothesis.size(); ++i )
472 theFilter.Or( theFilter.HasName( _compatibleHypothesis[ i ] ));
474 if ( ignoreAuxiliary )
475 theFilter.AndNot( theFilter.IsAuxiliary() );
482 //================================================================================
484 * \brief Return continuity of two edges
485 * \param E1 - the 1st edge
486 * \param E2 - the 2nd edge
487 * \retval GeomAbs_Shape - regularity at the junction between E1 and E2
489 //================================================================================
491 GeomAbs_Shape SMESH_Algo::Continuity(const TopoDS_Edge & E1,
492 const TopoDS_Edge & E2)
494 TopoDS_Vertex V = TopExp::LastVertex (E1, true);
495 if ( !V.IsSame( TopExp::FirstVertex(E2, true )))
496 if ( !TopExp::CommonVertex( E1, E2, V ))
498 Standard_Real u1 = BRep_Tool::Parameter( V, E1 );
499 Standard_Real u2 = BRep_Tool::Parameter( V, E2 );
500 BRepAdaptor_Curve C1( E1 ), C2( E2 );
501 Standard_Real tol = BRep_Tool::Tolerance( V );
502 Standard_Real angTol = 2e-3;
504 #if (OCC_VERSION_MAJOR << 16 | OCC_VERSION_MINOR << 8 | OCC_VERSION_MAINTENANCE) > 0x060100
507 return BRepLProp::Continuity(C1, C2, u1, u2, tol, angTol);
509 catch (Standard_Failure) {
514 //================================================================================
516 * \brief Return the node built on a vertex
517 * \param V - the vertex
518 * \param meshDS - mesh
519 * \retval const SMDS_MeshNode* - found node or NULL
521 //================================================================================
523 const SMDS_MeshNode* SMESH_Algo::VertexNode(const TopoDS_Vertex& V,
524 const SMESHDS_Mesh* meshDS)
526 if ( SMESHDS_SubMesh* sm = meshDS->MeshElements(V) ) {
527 SMDS_NodeIteratorPtr nIt= sm->GetNodes();
534 //================================================================================
536 * \brief Sets event listener to submeshes if necessary
537 * \param subMesh - submesh where algo is set
539 * After being set, event listener is notified on each event of a submesh.
540 * By default non listener is set
542 //================================================================================
544 void SMESH_Algo::SetEventListener(SMESH_subMesh* /*subMesh*/)
548 //================================================================================
550 * \brief Allow algo to do something after persistent restoration
551 * \param subMesh - restored submesh
553 * This method is called only if a submesh has HYP_OK algo_state.
555 //================================================================================
557 void SMESH_Algo::SubmeshRestored(SMESH_subMesh* /*subMesh*/)
561 //================================================================================
563 * \brief Computes mesh without geometry
564 * \param aMesh - the mesh
565 * \param aHelper - helper that must be used for adding elements to \aaMesh
566 * \retval bool - is a success
568 //================================================================================
570 bool SMESH_Algo::Compute(SMESH_Mesh & /*aMesh*/, SMESH_MesherHelper* /*aHelper*/)
572 return error( COMPERR_BAD_INPUT_MESH, "Mesh built on shape expected");
575 //================================================================================
577 * \brief store error and comment and then return ( error == COMPERR_OK )
579 //================================================================================
581 bool SMESH_Algo::error(int error, const SMESH_Comment& comment)
585 return ( error == COMPERR_OK );
588 //================================================================================
590 * \brief store error and return ( error == COMPERR_OK )
592 //================================================================================
594 bool SMESH_Algo::error(SMESH_ComputeErrorPtr error)
597 _error = error->myName;
598 _comment = error->myComment;
599 _badInputElements = error->myBadElements;
600 return error->IsOK();
605 //================================================================================
607 * \brief return compute error
609 //================================================================================
611 SMESH_ComputeErrorPtr SMESH_Algo::GetComputeError() const
613 SMESH_ComputeErrorPtr err = SMESH_ComputeError::New( _error, _comment, this );
614 // hope this method is called by only SMESH_subMesh after this->Compute()
615 err->myBadElements.splice( err->myBadElements.end(),
616 (list<const SMDS_MeshElement*>&) _badInputElements );
620 //================================================================================
622 * \brief initialize compute error
624 //================================================================================
626 void SMESH_Algo::InitComputeError()
630 list<const SMDS_MeshElement*>::iterator elem = _badInputElements.begin();
631 for ( ; elem != _badInputElements.end(); ++elem )
632 if ( (*elem)->GetID() < 1 )
634 _badInputElements.clear();
637 //================================================================================
639 * \brief store a bad input element preventing computation,
640 * which may be a temporary one i.e. not residing the mesh,
641 * then it will be deleted by InitComputeError()
643 //================================================================================
645 void SMESH_Algo::addBadInputElement(const SMDS_MeshElement* elem)
648 _badInputElements.push_back( elem );