1 // Copyright (C) 2007-2011 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_3D.cxx
26 // Created : Fri Oct 20 11:37:07 2006
27 // Author : Edward AGAPOV (eap)
29 #include "StdMeshers_Projection_3D.hxx"
30 #include "StdMeshers_ProjectionSource3D.hxx"
32 #include "StdMeshers_ProjectionUtils.hxx"
34 #include "SMDS_PolyhedralVolumeOfNodes.hxx"
35 #include "SMDS_VolumeTool.hxx"
36 #include "SMESHDS_Hypothesis.hxx"
37 #include "SMESHDS_SubMesh.hxx"
38 #include "SMESH_Block.hxx"
39 #include "SMESH_Comment.hxx"
40 #include "SMESH_Gen.hxx"
41 #include "SMESH_Mesh.hxx"
42 #include "SMESH_MesherHelper.hxx"
43 #include "SMESH_Pattern.hxx"
44 #include "SMESH_subMesh.hxx"
45 #include "SMESH_subMeshEventListener.hxx"
47 #include "utilities.h"
50 #include <TopExp_Explorer.hxx>
53 #define RETURN_BAD_RESULT(msg) { MESSAGE(")-: Error: " << msg); return false; }
54 #define gpXYZ(n) gp_XYZ(n->X(),n->Y(),n->Z())
55 #define SHOWYXZ(msg, xyz) // {\
57 // cout << msg << " ("<< p.X() << "; " <<p.Y() << "; " <<p.Z() << ") " <<endl;\
60 typedef StdMeshers_ProjectionUtils TAssocTool;
63 //=======================================================================
64 //function : StdMeshers_Projection_3D
66 //=======================================================================
68 StdMeshers_Projection_3D::StdMeshers_Projection_3D(int hypId, int studyId, SMESH_Gen* gen)
69 :SMESH_3D_Algo(hypId, studyId, gen)
71 _name = "Projection_3D";
72 _shapeType = (1 << TopAbs_SHELL) | (1 << TopAbs_SOLID); // 1 bit per shape type
74 _compatibleHypothesis.push_back("ProjectionSource3D");
78 //================================================================================
82 //================================================================================
84 StdMeshers_Projection_3D::~StdMeshers_Projection_3D()
87 //=======================================================================
88 //function : CheckHypothesis
90 //=======================================================================
92 bool StdMeshers_Projection_3D::CheckHypothesis(SMESH_Mesh& aMesh,
93 const TopoDS_Shape& aShape,
94 SMESH_Hypothesis::Hypothesis_Status& aStatus)
96 // check aShape that must be a 6 faces block
98 if ( TAssocTool::Count( aShape, TopAbs_SHELL, 1 ) != 1 ||
99 TAssocTool::Count( aShape, TopAbs_FACE , 1 ) != 6 ||
100 TAssocTool::Count( aShape, TopAbs_EDGE , 1 ) != 12 ||
101 TAssocTool::Count( aShape, TopAbs_WIRE , 1 ) != 6 )
103 aStatus = HYP_BAD_GEOMETRY;
107 list <const SMESHDS_Hypothesis * >::const_iterator itl;
109 const list <const SMESHDS_Hypothesis * >&hyps = GetUsedHypothesis(aMesh, aShape);
110 if ( hyps.size() == 0 )
112 aStatus = SMESH_Hypothesis::HYP_MISSING;
113 return false; // can't work with no hypothesis
116 if ( hyps.size() > 1 )
118 aStatus = SMESH_Hypothesis::HYP_ALREADY_EXIST;
122 const SMESHDS_Hypothesis *theHyp = hyps.front();
124 string hypName = theHyp->GetName();
126 aStatus = SMESH_Hypothesis::HYP_OK;
128 if (hypName == "ProjectionSource3D")
130 _sourceHypo = static_cast<const StdMeshers_ProjectionSource3D *>(theHyp);
131 // Check hypo parameters
133 SMESH_Mesh* srcMesh = _sourceHypo->GetSourceMesh();
134 SMESH_Mesh* tgtMesh = & aMesh;
139 if ( _sourceHypo->HasVertexAssociation() )
142 TopoDS_Shape edge = TAssocTool::GetEdgeByVertices
143 ( srcMesh, _sourceHypo->GetSourceVertex(1), _sourceHypo->GetSourceVertex(2) );
144 if ( edge.IsNull() ||
145 !SMESH_MesherHelper::IsSubShape( edge, srcMesh ) ||
146 !SMESH_MesherHelper::IsSubShape( edge, _sourceHypo->GetSource3DShape() ))
148 SCRUTE((edge.IsNull()));
149 SCRUTE((SMESH_MesherHelper::IsSubShape( edge, srcMesh )));
150 SCRUTE((SMESH_MesherHelper::IsSubShape( edge, _sourceHypo->GetSource3DShape() )));
151 aStatus = SMESH_Hypothesis::HYP_BAD_PARAMETER;
156 edge = TAssocTool::GetEdgeByVertices
157 ( tgtMesh, _sourceHypo->GetTargetVertex(1), _sourceHypo->GetTargetVertex(2) );
158 if ( edge.IsNull() ||
159 !SMESH_MesherHelper::IsSubShape( edge, tgtMesh ) ||
160 !SMESH_MesherHelper::IsSubShape( edge, aShape ))
162 SCRUTE((edge.IsNull()));
163 SCRUTE((SMESH_MesherHelper::IsSubShape( edge, tgtMesh )));
164 SCRUTE((SMESH_MesherHelper::IsSubShape( edge, aShape )));
165 aStatus = SMESH_Hypothesis::HYP_BAD_PARAMETER;
169 // check a source shape
170 if ( !SMESH_MesherHelper::IsSubShape( _sourceHypo->GetSource3DShape(), srcMesh ) ||
171 ( srcMesh == tgtMesh && aShape == _sourceHypo->GetSource3DShape()))
173 SCRUTE((SMESH_MesherHelper::IsSubShape( _sourceHypo->GetSource3DShape(), srcMesh)));
174 SCRUTE((srcMesh == tgtMesh));
175 SCRUTE((aShape == _sourceHypo->GetSource3DShape()));
176 aStatus = SMESH_Hypothesis::HYP_BAD_PARAMETER;
181 aStatus = SMESH_Hypothesis::HYP_INCOMPATIBLE;
183 return ( aStatus == HYP_OK );
186 //=======================================================================
189 //=======================================================================
191 bool StdMeshers_Projection_3D::Compute(SMESH_Mesh& aMesh, const TopoDS_Shape& aShape)
196 SMESH_Mesh * srcMesh = _sourceHypo->GetSourceMesh();
197 SMESH_Mesh * tgtMesh = & aMesh;
201 SMESHDS_Mesh * srcMeshDS = srcMesh->GetMeshDS();
202 SMESHDS_Mesh * tgtMeshDS = tgtMesh->GetMeshDS();
204 // get shell from shape3D
205 TopoDS_Shell srcShell, tgtShell;
206 TopExp_Explorer exp( _sourceHypo->GetSource3DShape(), TopAbs_SHELL );
208 for ( nbShell = 0; exp.More(); exp.Next(), ++nbShell )
209 srcShell = TopoDS::Shell( exp.Current() );
211 return error(COMPERR_BAD_SHAPE,
212 SMESH_Comment("Source shape must have 1 shell but not ") << nbShell);
214 exp.Init( aShape, TopAbs_SHELL );
215 for ( nbShell = 0; exp.More(); exp.Next(), ++nbShell )
216 tgtShell = TopoDS::Shell( exp.Current() );
218 return error(COMPERR_BAD_SHAPE,
219 SMESH_Comment("Target shape must have 1 shell but not ") << nbShell);
221 // Check that shapes are blocks
222 if ( TAssocTool::Count( tgtShell, TopAbs_FACE , 1 ) != 6 ||
223 TAssocTool::Count( tgtShell, TopAbs_EDGE , 1 ) != 12 ||
224 TAssocTool::Count( tgtShell, TopAbs_WIRE , 1 ) != 6 )
225 return error(COMPERR_BAD_SHAPE, "Target shape is not a block");
226 if ( TAssocTool::Count( srcShell, TopAbs_FACE , 1 ) != 6 ||
227 TAssocTool::Count( srcShell, TopAbs_EDGE , 1 ) != 12 ||
228 TAssocTool::Count( srcShell, TopAbs_WIRE , 1 ) != 6 )
229 return error(COMPERR_BAD_SHAPE, "Source shape is not a block");
231 // Assure that mesh on a source shape is computed
233 SMESH_subMesh* srcSubMesh = srcMesh->GetSubMesh( _sourceHypo->GetSource3DShape() );
234 //SMESH_subMesh* tgtSubMesh = tgtMesh->GetSubMesh( aShape );
236 if ( tgtMesh == srcMesh && !aShape.IsSame( _sourceHypo->GetSource3DShape() )) {
237 if ( !TAssocTool::MakeComputed( srcSubMesh ))
238 return error(COMPERR_BAD_INPUT_MESH,"Source mesh not computed");
241 if ( !srcSubMesh->IsMeshComputed() )
242 return error(COMPERR_BAD_INPUT_MESH,"Source mesh not computed");
245 // Find 2 pairs of corresponding vertices
247 TopoDS_Vertex tgtV000, tgtV100, srcV000, srcV100;
248 TAssocTool::TShapeShapeMap shape2ShapeMap;
250 if ( _sourceHypo->HasVertexAssociation() )
252 tgtV000 = _sourceHypo->GetTargetVertex(1);
253 tgtV100 = _sourceHypo->GetTargetVertex(2);
254 srcV000 = _sourceHypo->GetSourceVertex(1);
255 srcV100 = _sourceHypo->GetSourceVertex(2);
259 if ( !TAssocTool::FindSubShapeAssociation( tgtShell, tgtMesh, srcShell, srcMesh,
261 return error(COMPERR_BAD_SHAPE,"Topology of source and target shapes seems different" );
263 exp.Init( tgtShell, TopAbs_EDGE );
264 TopExp::Vertices( TopoDS::Edge( exp.Current() ), tgtV000, tgtV100 );
266 if ( !shape2ShapeMap.IsBound( tgtV000 ) || !shape2ShapeMap.IsBound( tgtV100 ))
267 return error("Association of subshapes failed" );
268 srcV000 = TopoDS::Vertex( shape2ShapeMap( tgtV000 ));
269 srcV100 = TopoDS::Vertex( shape2ShapeMap( tgtV100 ));
270 if ( !SMESH_MesherHelper::IsSubShape( srcV000, srcShell ) ||
271 !SMESH_MesherHelper::IsSubShape( srcV100, srcShell ))
272 return error("Incorrect association of subshapes" );
275 // Load 2 SMESH_Block's with src and tgt shells
277 SMESH_Block srcBlock, tgtBlock;
278 TopTools_IndexedMapOfOrientedShape scrShapes, tgtShapes;
279 if ( !tgtBlock.LoadBlockShapes( tgtShell, tgtV000, tgtV100, tgtShapes ))
280 return error(COMPERR_BAD_SHAPE, "Can't detect block subshapes. Not a block?");
282 if ( !srcBlock.LoadBlockShapes( srcShell, srcV000, srcV100, scrShapes ))
283 return error(COMPERR_BAD_SHAPE, "Can't detect block subshapes. Not a block?");
285 // Find matching nodes of src and tgt shells
287 TNodeNodeMap src2tgtNodeMap;
288 for ( int fId = SMESH_Block::ID_FirstF; fId < SMESH_Block::ID_Shell; ++fId )
290 // Corresponding subshapes
291 TopoDS_Face srcFace = TopoDS::Face( scrShapes( fId ));
292 TopoDS_Face tgtFace = TopoDS::Face( tgtShapes( fId ));
293 if ( _sourceHypo->HasVertexAssociation() ) { // associate face subshapes
294 shape2ShapeMap.Clear();
295 vector< int > edgeIdVec;
296 SMESH_Block::GetFaceEdgesIDs( fId, edgeIdVec );
297 for ( int i = 0; i < edgeIdVec.size(); ++i ) {
298 int eID = edgeIdVec[ i ];
299 shape2ShapeMap.Bind( tgtShapes( eID ), scrShapes( eID ));
301 vector< int > vertexIdVec;
302 SMESH_Block::GetEdgeVertexIDs( eID, vertexIdVec );
303 shape2ShapeMap.Bind( tgtShapes( vertexIdVec[0] ), scrShapes( vertexIdVec[0] ));
304 shape2ShapeMap.Bind( tgtShapes( vertexIdVec[1] ), scrShapes( vertexIdVec[1] ));
308 // Find matching nodes of tgt and src faces
309 TNodeNodeMap faceMatchingNodes;
310 if ( ! TAssocTool::FindMatchingNodesOnFaces( srcFace, srcMesh, tgtFace, tgtMesh,
311 shape2ShapeMap, faceMatchingNodes ))
312 return error(COMPERR_BAD_INPUT_MESH,SMESH_Comment("Mesh on faces #")
313 << srcMeshDS->ShapeToIndex( srcFace ) << " and "
314 << tgtMeshDS->ShapeToIndex( tgtFace ) << " seems different" );
316 // put found matching nodes of 2 faces to the global map
317 src2tgtNodeMap.insert( faceMatchingNodes.begin(), faceMatchingNodes.end() );
320 // ------------------
322 // ------------------
324 SMDS_VolumeTool volTool;
325 SMESH_MesherHelper helper( *tgtMesh );
326 helper.IsQuadraticSubMesh( aShape );
328 SMESHDS_SubMesh* srcSMDS = srcSubMesh->GetSubMeshDS();
329 SMDS_ElemIteratorPtr volIt = srcSMDS->GetElements();
330 while ( volIt->more() ) // loop on source volumes
332 const SMDS_MeshElement* srcVol = volIt->next();
333 if ( !srcVol || srcVol->GetType() != SMDSAbs_Volume )
335 int nbNodes = srcVol->NbNodes();
336 SMDS_VolumeTool::VolumeType volType = volTool.GetType( nbNodes );
337 if ( srcVol->IsQuadratic() )
338 nbNodes = volTool.NbCornerNodes( volType );
340 // Find or create a new tgt node for each node of a src volume
342 vector< const SMDS_MeshNode* > nodes( nbNodes );
343 for ( int i = 0; i < nbNodes; ++i )
345 const SMDS_MeshNode* srcNode = srcVol->GetNode( i );
346 const SMDS_MeshNode* tgtNode = 0;
347 TNodeNodeMap::iterator sN_tN = src2tgtNodeMap.find( srcNode );
348 if ( sN_tN != src2tgtNodeMap.end() ) // found
350 tgtNode = sN_tN->second;
352 else // Create a new tgt node
354 // compute normalized parameters of source node in srcBlock
355 gp_Pnt srcCoord = gpXYZ( srcNode );
357 if ( !srcBlock.ComputeParameters( srcCoord, srcParam ))
358 return error(SMESH_Comment("Can't compute normalized parameters ")
359 << "for source node " << srcNode->GetID());
360 // compute coordinates of target node by srcParam
362 if ( !tgtBlock.ShellPoint( srcParam, tgtXYZ ))
363 return error("Can't compute coordinates by normalized parameters");
365 SMDS_MeshNode* newNode = tgtMeshDS->AddNode( tgtXYZ.X(), tgtXYZ.Y(), tgtXYZ.Z() );
366 tgtMeshDS->SetNodeInVolume( newNode, helper.GetSubShapeID() );
368 src2tgtNodeMap.insert( make_pair( srcNode, tgtNode ));
370 nodes[ i ] = tgtNode;
373 // Create a new volume
375 SMDS_MeshVolume * tgtVol = 0;
376 int id = 0, force3d = false;
378 case SMDS_VolumeTool::TETRA :
379 case SMDS_VolumeTool::QUAD_TETRA:
380 tgtVol = helper.AddVolume( nodes[0],
383 nodes[3], id, force3d); break;
384 case SMDS_VolumeTool::PYRAM :
385 case SMDS_VolumeTool::QUAD_PYRAM:
386 tgtVol = helper.AddVolume( nodes[0],
390 nodes[4], id, force3d); break;
391 case SMDS_VolumeTool::PENTA :
392 case SMDS_VolumeTool::QUAD_PENTA:
393 tgtVol = helper.AddVolume( nodes[0],
398 nodes[5], id, force3d); break;
399 case SMDS_VolumeTool::HEXA :
400 case SMDS_VolumeTool::QUAD_HEXA :
401 tgtVol = helper.AddVolume( nodes[0],
408 nodes[7], id, force3d); break;
409 default: // polyhedron
410 const SMDS_VtkVolume * poly =
411 dynamic_cast<const SMDS_VtkVolume*>( srcVol );
413 RETURN_BAD_RESULT("Unexpected volume type");
414 if ( !poly->IsPoly())
415 RETURN_BAD_RESULT("Unexpected volume type");
416 tgtVol = tgtMeshDS->AddPolyhedralVolume( nodes, poly->GetQuantities() );
419 tgtMeshDS->SetMeshElementOnShape( tgtVol, helper.GetSubShapeID() );
421 } // loop on volumes of src shell
427 //=======================================================================
428 //function : Evaluate
430 //=======================================================================
432 bool StdMeshers_Projection_3D::Evaluate(SMESH_Mesh& aMesh,
433 const TopoDS_Shape& aShape,
434 MapShapeNbElems& aResMap)
439 SMESH_Mesh * srcMesh = _sourceHypo->GetSourceMesh();
440 SMESH_Mesh * tgtMesh = & aMesh;
444 // get shell from shape3D
445 TopoDS_Shell srcShell, tgtShell;
446 TopExp_Explorer exp( _sourceHypo->GetSource3DShape(), TopAbs_SHELL );
448 for ( nbShell = 0; exp.More(); exp.Next(), ++nbShell )
449 srcShell = TopoDS::Shell( exp.Current() );
451 return error(COMPERR_BAD_SHAPE,
452 SMESH_Comment("Source shape must have 1 shell but not ") << nbShell);
454 exp.Init( aShape, TopAbs_SHELL );
455 for ( nbShell = 0; exp.More(); exp.Next(), ++nbShell )
456 tgtShell = TopoDS::Shell( exp.Current() );
458 return error(COMPERR_BAD_SHAPE,
459 SMESH_Comment("Target shape must have 1 shell but not ") << nbShell);
461 // Check that shapes are blocks
462 if ( TAssocTool::Count( tgtShell, TopAbs_FACE , 1 ) != 6 ||
463 TAssocTool::Count( tgtShell, TopAbs_EDGE , 1 ) != 12 ||
464 TAssocTool::Count( tgtShell, TopAbs_WIRE , 1 ) != 6 )
465 return error(COMPERR_BAD_SHAPE, "Target shape is not a block");
466 if ( TAssocTool::Count( srcShell, TopAbs_FACE , 1 ) != 6 ||
467 TAssocTool::Count( srcShell, TopAbs_EDGE , 1 ) != 12 ||
468 TAssocTool::Count( srcShell, TopAbs_WIRE , 1 ) != 6 )
469 return error(COMPERR_BAD_SHAPE, "Source shape is not a block");
471 // Assure that mesh on a source shape is computed
473 SMESH_subMesh* srcSubMesh = srcMesh->GetSubMesh( _sourceHypo->GetSource3DShape() );
475 if ( !srcSubMesh->IsMeshComputed() )
476 return error(COMPERR_BAD_INPUT_MESH,"Source mesh not computed");
479 std::vector<int> aVec(SMDSEntity_Last);
480 for(int i=SMDSEntity_Node; i<SMDSEntity_Last; i++) aVec[i] = 0;
482 aVec[SMDSEntity_Node] = srcSubMesh->GetSubMeshDS()->NbNodes();
484 //bool quadratic = false;
485 SMDS_ElemIteratorPtr elemIt = srcSubMesh->GetSubMeshDS()->GetElements();
486 while ( elemIt->more() ) {
487 const SMDS_MeshElement* E = elemIt->next();
488 if( E->NbNodes()==4 ) {
489 aVec[SMDSEntity_Tetra]++;
491 else if( E->NbNodes()==5 ) {
492 aVec[SMDSEntity_Pyramid]++;
494 else if( E->NbNodes()==6 ) {
495 aVec[SMDSEntity_Penta]++;
497 else if( E->NbNodes()==8 ) {
498 aVec[SMDSEntity_Hexa]++;
500 else if( E->NbNodes()==10 && E->IsQuadratic() ) {
501 aVec[SMDSEntity_Quad_Tetra]++;
503 else if( E->NbNodes()==13 && E->IsQuadratic() ) {
504 aVec[SMDSEntity_Quad_Pyramid]++;
506 else if( E->NbNodes()==15 && E->IsQuadratic() ) {
507 aVec[SMDSEntity_Quad_Penta]++;
509 else if( E->NbNodes()==20 && E->IsQuadratic() ) {
510 aVec[SMDSEntity_Quad_Hexa]++;
513 aVec[SMDSEntity_Polyhedra]++;
517 SMESH_subMesh * sm = aMesh.GetSubMesh(aShape);
518 aResMap.insert(std::make_pair(sm,aVec));
524 //=============================================================================
526 * \brief Sets a default event listener to submesh of the source shape
527 * \param subMesh - submesh where algo is set
529 * This method is called when a submesh gets HYP_OK algo_state.
530 * After being set, event listener is notified on each event of a submesh.
531 * Arranges that CLEAN event is translated from source submesh to
534 //=============================================================================
536 void StdMeshers_Projection_3D::SetEventListener(SMESH_subMesh* subMesh)
538 TAssocTool::SetEventListener( subMesh,
539 _sourceHypo->GetSource3DShape(),
540 _sourceHypo->GetSourceMesh() );