// File : SMDS_VolumeTool.cxx // Created : Tue Jul 13 12:22:13 2004 // Author : Edward AGAPOV (eap) // Copyright : Open CASCADE #include "SMDS_VolumeTool.hxx" #include "SMDS_MeshElement.hxx" #include "SMDS_MeshNode.hxx" #include #include using namespace std; /* // N3 // + // /|\ // / | \ // / | \ // N0 +---|---+ N2 TETRAHEDRON // \ | / // \ | / // \ | / // \|/ // + // N1 */ static int Tetra_F [4][4] = { // FORWARD == REVERSED EXTERNAL { 0, 1, 2, 0 }, // Bottom face has an internal normal, other - external { 0, 1, 3, 0 }, { 1, 2, 3, 1 }, { 0, 3, 2, 0 }}; static int Tetra_R [4][4] = { // REVERSED == FORWARD EXTERNAL { 0, 2, 1, 0 }, // All faces have external normals { 0, 1, 3, 0 }, { 1, 2, 3, 1 }, { 0, 3, 2, 0 }}; static int Tetra_nbN [] = { 3, 3, 3, 3 }; /* // + N4 // /|\ // / | \ // / | \ // / | \ // N3 +---------+ N5 // | | | // | + N1 | // | / \ | PENTAHEDRON // | / \ | // | / \ | // |/ \| // N0 +---------+ N2 */ static int Penta_F [5][5] = { // FORWARD { 0, 1, 2, 0, 0 }, // Top face has an internal normal, other - external { 3, 4, 5, 3, 3 }, // 0 is bottom, 1 is top face { 0, 2, 5, 3, 0 }, { 1, 2, 5, 4, 1 }, { 1, 0, 3, 4, 1 }}; static int Penta_R [5][5] = { // REVERSED { 0, 2, 1, 0, 0 }, // Bottom face has an internal normal, other - external { 3, 5, 4, 3, 3 }, // 0 is bottom, 1 is top face { 0, 2, 5, 3, 0 }, { 1, 2, 5, 4, 1 }, { 1, 0, 3, 4, 1 }}; static int Penta_FE [5][5] = { // EXTERNAL { 0, 1, 2, 0, 0 }, { 3, 5, 4, 3, 3 }, { 0, 2, 5, 3, 0 }, { 1, 2, 5, 4, 1 }, { 1, 0, 3, 4, 1 }}; static int Penta_RE [5][5] = { // REVERSED EXTERNAL { 0, 0, 2, 1, 0 }, { 3, 3, 4, 5, 3 }, { 0, 2, 5, 3, 0 }, { 1, 2, 5, 4, 1 }, { 1, 0, 3, 4, 1 }}; static int Penta_nbN [] = { 3, 3, 4, 4, 4 }; /* // N7+----------+N6 // /| /| // / | / | // / | / | // N4+----------+N5 | // | | | | HEXAHEDRON // | | | | // | | | | // | N3+------|---+N2 // | / | / // | / | / // |/ |/ // N0+----------+N1 */ static int Hexa_F [6][5] = { // FORWARD { 0, 1, 2, 3, 0 }, // opposite faces are neighbouring, { 4, 5, 6, 7, 4 }, // even face normal is internal, odd - external { 1, 0, 4, 5, 1 }, // same index nodes nodes of opposite faces are linked { 2, 3, 7, 6, 2 }, { 0, 3, 7, 4, 0 }, { 1, 2, 6, 5, 1 }}; static int Hexa_R [6][5] = { // REVERSED { 0, 3, 2, 1, 0 }, // opposite faces are neighbouring, { 4, 7, 6, 5, 4 }, // even face normal is external, odd - internal { 1, 5, 4, 0, 1 }, // same index nodes nodes of opposite faces are linked { 2, 6, 7, 3, 2 }, { 0, 4, 7, 3, 0 }, { 1, 5, 6, 2, 1 }}; static int Hexa_FE [6][5] = { // EXTERNAL { 0, 3, 2, 1, 0 }, // opposite faces are neighbouring, { 4, 5, 6, 7, 4 }, // all face normals are external, { 0, 1, 5, 4, 0 }, // links in opposite faces: 0-0, 1-3, 2-2, 3-1 { 3, 7, 6, 2, 3 }, { 1, 2, 6, 5, 1 }, { 0, 4, 7, 3, 0 }}; static int Hexa_RE [6][5] = { // REVERSED EXTERNAL { 0, 1, 2, 3, 0 }, // opposite faces are neighbouring, { 4, 7, 6, 5, 4 }, // all face normals are external, { 0, 1, 5, 4, 0 }, // links in opposite faces: 0-0, 1-3, 2-2, 3-1 { 3, 7, 6, 2, 3 }, { 1, 2, 6, 5, 1 }, { 0, 4, 7, 3, 0 }}; static int Hexa_nbN [] = { 4, 4, 4, 4, 4, 4 }; // ======================================================== // to perform some calculations without linkage to CASCADE // ======================================================== struct XYZ { double x; double y; double z; XYZ() { x = 0; y = 0; z = 0; } XYZ( double X, double Y, double Z ) { x = X; y = Y; z = Z; } XYZ( const XYZ& other ) { x = other.x; y = other.y; z = other.z; } XYZ( const SMDS_MeshNode* n ) { x = n->X(); y = n->Y(); z = n->Z(); } XYZ operator-( const XYZ& other ); XYZ Crossed( const XYZ& other ); double Dot( const XYZ& other ); double Magnitude(); }; XYZ XYZ::operator-( const XYZ& Right ) { return XYZ(x - Right.x, y - Right.y, z - Right.z); } XYZ XYZ::Crossed( const XYZ& Right ) { return XYZ (y * Right.z - z * Right.y, z * Right.x - x * Right.z, x * Right.y - y * Right.x); } double XYZ::Dot( const XYZ& Other ) { return(x * Other.x + y * Other.y + z * Other.z); } double XYZ::Magnitude() { return sqrt (x * x + y * y + z * z); } //======================================================================= //function : SMDS_VolumeTool //purpose : //======================================================================= SMDS_VolumeTool::SMDS_VolumeTool () : myVolume( 0 ), myVolForward( true ), myNbFaces( 0 ), myVolumeNbNodes( 0 ), myForwardFaces( false ), myExternalFaces( false ) { } //======================================================================= //function : SMDS_VolumeTool //purpose : //======================================================================= SMDS_VolumeTool::SMDS_VolumeTool (const SMDS_MeshElement* theVolume) : myForwardFaces( false ), myExternalFaces( false ) { Set( theVolume ); } //======================================================================= //function : SMDS_VolumeTool //purpose : //======================================================================= SMDS_VolumeTool::~SMDS_VolumeTool() { } //======================================================================= //function : SetVolume //purpose : Set volume to iterate on //======================================================================= bool SMDS_VolumeTool::Set (const SMDS_MeshElement* theVolume) { myVolume = 0; myVolForward = true; myCurFace = -1; myVolumeNbNodes = 0; myNbFaces = 0; if ( theVolume && theVolume->GetType() == SMDSAbs_Volume ) { myVolumeNbNodes = theVolume->NbNodes(); switch ( myVolumeNbNodes ) { case 4: case 6: case 8: { myVolume = theVolume; myNbFaces = theVolume->NbFaces(); // set volume nodes int iNode = 0; SMDS_ElemIteratorPtr nodeIt = myVolume->nodesIterator(); while ( nodeIt->more() ) myVolumeNodes[ iNode++ ] = static_cast( nodeIt->next() ); // nb nodes in each face if ( myVolumeNbNodes == 4 ) myFaceNbNodes = Tetra_nbN; else if ( myVolumeNbNodes == 6 ) myFaceNbNodes = Penta_nbN; else myFaceNbNodes = Hexa_nbN; break; // define volume orientation XYZ botNormal; GetFaceNormal( 0, botNormal.x, botNormal.y, botNormal.z ); const SMDS_MeshNode* topNode = myVolumeNodes[ myVolumeNbNodes - 1 ]; const SMDS_MeshNode* botNode = myVolumeNodes[ 0 ]; XYZ upDir (topNode->X() - botNode->X(), topNode->Y() - botNode->Y(), topNode->Z() - botNode->Z() ); bool diffDir = ( botNormal.Dot( upDir ) < 0 ); myVolForward = ( myVolumeNbNodes == 6 ? diffDir : !diffDir ); } default: myVolume = 0; } } return ( myVolume != 0 ); } //======================================================================= //function : GetInverseNodes //purpose : Return nodes vector of an inverse volume //======================================================================= #define SWAP_NODES(nodes,i1,i2) \ { \ const SMDS_MeshNode* tmp = nodes[ i1 ]; \ nodes[ i1 ] = nodes[ i2 ]; \ nodes[ i2 ] = tmp; \ } void SMDS_VolumeTool::Inverse () { if ( !myVolume ) return; myVolForward = !myVolForward; myCurFace = -1; // inverse top and bottom faces switch ( myVolumeNbNodes ) { case 4: SWAP_NODES( myVolumeNodes, 1, 2 ); break; case 6: SWAP_NODES( myVolumeNodes, 1, 2 ); SWAP_NODES( myVolumeNodes, 4, 5 ); break; case 8: SWAP_NODES( myVolumeNodes, 1, 3 ); SWAP_NODES( myVolumeNodes, 5, 7 ); break; default:; } } //======================================================================= //function : GetSize //purpose : Return element volume //======================================================================= double SMDS_VolumeTool::GetSize() const { return 0; } //======================================================================= //function : GetBaryCenter //purpose : //======================================================================= bool SMDS_VolumeTool::GetBaryCenter(double & X, double & Y, double & Z) const { X = Y = Z = 0.; if ( !myVolume ) return false; for ( int i = 0; i < myVolumeNbNodes; i++ ) { X += myVolumeNodes[ i ]->X(); Y += myVolumeNodes[ i ]->Y(); Z += myVolumeNodes[ i ]->Z(); } X /= myVolumeNbNodes; Y /= myVolumeNbNodes; Z /= myVolumeNbNodes; return true; } //======================================================================= //function : SetForwardOrientation //purpose : Node order will be as for forward orientation //======================================================================= void SMDS_VolumeTool::SetForwardOrientation () { myForwardFaces = true; } //======================================================================= //function : SetExternalNormal //purpose : Node order will be so that faces normals are external //======================================================================= void SMDS_VolumeTool::SetExternalNormal () { myExternalFaces = true; } //======================================================================= //function : NbFaceNodes //purpose : Return number of nodes in the array of face nodes //======================================================================= int SMDS_VolumeTool::NbFaceNodes( int faceIndex ) { if ( !setFace( faceIndex )) return 0; return myFaceNbNodes[ faceIndex ]; } //======================================================================= //function : GetFaceNodes //purpose : Return pointer to the array of face nodes. // To comfort link iteration, the array // length == NbFaceNodes( faceIndex ) + 1 and // the last node == the first one. //======================================================================= const SMDS_MeshNode** SMDS_VolumeTool::GetFaceNodes( int faceIndex ) { if ( !setFace( faceIndex )) return 0; return myFaceNodes; } //======================================================================= //function : GetFaceNodesIndices //purpose : Return pointer to the array of face nodes indices // To comfort link iteration, the array // length == NbFaceNodes( faceIndex ) + 1 and // the last node index == the first one. //======================================================================= const int* SMDS_VolumeTool::GetFaceNodesIndices( int faceIndex ) { if ( !setFace( faceIndex )) return 0; return myFaceNodeIndices; } //======================================================================= //function : GetFaceNodes //purpose : Return a set of face nodes. //======================================================================= bool SMDS_VolumeTool::GetFaceNodes (int faceIndex, std::set& theFaceNodes ) { if ( !setFace( faceIndex )) return false; theFaceNodes.clear(); int iNode, nbNode = myFaceNbNodes[ faceIndex ]; for ( int iNode = 0; iNode < nbNode; iNode++ ) theFaceNodes.insert( myFaceNodes[ iNode ]); return true; } //======================================================================= //function : IsFaceExternal //purpose : Check normal orientation of a returned face //======================================================================= bool SMDS_VolumeTool::IsFaceExternal( int faceIndex ) { if ( myExternalFaces || !myVolume ) return true; bool reversed = ( !myForwardFaces && !myVolForward ); switch ( myVolumeNbNodes ) { case 4: // only the bottom of a forward tetrahedron can be internal return ( reversed || faceIndex != 0 ); case 6: // in a forward pentahedron, the top is internal, in a reversed one - bottom return ( reversed ? faceIndex != 0 : faceIndex != 1 ); case 8: { // in a forward hexahedron, odd face normal is external, else vice versa bool odd = faceIndex % 2; return ( reversed ? !odd : odd ); } default:; } return false; } //======================================================================= //function : GetFaceNormal //purpose : Return a normal to a face //======================================================================= bool SMDS_VolumeTool::GetFaceNormal (int faceIndex, double & X, double & Y, double & Z) { if ( !setFace( faceIndex )) return false; XYZ p1 ( myFaceNodes[0] ); XYZ p2 ( myFaceNodes[1] ); XYZ p3 ( myFaceNodes[2] ); XYZ aVec12( p2 - p1 ); XYZ aVec13( p3 - p1 ); XYZ cross = aVec12.Crossed( aVec13 ); double size = cross.Magnitude(); if ( size <= DBL_MIN ) return false; X = cross.x / size; Y = cross.y / size; Z = cross.z / size; return true; } //======================================================================= //function : GetFaceArea //purpose : Return face area //======================================================================= double SMDS_VolumeTool::GetFaceArea( int faceIndex ) { if ( !setFace( faceIndex )) return 0; XYZ p1 ( myFaceNodes[0] ); XYZ p2 ( myFaceNodes[1] ); XYZ p3 ( myFaceNodes[2] ); XYZ aVec12( p2 - p1 ); XYZ aVec13( p3 - p1 ); double area = aVec12.Crossed( aVec13 ).Magnitude() * 0.5; if ( myFaceNbNodes[ faceIndex ] == 4 ) { XYZ p4 ( myFaceNodes[3] ); XYZ aVec14( p4 - p1 ); area += aVec14.Crossed( aVec13 ).Magnitude() * 0.5; } return area; } //======================================================================= //function : GetOppFaceIndex //purpose : Return index of the opposite face if it exists, else -1. //======================================================================= int SMDS_VolumeTool::GetOppFaceIndex( int faceIndex ) const { int ind = -1; if ( faceIndex >= 0 && faceIndex < NbFaces() ) { switch ( myVolumeNbNodes ) { case 6: if ( faceIndex == 0 || faceIndex == 1 ) ind = 1 - faceIndex; break; case 8: ind = faceIndex + ( faceIndex % 2 ? -1 : 1 ); break; default:; } } return ind; } //======================================================================= //function : IsLinked //purpose : return true if theNode1 is linked with theNode2 //======================================================================= bool SMDS_VolumeTool::IsLinked (const SMDS_MeshNode* theNode1, const SMDS_MeshNode* theNode2) const { if ( !myVolume ) return false; // find nodes indices int i1 = -1, i2 = -1; for ( int i = 0; i < myVolumeNbNodes; i++ ) { if ( myVolumeNodes[ i ] == theNode1 ) i1 = i; else if ( myVolumeNodes[ i ] == theNode2 ) i2 = i; } return IsLinked( i1, i2 ); } //======================================================================= //function : IsLinked //purpose : return true if the node with theNode1Index is linked // with the node with theNode2Index //======================================================================= bool SMDS_VolumeTool::IsLinked (const int theNode1Index, const int theNode2Index) const { int minInd = theNode1Index < theNode2Index ? theNode1Index : theNode2Index; int maxInd = theNode1Index < theNode2Index ? theNode2Index : theNode1Index; if ( minInd < 0 || maxInd > myVolumeNbNodes - 1 || maxInd == minInd ) return false; switch ( myVolumeNbNodes ) { case 4: return true; case 6: switch ( maxInd - minInd ) { case 1: return minInd != 2; case 2: return minInd == 0 || minInd == 3; case 3: return true; default:; } break; case 8: switch ( maxInd - minInd ) { case 1: return minInd != 3; case 3: return minInd == 0 || minInd == 4; case 4: return true; default:; } break; default:; } return false; } //======================================================================= //function : GetNodeIndex //purpose : Return an index of theNode //======================================================================= int SMDS_VolumeTool::GetNodeIndex(const SMDS_MeshNode* theNode) const { if ( myVolume ) { for ( int i = 0; i < myVolumeNbNodes; i++ ) { if ( myVolumeNodes[ i ] == theNode ) return i; } } return -1; } //======================================================================= //function : IsFreeFace //purpose : check that only one volume is build on the face nodes //======================================================================= bool SMDS_VolumeTool::IsFreeFace( int faceIndex ) { const int free = true; if ( !setFace( faceIndex )) return !free; const SMDS_MeshNode** nodes = GetFaceNodes( faceIndex ); int nbFaceNodes = NbFaceNodes( faceIndex ); // evaluate nb of face nodes shared by other volume int maxNbShared = -1; typedef map< const SMDS_MeshElement*, int > TElemIntMap; TElemIntMap volNbShared; TElemIntMap::iterator vNbIt; for ( int iNode = 0; iNode < nbFaceNodes; iNode++ ) { const SMDS_MeshNode* n = nodes[ iNode ]; SMDS_ElemIteratorPtr eIt = n->GetInverseElementIterator(); while ( eIt->more() ) { const SMDS_MeshElement* elem = eIt->next(); if ( elem != myVolume && elem->GetType() == SMDSAbs_Volume ) { int nbShared = 1; vNbIt = volNbShared.find( elem ); if ( vNbIt == volNbShared.end() ) volNbShared.insert ( TElemIntMap::value_type( elem, nbShared )); else nbShared = ++(*vNbIt).second; if ( nbShared > maxNbShared ) maxNbShared = nbShared; } } } if ( maxNbShared < 3 ) return free; // is free // find volumes laying on the opposite side of the face // and sharing all nodes XYZ intNormal; // internal normal GetFaceNormal( faceIndex, intNormal.x, intNormal.y, intNormal.z ); if ( IsFaceExternal( faceIndex )) intNormal = XYZ( -intNormal.x, -intNormal.y, -intNormal.z ); XYZ p0 ( nodes[0] ), baryCenter; for ( vNbIt = volNbShared.begin(); vNbIt != volNbShared.end(); vNbIt++ ) { int nbShared = (*vNbIt).second; if ( nbShared >= 3 ) { SMDS_VolumeTool volume( (*vNbIt).first ); volume.GetBaryCenter( baryCenter.x, baryCenter.y, baryCenter.z ); XYZ intNormal2( baryCenter - p0 ); if ( intNormal.Dot( intNormal2 ) < 0 ) continue; // opposite side } // remove a volume from volNbShared map volNbShared.erase( vNbIt ); } // here volNbShared contains only volumes laying on the // opposite side of the face if ( volNbShared.empty() ) return free; // is free // check if the whole area of a face is shared bool isShared[] = { false, false, false, false }; // 4 triangle parts of a quadrangle for ( vNbIt = volNbShared.begin(); vNbIt != volNbShared.end(); vNbIt++ ) { SMDS_VolumeTool volume( (*vNbIt).first ); bool prevLinkShared = false; int nbSharedLinks = 0; for ( int iNode = 0; iNode < nbFaceNodes; iNode++ ) { bool linkShared = volume.IsLinked( nodes[ iNode ], nodes[ iNode + 1] ); if ( linkShared ) nbSharedLinks++; if ( linkShared && prevLinkShared && volume.IsLinked( nodes[ iNode - 1 ], nodes[ iNode + 1] )) isShared[ iNode ] = true; prevLinkShared = linkShared; } if ( nbSharedLinks == nbFaceNodes ) return !free; // is not free if ( nbFaceNodes == 4 ) { // check traingle parts 1 & 3 if ( isShared[1] && isShared[3] ) return !free; // is not free // check traingle parts 0 & 2; // 0 part could not be checked in the loop; check it here if ( isShared[2] && prevLinkShared && volume.IsLinked( nodes[ 0 ], nodes[ 1 ] ) && volume.IsLinked( nodes[ 1 ], nodes[ 3 ] ) ) return !free; // is not free } } return free; } //======================================================================= //function : GetFaceIndex //purpose : Return index of a face formed by theFaceNodes //======================================================================= int SMDS_VolumeTool::GetFaceIndex( const set& theFaceNodes ) { for ( int iFace = 0; iFace < myNbFaces; iFace++ ) { const SMDS_MeshNode** nodes = GetFaceNodes( iFace ); int nbFaceNodes = NbFaceNodes( iFace ); set nodeSet; for ( int iNode = 0; iNode < nbFaceNodes; iNode++ ) nodeSet.insert( nodes[ iNode ] ); if ( theFaceNodes == nodeSet ) return iFace; } return -1; } //======================================================================= //function : GetFaceIndex //purpose : Return index of a face formed by theFaceNodes //======================================================================= int SMDS_VolumeTool::GetFaceIndex( const set& theFaceNodesIndices ) { for ( int iFace = 0; iFace < myNbFaces; iFace++ ) { const int* nodes = GetFaceNodesIndices( iFace ); int nbFaceNodes = NbFaceNodes( iFace ); set nodeSet; for ( int iNode = 0; iNode < nbFaceNodes; iNode++ ) nodeSet.insert( nodes[ iNode ] ); if ( theFaceNodesIndices == nodeSet ) return iFace; } return -1; } //======================================================================= //function : setFace //purpose : //======================================================================= bool SMDS_VolumeTool::setFace( int faceIndex ) { if ( !myVolume ) return false; if ( myCurFace == faceIndex ) return true; if ( faceIndex < 0 || faceIndex >= NbFaces() ) return false; // choose face node indices switch ( myVolumeNbNodes ) { case 4: if ( myExternalFaces ) myFaceNodeIndices = myVolForward ? Tetra_R[ faceIndex ] : Tetra_F[ faceIndex ]; else if ( myForwardFaces ) myFaceNodeIndices = myVolForward ? Tetra_F[ faceIndex ] : Tetra_R[ faceIndex ]; else myFaceNodeIndices = Tetra_F[ faceIndex ]; break; case 6: if ( myExternalFaces ) myFaceNodeIndices = myVolForward ? Penta_FE[ faceIndex ] : Penta_RE[ faceIndex ]; else if ( myForwardFaces ) myFaceNodeIndices = myVolForward ? Penta_F[ faceIndex ] : Penta_R[ faceIndex ]; else myFaceNodeIndices = Penta_F[ faceIndex ]; break; case 8: if ( myExternalFaces ) myFaceNodeIndices = myVolForward ? Hexa_FE[ faceIndex ] : Hexa_RE[ faceIndex ]; else if ( myForwardFaces ) myFaceNodeIndices = myVolForward ? Hexa_F[ faceIndex ] : Hexa_R[ faceIndex ]; else myFaceNodeIndices = Hexa_F[ faceIndex ]; break; default: return false; } // set face nodes int iNode, nbNode = myFaceNbNodes[ faceIndex ]; for ( iNode = 0; iNode <= nbNode; iNode++ ) myFaceNodes[ iNode ] = myVolumeNodes[ myFaceNodeIndices[ iNode ]]; myCurFace = faceIndex; return true; }