+
+ } // projectBy2DSimilarity()
+
+ //================================================================================
+ /*!
+ * \brief Quadrangle algorithm computing structured triangle mesh
+ */
+ //================================================================================
+
+ struct QuadAlgo : public StdMeshers_Quadrangle_2D
+ {
+ QuadAlgo( int hypId, SMESH_Gen* gen ): StdMeshers_Quadrangle_2D( hypId, gen ) {}
+
+ bool Compute( SMESH_MesherHelper & theHelper, const StdMeshers_FaceSidePtr& theWire )
+ {
+ SMESH_Mesh& theMesh = *theHelper.GetMesh();
+
+ // set sides of a quad FACE
+ FaceQuadStruct::Ptr quad( new FaceQuadStruct );
+ quad->side.reserve( 4 );
+ quad->face = theWire->Face();
+ for ( int i = 0; i < 4; ++i )
+ quad->side.push_back
+ ( StdMeshers_FaceSide::New( quad->face, theWire->Edge(i), &theMesh, i < QUAD_TOP_SIDE,
+ /*skipMedium=*/true, theWire->FaceHelper() ));
+ if ( !setNormalizedGrid( quad ))
+ return false;
+
+ // make internal nodes
+ SMESHDS_Mesh * meshDS = theMesh.GetMeshDS();
+ int geomFaceID = meshDS->ShapeToIndex( quad->face );
+ Handle(Geom_Surface) S = BRep_Tool::Surface( quad->face );
+ for ( int i = 1; i < quad->iSize - 1; i++)
+ for ( int j = 1; j < quad->jSize - 1; j++)
+ {
+ UVPtStruct& uvPnt = quad->UVPt( i, j );
+ gp_Pnt P = S->Value( uvPnt.u, uvPnt.v );
+ uvPnt.node = meshDS->AddNode(P.X(), P.Y(), P.Z());
+ meshDS->SetNodeOnFace( uvPnt.node, geomFaceID, uvPnt.u, uvPnt.v );
+ }
+
+ // make triangles
+ for ( int i = 0; i < quad->iSize-1; i++) {
+ for ( int j = 0; j < quad->jSize-1; j++)
+ {
+ const SMDS_MeshNode* a = quad->uv_grid[ j * quad->iSize + i ].node;
+ const SMDS_MeshNode* b = quad->uv_grid[ j * quad->iSize + i + 1].node;
+ const SMDS_MeshNode* c = quad->uv_grid[(j + 1) * quad->iSize + i + 1].node;
+ const SMDS_MeshNode* d = quad->uv_grid[(j + 1) * quad->iSize + i ].node;
+ theHelper.AddFace(a, b, c);
+ theHelper.AddFace(a, c, d);
+ }
+ }
+ return true;
+ }
+ };
+
+ //================================================================================
+ /*!
+ * \brief Local coordinate system of a triangle. Return barycentric coordinates of a point
+ */
+ //================================================================================
+
+ struct TriaCoordSys
+ {
+ gp_Pnt myO; //!< origin
+ gp_Vec myX; //!< X axis
+ gp_Vec myY; //!< Y axis
+ gp_XY myUV1; //!< UV of 2nd node in this CS
+ gp_XY myUV2; //!< UV of 3d node in this CS
+
+ void Init( const gp_Pnt p1, const gp_Pnt p2, const gp_Pnt p3 )
+ {
+ myO = p1;
+
+ myX = gp_Vec( p1, p2 );
+ myUV1.SetCoord( myX.Magnitude(), 0 );
+ myX /= myUV1.X();
+
+ gp_Vec v13( p1, p3 );
+ myY = myX.CrossCrossed( myX, v13 );
+ myY.Normalize();
+ myUV2.SetCoord( v13 * myX, v13 * myY );
+
+ return;
+ }
+
+ void GetBaryCoords( const gp_Pnt p, double& bc1, double& bc2, double& bc3 ) const
+ {
+ gp_Vec op( myO, p );
+ gp_XY uv( op * myX, op * myY );
+
+ SMESH_MeshAlgos::GetBarycentricCoords( uv,
+ gp::Origin2d().XY(), myUV1, myUV2,
+ bc1, bc2 );
+ bc3 = 1 - bc1 - bc2;
+ }
+ };
+
+
+ //================================================================================
+ /*!
+ * \brief Structured 2D mesh of a quadrilateral FACE; is used in projectQuads()
+ */
+ //================================================================================
+
+ struct QuadMesh : public SMESH_SequentialMesh
+ {
+ ObjectPool< TriaCoordSys > _traiLCSPool;
+ SMESH_ElementSearcher* _elemSearcher;
+ SMESH_Gen _sgen;
+ SMESH_MesherHelper _helper;
+
+ QuadMesh(const TopoDS_Face& face):
+ _elemSearcher( nullptr ), _helper( *this )
+ {
+ _meshDS = new SMESHDS_Mesh( 0, true );
+ _gen = &_sgen;
+ ShapeToMesh( face );
+ }
+ ~QuadMesh() { delete _elemSearcher; }
+
+ // --------------------------------------------------------------------------------
+ /*!
+ * \brief Compute quadrangle mesh and prepare for face search
+ */
+ bool Compute( const TSideVector& wires, int nbSeg1, int nbSeg2, bool isSourceMesh )
+ {
+ if ( wires.size() > 1 || wires[0]->NbEdges() != 4 )
+ return false;
+
+ // compute quadrangle mesh
+
+ SMESH_Hypothesis* algo1D = new StdMeshers_Regular_1D( _sgen.GetANewId(), &_sgen );
+ AddHypothesis( GetShapeToMesh(), algo1D->GetID() );
+
+ StdMeshers_NumberOfSegments * nbHyp1, *nbHyp2;
+ nbHyp1 = new StdMeshers_NumberOfSegments( _sgen.GetANewId(), &_sgen );
+ nbHyp1->SetNumberOfSegments( nbSeg1 );
+ AddHypothesis( wires[0]->Edge(0), nbHyp1->GetID() );
+ AddHypothesis( wires[0]->Edge(2), nbHyp1->GetID() );
+
+ nbHyp2 = new StdMeshers_NumberOfSegments( _sgen.GetANewId(), &_sgen );
+ nbHyp2->SetNumberOfSegments( nbSeg2 );
+ AddHypothesis( wires[0]->Edge(1), nbHyp2->GetID() );
+ AddHypothesis( wires[0]->Edge(3), nbHyp2->GetID() );
+
+ if ( !_sgen.Compute( *this, GetShapeToMesh(), SMESH_Gen::SHAPE_ONLY_UPWARD ))
+ return false;
+
+ QuadAlgo algo2D( _sgen.GetANewId(), &_sgen );
+ if ( !algo2D.Compute( _helper, wires[0] ))
+ return false;
+
+ // remove edges
+ // for ( SMDS_ElemIteratorPtr eIt = _meshDS->elementsIterator( SMDSAbs_Edge ); eIt->more(); )
+ // _meshDS->RemoveFreeElement( eIt->next(), /*sm=*/0, /*groups=*/false );
+
+ // _meshDS->Modified(); // setMyModified();
+ // _meshDS->CompactMesh();
+
+ // create TriaCoordSys for every triangle
+ if ( isSourceMesh )
+ {
+ for ( SMDS_ElemIteratorPtr fIt = _meshDS->elementsIterator( SMDSAbs_Face ); fIt->more(); )
+ {
+ const SMDS_MeshElement* tria = fIt->next();
+ TriaCoordSys* triaLCS = _traiLCSPool.getNew();
+ triaLCS->Init( SMESH_NodeXYZ( tria->GetNode( 0 )),
+ SMESH_NodeXYZ( tria->GetNode( 1 )),
+ SMESH_NodeXYZ( tria->GetNode( 2 )));
+ // int i= tria->GetID() - NbEdges() - 1;
+ // cout << "ID from TRIA " << i << " - poolSize " << _traiLCSPool.nbElements() <<
+ // ( _traiLCSPool[i]!= triaLCS ? " KO" : "" ) << endl;
+ }
+ _elemSearcher = SMESH_MeshAlgos::GetElementSearcher( *_meshDS );
+ }
+ return true;
+ }
+ // --------------------------------------------------------------------------------
+ /*!
+ * \brief Find a source triangle including a point and return its barycentric coordinates
+ */
+ const SMDS_MeshElement* FindFaceByPoint( const gp_Pnt p,
+ double & bc1, double & bc2, double & bc3 )
+ {
+ const SMDS_MeshElement* tria = nullptr;
+ gp_XYZ projPnt = _elemSearcher->Project( p, SMDSAbs_Face, &tria );
+
+ int lcsID = tria->GetID() - NbEdges() - 1;
+ const TriaCoordSys* triaLCS = _traiLCSPool[ lcsID ];
+ triaLCS->GetBaryCoords( projPnt, bc1, bc2, bc3 );
+
+ return tria;
+ }
+ // --------------------------------------------------------------------------------
+ /*!
+ * \brief Return a point lying on a corresponding target triangle
+ */
+ gp_Pnt GetPoint( const SMDS_MeshElement* srcTria, double & bc1, double & bc2, double & bc3 )
+ {
+ const SMDS_MeshElement* tgtTria = _meshDS->FindElement( srcTria->GetID() );
+ gp_Pnt p = ( bc1 * SMESH_NodeXYZ( tgtTria->GetNode(0) ) +
+ bc2 * SMESH_NodeXYZ( tgtTria->GetNode(1) ) +
+ bc3 * SMESH_NodeXYZ( tgtTria->GetNode(2) ) );
+ return p;
+ }
+ // --------------------------------------------------------------------------------
+ /*!
+ * \brief Return an UV of point lying on a corresponding target triangle
+ */
+ gp_XY GetUV( const SMDS_MeshElement* srcTria,
+ double & bc1, double & bc2, double & bc3 )
+ {
+ const SMDS_MeshElement* tgtTria = _meshDS->FindElement( srcTria->GetID() );
+ TopoDS_Shape tgtShape = GetShapeToMesh();
+ const TopoDS_Face& face = TopoDS::Face( tgtShape );
+
+ gp_XY p = ( bc1 * _helper.GetNodeUV( face, tgtTria->GetNode(0) ) +
+ bc2 * _helper.GetNodeUV( face, tgtTria->GetNode(1) ) +
+ bc3 * _helper.GetNodeUV( face, tgtTria->GetNode(2) ) );
+ return p;
+ }
+ };
+
+ //================================================================================
+ /*!
+ * \brief Calculate average size of faces
+ * Actually calculate average of min and max face size
+ */
+ //================================================================================
+
+ double calcAverageFaceSize( SMESHDS_SubMesh* sm )
+ {
+ double minLen = Precision::Infinite(), maxLen = 0;
+ for ( SMDS_ElemIteratorPtr fIt = sm->GetElements(); fIt->more(); )
+ {
+ const SMDS_MeshElement* face = fIt->next();
+ int nbNodes = face->NbCornerNodes();
+ gp_XYZ pPrev = SMESH_NodeXYZ( face->GetNode( nbNodes - 1 ));
+ for ( int i = 0; i < nbNodes; ++i )
+ {
+ SMESH_NodeXYZ p( face->GetNode( i ));
+ double len = ( p - pPrev ).SquareModulus();
+ minLen = Min( len, minLen );
+ maxLen = Max( len, maxLen );
+ pPrev = p;
+ }
+ }
+ return 0.5 * ( Sqrt( minLen ) + Sqrt( maxLen ));