src/StdMeshers/StdMeshers_Projection_2D.cxx

   1 // Copyright (C) 2007-2014  CEA/DEN, EDF R&D, OPEN CASCADE
   2 //
   3 // Copyright (C) 2003-2007  OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
   4 // CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
   5 //
   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, or (at your option) any later version.
  10 //
  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.
  15 //
  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
  19 //
  20 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
  21 //
  22
  23 //  SMESH SMESH : implementaion of SMESH idl descriptions
  24 // File      : StdMeshers_Projection_2D.cxx
  25 // Module    : SMESH
  26 // Created   : Fri Oct 20 11:37:07 2006
  27 // Author    : Edward AGAPOV (eap)
  28 //
  29 #include "StdMeshers_Projection_2D.hxx"
  30
  31 #include "StdMeshers_ProjectionSource2D.hxx"
  32 #include "StdMeshers_ProjectionUtils.hxx"
  33 #include "StdMeshers_FaceSide.hxx"
  34
  35 #include "SMDS_EdgePosition.hxx"
  36 #include "SMDS_FacePosition.hxx"
  37 #include "SMESHDS_Hypothesis.hxx"
  38 #include "SMESHDS_SubMesh.hxx"
  39 #include "SMESH_Block.hxx"
  40 #include "SMESH_Comment.hxx"
  41 #include "SMESH_Gen.hxx"
  42 #include "SMESH_Mesh.hxx"
  43 #include "SMESH_MesherHelper.hxx"
  44 #include "SMESH_Pattern.hxx"
  45 #include "SMESH_subMesh.hxx"
  46 #include "SMESH_subMeshEventListener.hxx"
  47
  48 #include "utilities.h"
  49
  50 #include <BRep_Tool.hxx>
  51 #include <Bnd_B2d.hxx>
  52 #include <TopExp.hxx>
  53 #include <TopExp_Explorer.hxx>
  54 #include <TopTools_DataMapIteratorOfDataMapOfShapeShape.hxx>
  55 #include <TopTools_ListIteratorOfListOfShape.hxx>
  56 #include <TopoDS.hxx>
  57 #include <gp_Ax2.hxx>
  58 #include <gp_Ax3.hxx>
  59
  60
  61 using namespace std;
  62
  63 #define RETURN_BAD_RESULT(msg) { MESSAGE(")-: Error: " << msg); return false; }
  64
  65 namespace TAssocTool = StdMeshers_ProjectionUtils;
  66 //typedef StdMeshers_ProjectionUtils TAssocTool;
  67
  68 //=======================================================================
  69 //function : StdMeshers_Projection_2D
  70 //purpose  :
  71 //=======================================================================
  72
  73 StdMeshers_Projection_2D::StdMeshers_Projection_2D(int hypId, int studyId, SMESH_Gen* gen)
  74   :SMESH_2D_Algo(hypId, studyId, gen)
  75 {
  76   _name = "Projection_2D";
  77   _compatibleHypothesis.push_back("ProjectionSource2D");
  78   _sourceHypo = 0;
  79 }
  80
  81 //================================================================================
  82 /*!
  83  * \brief Destructor
  84  */
  85 //================================================================================
  86
  87 StdMeshers_Projection_2D::~StdMeshers_Projection_2D()
  88 {}
  89
  90 //=======================================================================
  91 //function : CheckHypothesis
  92 //purpose  :
  93 //=======================================================================
  94
  95 bool StdMeshers_Projection_2D::CheckHypothesis(SMESH_Mesh&                          theMesh,
  96                                                const TopoDS_Shape&                  theShape,
  97                                                SMESH_Hypothesis::Hypothesis_Status& theStatus)
  98 {
  99   list <const SMESHDS_Hypothesis * >::const_iterator itl;
 100
 101   const list <const SMESHDS_Hypothesis * >&hyps = GetUsedHypothesis(theMesh, theShape);
 102   if ( hyps.size() == 0 )
 103   {
 104     theStatus = HYP_MISSING;
 105     return false;  // can't work with no hypothesis
 106   }
 107
 108   if ( hyps.size() > 1 )
 109   {
 110     theStatus = HYP_ALREADY_EXIST;
 111     return false;
 112   }
 113
 114   const SMESHDS_Hypothesis *theHyp = hyps.front();
 115
 116   string hypName = theHyp->GetName();
 117
 118   theStatus = HYP_OK;
 119
 120   if (hypName == "ProjectionSource2D")
 121   {
 122     _sourceHypo = static_cast<const StdMeshers_ProjectionSource2D *>(theHyp);
 123
 124     // Check hypo parameters
 125
 126     SMESH_Mesh* srcMesh = _sourceHypo->GetSourceMesh();
 127     SMESH_Mesh* tgtMesh = & theMesh;
 128     if ( !srcMesh )
 129       srcMesh = tgtMesh;
 130
 131     // check vertices
 132     if ( _sourceHypo->HasVertexAssociation() )
 133     {
 134       // source vertices
 135       TopoDS_Shape edge = TAssocTool::GetEdgeByVertices
 136         ( srcMesh, _sourceHypo->GetSourceVertex(1), _sourceHypo->GetSourceVertex(2) );
 137       if ( edge.IsNull() ||
 138            !SMESH_MesherHelper::IsSubShape( edge, srcMesh ) ||
 139            !SMESH_MesherHelper::IsSubShape( edge, _sourceHypo->GetSourceFace() ))
 140       {
 141         theStatus = HYP_BAD_PARAMETER;
 142         SCRUTE((edge.IsNull()));
 143         SCRUTE((SMESH_MesherHelper::IsSubShape( edge, srcMesh )));
 144         SCRUTE((SMESH_MesherHelper::IsSubShape( edge, _sourceHypo->GetSourceFace() )));
 145       }
 146       else
 147       {
 148         // target vertices
 149         edge = TAssocTool::GetEdgeByVertices
 150           ( tgtMesh, _sourceHypo->GetTargetVertex(1), _sourceHypo->GetTargetVertex(2) );
 151         if ( edge.IsNull() || !SMESH_MesherHelper::IsSubShape( edge, tgtMesh ))
 152         {
 153           theStatus = HYP_BAD_PARAMETER;
 154           SCRUTE((edge.IsNull()));
 155           SCRUTE((SMESH_MesherHelper::IsSubShape( edge, tgtMesh )));
 156         }
 157         // PAL16203
 158         else if ( !_sourceHypo->IsCompoundSource() &&
 159                   !SMESH_MesherHelper::IsSubShape( edge, theShape ))
 160         {
 161           theStatus = HYP_BAD_PARAMETER;
 162           SCRUTE((SMESH_MesherHelper::IsSubShape( edge, theShape )));
 163         }
 164       }
 165     }
 166     // check a source face
 167     if ( !SMESH_MesherHelper::IsSubShape( _sourceHypo->GetSourceFace(), srcMesh ) ||
 168          ( srcMesh == tgtMesh && theShape == _sourceHypo->GetSourceFace() ))
 169     {
 170       theStatus = HYP_BAD_PARAMETER;
 171       SCRUTE((SMESH_MesherHelper::IsSubShape( _sourceHypo->GetSourceFace(), srcMesh )));
 172       SCRUTE((srcMesh == tgtMesh));
 173       SCRUTE(( theShape == _sourceHypo->GetSourceFace() ));
 174     }
 175   }
 176   else
 177   {
 178     theStatus = HYP_INCOMPATIBLE;
 179   }
 180   return ( theStatus == HYP_OK );
 181 }
 182
 183 namespace {
 184
 185   //================================================================================
 186   /*!
 187    * \brief define if a node is new or old
 188    * \param node - node to check
 189    * \retval bool - true if the node existed before Compute() is called
 190    */
 191   //================================================================================
 192
 193   bool isOldNode( const SMDS_MeshNode* node/*, const bool is1DComputed*/ )
 194   {
 195     // old nodes are shared by edges and new ones are shared
 196     // only by faces created by mapper
 197     //if ( is1DComputed )
 198     {
 199       bool isOld = node->NbInverseElements(SMDSAbs_Edge) > 0;
 200       return isOld;
 201     }
 202     // else
 203     // {
 204     //   SMDS_ElemIteratorPtr invFace = node->GetInverseElementIterator(SMDSAbs_Face);
 205     //   bool isNew = invFace->more();
 206     //   return !isNew;
 207     // }
 208   }
 209
 210   //================================================================================
 211   /*!
 212    * \brief Class to remove mesh built by pattern mapper on edges
 213    * and vertices in the case of failure of projection algo.
 214    * It does it's job at destruction
 215    */
 216   //================================================================================
 217
 218   class MeshCleaner {
 219     SMESH_subMesh* sm;
 220   public:
 221     MeshCleaner( SMESH_subMesh* faceSubMesh ): sm(faceSubMesh) {}
 222     ~MeshCleaner() { Clean(sm); }
 223     void Release() { sm = 0; } // mesh will not be removed
 224     static void Clean( SMESH_subMesh* sm, bool withSub=true )
 225     {
 226       if ( !sm || !sm->GetSubMeshDS() ) return;
 227       // PAL16567, 18920. Remove face nodes as well
 228 //       switch ( sm->GetSubShape().ShapeType() ) {
 229 //       case TopAbs_VERTEX:
 230 //       case TopAbs_EDGE: {
 231         SMDS_NodeIteratorPtr nIt = sm->GetSubMeshDS()->GetNodes();
 232         SMESHDS_Mesh* mesh = sm->GetFather()->GetMeshDS();
 233         while ( nIt->more() ) {
 234           const SMDS_MeshNode* node = nIt->next();
 235           if ( !isOldNode( node ) )
 236             mesh->RemoveNode( node );
 237         }
 238         // do not break but iterate over DependsOn()
 239 //       }
 240 //       default:
 241         if ( !withSub ) return;
 242         SMESH_subMeshIteratorPtr smIt = sm->getDependsOnIterator(false,false);
 243         while ( smIt->more() )
 244           Clean( smIt->next(), false );
 245 //       }
 246     }
 247   };
 248
 249   //================================================================================
 250   /*!
 251    * \brief find new nodes belonging to one free border of mesh on face
 252     * \param sm - submesh on edge or vertex containg nodes to choose from
 253     * \param face - the face bound by the submesh
 254     * \param u2nodes - map to fill with nodes
 255     * \param seamNodes - set of found nodes
 256     * \retval bool - is a success
 257    */
 258   //================================================================================
 259
 260   bool getBoundaryNodes ( SMESH_subMesh*                        sm,
 261                           const TopoDS_Face&                    face,
 262                           map< double, const SMDS_MeshNode* > & u2nodes,
 263                           set< const SMDS_MeshNode* > &         seamNodes)
 264   {
 265     u2nodes.clear();
 266     seamNodes.clear();
 267     if ( !sm || !sm->GetSubMeshDS() )
 268       RETURN_BAD_RESULT("Null submesh");
 269
 270     SMDS_NodeIteratorPtr nIt = sm->GetSubMeshDS()->GetNodes();
 271     switch ( sm->GetSubShape().ShapeType() ) {
 272
 273     case TopAbs_VERTEX: {
 274       while ( nIt->more() ) {
 275         const SMDS_MeshNode* node = nIt->next();
 276         if ( isOldNode( node ) ) continue;
 277         u2nodes.insert( make_pair( 0., node ));
 278         seamNodes.insert( node );
 279         return true;
 280       }
 281       break;
 282     }
 283     case TopAbs_EDGE: {
 284
 285       // Get submeshes of sub-vertices
 286       const map< int, SMESH_subMesh * >& subSM = sm->DependsOn();
 287       if ( subSM.size() != 2 )
 288         RETURN_BAD_RESULT("there must be 2 submeshes of sub-vertices"
 289                           " but we have " << subSM.size());
 290       SMESH_subMesh* smV1 = subSM.begin()->second;
 291       SMESH_subMesh* smV2 = subSM.rbegin()->second;
 292       if ( !smV1->IsMeshComputed() || !smV2->IsMeshComputed() )
 293         RETURN_BAD_RESULT("Empty vertex submeshes");
 294
 295       const SMDS_MeshNode* nV1 = 0;
 296       const SMDS_MeshNode* nE = 0;
 297
 298       // Look for nV1 - a new node on V1
 299       nIt = smV1->GetSubMeshDS()->GetNodes();
 300       while ( nIt->more() && !nE ) {
 301         const SMDS_MeshNode* node = nIt->next();
 302         if ( isOldNode( node ) ) continue;
 303         nV1 = node;
 304
 305         // Find nE - a new node connected to nV1 and belonging to edge submesh;
 306         SMESHDS_SubMesh* smDS = sm->GetSubMeshDS();
 307         SMDS_ElemIteratorPtr vElems = nV1->GetInverseElementIterator(SMDSAbs_Face);
 308         while ( vElems->more() && !nE ) {
 309           const SMDS_MeshElement* elem = vElems->next();
 310           int nbNodes = elem->NbNodes();
 311           if ( elem->IsQuadratic() )
 312             nbNodes /= 2;
 313           int iV1 = elem->GetNodeIndex( nV1 );
 314           // try next after nV1
 315           int iE = SMESH_MesherHelper::WrapIndex( iV1 + 1, nbNodes );
 316           if ( smDS->Contains( elem->GetNode( iE ) ))
 317             nE = elem->GetNode( iE );
 318           if ( !nE ) {
 319             // try node before nV1
 320             iE = SMESH_MesherHelper::WrapIndex( iV1 - 1, nbNodes );
 321             if ( smDS->Contains( elem->GetNode( iE )))
 322               nE = elem->GetNode( iE );
 323           }
 324           if ( nE && elem->IsQuadratic() ) { // find medium node between nV1 and nE
 325             if ( Abs( iV1 - iE ) == 1 )
 326               nE = elem->GetNode( Min ( iV1, iE ) + nbNodes );
 327             else
 328               nE = elem->GetNode( elem->NbNodes() - 1 );
 329           }
 330         }
 331       }
 332       if ( !nV1 )
 333         RETURN_BAD_RESULT("No new node found on V1");
 334       if ( !nE )
 335         RETURN_BAD_RESULT("new node on edge not found");
 336
 337       // Get the whole free border of a face
 338       list< const SMDS_MeshNode* > bordNodes;
 339       list< const SMDS_MeshElement* > bordFaces;
 340       if ( !SMESH_MeshEditor::FindFreeBorder (nV1, nE, nV1, bordNodes, bordFaces ))
 341         RETURN_BAD_RESULT("free border of a face not found by nodes " <<
 342                           nV1->GetID() << " " << nE->GetID() );
 343
 344       // Insert nodes of the free border to the map until node on V2 encountered
 345       SMESHDS_SubMesh* v2smDS = smV2->GetSubMeshDS();
 346       list< const SMDS_MeshNode* >::iterator bordIt = bordNodes.begin();
 347       bordIt++; // skip nV1
 348       for ( ; bordIt != bordNodes.end(); ++bordIt ) {
 349         const SMDS_MeshNode* node = *bordIt;
 350         if ( v2smDS->Contains( node ))
 351           break;
 352         if ( node->GetPosition()->GetTypeOfPosition() != SMDS_TOP_EDGE )
 353           RETURN_BAD_RESULT("Bad node position type: node " << node->GetID() <<
 354                             " pos type " << node->GetPosition()->GetTypeOfPosition());
 355         const SMDS_EdgePosition* pos =
 356           static_cast<const SMDS_EdgePosition*>(node->GetPosition());
 357         u2nodes.insert( make_pair( pos->GetUParameter(), node ));
 358         seamNodes.insert( node );
 359       }
 360       if ( u2nodes.size() != seamNodes.size() )
 361         RETURN_BAD_RESULT("Bad node params on edge " << sm->GetId() <<
 362                           ", " << u2nodes.size() << " != " << seamNodes.size() );
 363       return true;
 364     }
 365     default:;
 366     }
 367     RETURN_BAD_RESULT ("Unexpected submesh type");
 368
 369   } // bool getBoundaryNodes()
 370
 371   //================================================================================
 372   /*!
 373    * \brief Preform projection in case if tgtFace.IsPartner( srcFace ) and in case
 374    * if projection by transformation is possible
 375    */
 376   //================================================================================
 377
 378   bool projectPartner(const TopoDS_Face&                tgtFace,
 379                       const TopoDS_Face&                srcFace,
 380                       SMESH_Mesh *                      tgtMesh,
 381                       SMESH_Mesh *                      srcMesh,
 382                       const TAssocTool::TShapeShapeMap& shape2ShapeMap)
 383   {
 384     SMESHDS_Mesh* tgtMeshDS = tgtMesh->GetMeshDS();
 385     SMESHDS_Mesh* srcMeshDS = srcMesh->GetMeshDS();
 386
 387     const double tol = 1.e-7 * srcMeshDS->getMaxDim();
 388
 389     gp_Trsf trsf; // transformation to get location of target nodes from source ones
 390     if ( tgtFace.IsPartner( srcFace ))
 391     {
 392       gp_Trsf srcTrsf = srcFace.Location();
 393       gp_Trsf tgtTrsf = tgtFace.Location();
 394       trsf = srcTrsf.Inverted() * tgtTrsf;
 395     }
 396     else
 397     {
 398       // Try to find the transformation
 399
 400       // make any local coord systems of src and tgt faces
 401       vector<gp_Pnt> srcPP, tgtPP; // 3 points on face boundaries to make axes of CS
 402       int tgtNbVert = SMESH_MesherHelper::Count( tgtFace, TopAbs_VERTEX, /*ignoreSame=*/true );
 403       int srcNbVert = SMESH_MesherHelper::Count( srcFace, TopAbs_VERTEX, /*ignoreSame=*/true );
 404       SMESH_subMesh *         srcSM = srcMesh->GetSubMesh( srcFace );
 405       SMESH_subMeshIteratorPtr smIt = srcSM->getDependsOnIterator(/*includeSelf=*/false,false);
 406       srcSM = smIt->next(); // sm of a vertex
 407       while ( smIt->more() && srcPP.size() < 3 )
 408       {
 409         srcSM = smIt->next();
 410         SMESHDS_SubMesh* srcSmds = srcSM->GetSubMeshDS();
 411         if ( !srcSmds ) continue;
 412         SMDS_NodeIteratorPtr nIt = srcSmds->GetNodes();
 413         while ( nIt->more() )
 414         {
 415           SMESH_TNodeXYZ p ( nIt->next());
 416           bool pOK = false;
 417           switch ( srcPP.size() )
 418           {
 419           case 0: pOK = true; break;
 420
 421           case 1: pOK = ( srcPP[0].SquareDistance( p ) > 10*tol ); break;
 422
 423           case 2:
 424             {
 425               gp_Vec p0p1( srcPP[0], srcPP[1] ), p0p( srcPP[0], p );
 426               // pOK = !p0p1.IsParallel( p0p, tol );
 427               pOK = !p0p1.IsParallel( p0p, 3.14/20 ); // angle min 18 degrees
 428               break;
 429             }
 430           }
 431           if ( !pOK )
 432             continue;
 433
 434           // find corresponding point on target shape
 435           pOK = false;
 436           gp_Pnt tgtP;
 437           const TopoDS_Shape& tgtShape = shape2ShapeMap( srcSM->GetSubShape(), /*isSrc=*/true );
 438           if ( tgtShape.ShapeType() == TopAbs_VERTEX )
 439           {
 440             tgtP = BRep_Tool::Pnt( TopoDS::Vertex( tgtShape ));
 441             if ( srcNbVert == tgtNbVert || tgtPP.empty() )
 442               pOK = true;
 443             else
 444               pOK = (( tgtP.Distance( tgtPP[0] ) > tol*tol ) &&
 445                      ( tgtPP.size() == 1 || tgtP.Distance( tgtPP[1] ) > tol*tol ));
 446             //cout << "V - nS " << p._node->GetID() << " - nT " << SMESH_Algo::VertexNode(TopoDS::Vertex( tgtShape),tgtMeshDS)->GetID() << endl;
 447           }
 448           else if ( tgtPP.size() > 0 )
 449           {
 450             if ( SMESHDS_SubMesh* tgtSmds = tgtMeshDS->MeshElements( tgtShape ))
 451             {
 452               double srcDist = srcPP[0].Distance( p );
 453               double eTol = BRep_Tool::Tolerance( TopoDS::Edge( tgtShape ));
 454               if (eTol < tol) eTol = tol;
 455               SMDS_NodeIteratorPtr nItT = tgtSmds->GetNodes();
 456               while ( nItT->more() && !pOK )
 457               {
 458                 const SMDS_MeshNode* n = nItT->next();
 459                 tgtP = SMESH_TNodeXYZ( n );
 460                 pOK = ( fabs( srcDist - tgtPP[0].Distance( tgtP )) < 2*eTol );
 461                 //cout << "E - nS " << p._node->GetID() << " - nT " << n->GetID()<< " OK - " << pOK<< " " << fabs( srcDist - tgtPP[0].Distance( tgtP ))<< " tol " << eTol<< endl;
 462               }
 463             }
 464           }
 465           if ( !pOK )
 466             continue;
 467
 468           srcPP.push_back( p );
 469           tgtPP.push_back( tgtP );
 470         }
 471       }
 472       if ( srcPP.size() != 3 )
 473         return false;
 474
 475       // make transformation
 476       gp_Trsf fromTgtCS, toSrcCS; // from/to global CS
 477       gp_Ax2 srcCS( srcPP[0], gp_Vec( srcPP[0], srcPP[1] ), gp_Vec( srcPP[0], srcPP[2]));
 478       gp_Ax2 tgtCS( tgtPP[0], gp_Vec( tgtPP[0], tgtPP[1] ), gp_Vec( tgtPP[0], tgtPP[2]));
 479       toSrcCS  .SetTransformation( gp_Ax3( srcCS ));
 480       fromTgtCS.SetTransformation( gp_Ax3( tgtCS ));
 481       fromTgtCS.Invert();
 482
 483       trsf = fromTgtCS * toSrcCS;
 484     }
 485
 486     // Fill map of src to tgt nodes with nodes on edges
 487
 488     map<const SMDS_MeshNode* , const SMDS_MeshNode*> src2tgtNodes;
 489     map<const SMDS_MeshNode* , const SMDS_MeshNode*>::iterator srcN_tgtN;
 490
 491     for ( TopExp_Explorer srcExp( srcFace, TopAbs_EDGE); srcExp.More(); srcExp.Next() )
 492     {
 493       const TopoDS_Shape& srcEdge = srcExp.Current();
 494       const TopoDS_Shape& tgtEdge = shape2ShapeMap( srcEdge, /*isSrc=*/true );
 495       if ( srcMesh->GetSubMesh( srcEdge )->IsEmpty() ||
 496            tgtMesh->GetSubMesh( tgtEdge )->IsEmpty() )
 497         continue;
 498
 499       map< double, const SMDS_MeshNode* > srcNodes, tgtNodes;
 500       if (( ! SMESH_Algo::GetSortedNodesOnEdge( srcMeshDS,
 501                                                 TopoDS::Edge( srcEdge ),
 502                                                 /*ignoreMediumNodes = */true,
 503                                                 srcNodes ))
 504            ||
 505           ( ! SMESH_Algo::GetSortedNodesOnEdge( tgtMeshDS,
 506                                                 TopoDS::Edge( tgtEdge ),
 507                                                 /*ignoreMediumNodes = */true,
 508                                                 tgtNodes ))
 509            ||
 510           (( srcNodes.size() != tgtNodes.size() ) && tgtNodes.size() > 0 )
 511           )
 512         return false;
 513
 514       if ( !tgtEdge.IsPartner( srcEdge ))
 515       {
 516         if ( tgtNodes.empty() )
 517           return false;
 518         // check that transformation is OK by three nodes
 519         gp_Pnt p0S = SMESH_TNodeXYZ( (srcNodes.begin())  ->second);
 520         gp_Pnt p1S = SMESH_TNodeXYZ( (srcNodes.rbegin()) ->second);
 521         gp_Pnt p2S = SMESH_TNodeXYZ( (++srcNodes.begin())->second);
 522
 523         gp_Pnt p0T = SMESH_TNodeXYZ( (tgtNodes.begin())  ->second);
 524         gp_Pnt p1T = SMESH_TNodeXYZ( (tgtNodes.rbegin()) ->second);
 525         gp_Pnt p2T = SMESH_TNodeXYZ( (++tgtNodes.begin())->second);
 526
 527         // transform source points, they must coincide with target ones
 528         if ( p0T.SquareDistance( p0S.Transformed( trsf )) > tol ||
 529              p1T.SquareDistance( p1S.Transformed( trsf )) > tol ||
 530              p2T.SquareDistance( p2S.Transformed( trsf )) > tol )
 531         {
 532           //cout << "KO trsf, 3 dist: "
 533           //<< p0T.SquareDistance( p0S.Transformed( trsf ))<< ", "
 534           //<< p1T.SquareDistance( p1S.Transformed( trsf ))<< ", "
 535           //<< p2T.SquareDistance( p2S.Transformed( trsf ))<< ", "<<endl;
 536           return false;
 537         }
 538       }
 539       if ( !tgtNodes.empty() )
 540       {
 541         map< double, const SMDS_MeshNode* >::iterator u_tn = tgtNodes.begin();
 542         map< double, const SMDS_MeshNode* >::iterator u_sn = srcNodes.begin();
 543         for ( ; u_tn != tgtNodes.end(); ++u_tn, ++u_sn)
 544           src2tgtNodes.insert( make_pair( u_sn->second, u_tn->second ));
 545       }
 546     }
 547
 548     // Make new faces
 549
 550     // prepare the helper to adding quadratic elements if necessary
 551     SMESH_MesherHelper helper( *tgtMesh );
 552     helper.SetSubShape( tgtFace );
 553     helper.IsQuadraticSubMesh( tgtFace );
 554
 555     SMESH_MesherHelper srcHelper( *srcMesh );
 556     srcHelper.SetSubShape( srcFace );
 557
 558     const SMDS_MeshNode* nullNode = 0;
 559
 560     // indices of nodes to create properly oriented faces
 561     bool isReverse = ( trsf.Form() != gp_Identity );
 562     int tri1 = 1, tri2 = 2, quad1 = 1, quad3 = 3;
 563     if ( isReverse )
 564       std::swap( tri1, tri2 ), std::swap( quad1, quad3 );
 565
 566     SMESHDS_SubMesh*   srcSubDS = srcMeshDS->MeshElements( srcFace );
 567     SMDS_ElemIteratorPtr elemIt = srcSubDS->GetElements();
 568     vector< const SMDS_MeshNode* > tgtNodes;
 569     while ( elemIt->more() ) // loop on all mesh faces on srcFace
 570     {
 571       const SMDS_MeshElement* elem = elemIt->next();
 572       const int nbN = elem->NbCornerNodes();
 573       tgtNodes.resize( nbN );
 574       helper.SetElementsOnShape( false );
 575       for ( int i = 0; i < nbN; ++i ) // loop on nodes of the source element
 576       {
 577         const SMDS_MeshNode* srcNode = elem->GetNode(i);
 578         srcN_tgtN = src2tgtNodes.insert( make_pair( srcNode, nullNode )).first;
 579         if ( srcN_tgtN->second == nullNode )
 580         {
 581           // create a new node
 582           gp_Pnt tgtP = gp_Pnt( SMESH_TNodeXYZ( srcNode )).Transformed( trsf );
 583           SMDS_MeshNode* n = helper.AddNode( tgtP.X(), tgtP.Y(), tgtP.Z() );
 584           srcN_tgtN->second = n;
 585           switch ( srcNode->GetPosition()->GetTypeOfPosition() )
 586           {
 587           case SMDS_TOP_FACE:
 588           {
 589             gp_Pnt2d srcUV = srcHelper.GetNodeUV( srcFace, srcNode );
 590             tgtMeshDS->SetNodeOnFace( n, helper.GetSubShapeID(), srcUV.X(), srcUV.Y() );
 591             break;
 592           }
 593           case SMDS_TOP_EDGE:
 594           {
 595             const TopoDS_Shape & srcE = srcMeshDS->IndexToShape( srcNode->getshapeId() );
 596             const TopoDS_Shape & tgtE = shape2ShapeMap( srcE, /*isSrc=*/true );
 597             double srcU = srcHelper.GetNodeU( TopoDS::Edge( srcE ), srcNode );
 598             tgtMeshDS->SetNodeOnEdge( n, TopoDS::Edge( tgtE ), srcU );
 599             break;
 600           }
 601           case SMDS_TOP_VERTEX:
 602           {
 603             const TopoDS_Shape & srcV = srcMeshDS->IndexToShape( srcNode->getshapeId() );
 604             const TopoDS_Shape & tgtV = shape2ShapeMap( srcV, /*isSrc=*/true );
 605             tgtMeshDS->SetNodeOnVertex( n, TopoDS::Vertex( tgtV ));
 606             break;
 607           }
 608           default:;
 609           }
 610         }
 611         tgtNodes[i] = srcN_tgtN->second;
 612       }
 613       // create a new face
 614       helper.SetElementsOnShape( true );
 615       switch ( nbN )
 616       {
 617       case 3: helper.AddFace(tgtNodes[0], tgtNodes[tri1], tgtNodes[tri2]); break;
 618       case 4: helper.AddFace(tgtNodes[0], tgtNodes[quad1], tgtNodes[2], tgtNodes[quad3]); break;
 619       default:
 620         if ( isReverse ) std::reverse( tgtNodes.begin(), tgtNodes.end() );
 621         helper.AddPolygonalFace( tgtNodes );
 622       }
 623     }
 624
 625     // check node positions
 626
 627     if ( !tgtFace.IsPartner( srcFace ) )
 628     {
 629       int nbOkPos = 0;
 630       const double tol2d = 1e-12;
 631       srcN_tgtN = src2tgtNodes.begin();
 632       for ( ; srcN_tgtN != src2tgtNodes.end(); ++srcN_tgtN )
 633       {
 634         const SMDS_MeshNode* n = srcN_tgtN->second;
 635         switch ( n->GetPosition()->GetTypeOfPosition() )
 636         {
 637         case SMDS_TOP_FACE:
 638         {
 639           gp_XY uv = helper.GetNodeUV( tgtFace, n ), uvBis = uv;
 640           if (( helper.CheckNodeUV( tgtFace, n, uv, tol )) &&
 641               (( uv - uvBis ).SquareModulus() < tol2d )    &&
 642               ( ++nbOkPos > 10 ))
 643             return true;
 644           else
 645             nbOkPos = 0;
 646           break;
 647         }
 648         case SMDS_TOP_EDGE:
 649         {
 650           const TopoDS_Edge & tgtE = TopoDS::Edge( tgtMeshDS->IndexToShape( n->getshapeId() ));
 651           double u = helper.GetNodeU( tgtE, n ), uBis = u;
 652           if (( !helper.CheckNodeU( tgtE, n, u, tol )) ||
 653               (( u - uBis ) < tol2d ))
 654             nbOkPos = 0;
 655           break;
 656         }
 657         default:;
 658         }
 659       }
 660     }
 661
 662     return true;
 663
 664   } //   bool projectPartner()
 665
 666   //================================================================================
 667   /*!
 668    * \brief Check if two consecutive EDGEs are connected in 2D
 669    *  \param [in] E1 - a well oriented non-seam EDGE
 670    *  \param [in] E2 - a possibly well oriented seam EDGE
 671    *  \param [in] F - a FACE
 672    *  \return bool - result
 673    */
 674   //================================================================================
 675
 676   bool are2dConnected( const TopoDS_Edge & E1,
 677                        const TopoDS_Edge & E2,
 678                        const TopoDS_Face & F )
 679   {
 680     double f,l;
 681     Handle(Geom2d_Curve) c1 = BRep_Tool::CurveOnSurface( E1, F, f, l );
 682     gp_Pnt2d uvLast1 = c1->Value( E1.Orientation() == TopAbs_REVERSED ? f : l );
 683
 684     Handle(Geom2d_Curve) c2 = BRep_Tool::CurveOnSurface( E2, F, f, l );
 685     gp_Pnt2d uvFirst2 = c2->Value( f );
 686     gp_Pnt2d uvLast2  = c2->Value( l );
 687     double tol2 = 1e-5 * uvLast2.SquareDistance( uvFirst2 );
 688
 689     return (( uvLast1.SquareDistance( uvFirst2 ) < tol2 ) ||
 690             ( uvLast1.SquareDistance( uvLast2 ) < tol2 ));
 691   }
 692
 693   //================================================================================
 694   /*!
 695    * \brief Preform projection in case if the faces are similar in 2D space
 696    */
 697   //================================================================================
 698
 699   bool projectBy2DSimilarity(const TopoDS_Face&                tgtFace,
 700                              const TopoDS_Face&                srcFace,
 701                              SMESH_Mesh *                      tgtMesh,
 702                              SMESH_Mesh *                      srcMesh,
 703                              const TAssocTool::TShapeShapeMap& shape2ShapeMap,
 704                              const bool                        is1DComputed)
 705   {
 706     // 1) Preparation
 707
 708     // get ordered src EDGEs
 709     TError err;
 710     TSideVector srcWires =
 711       StdMeshers_FaceSide::GetFaceWires( srcFace, *srcMesh,/*ignoreMediumNodes = */false, err);
 712     if ( err && !err->IsOK() )
 713       return false;
 714
 715     // make corresponding sequence of tgt EDGEs
 716     TSideVector tgtWires( srcWires.size() );
 717     for ( size_t iW = 0; iW < srcWires.size(); ++iW )
 718     {
 719       list< TopoDS_Edge > tgtEdges;
 720       StdMeshers_FaceSidePtr srcWire = srcWires[iW];
 721       TopTools_IndexedMapOfShape edgeMap; // to detect seam edges
 722       for ( int iE = 0; iE < srcWire->NbEdges(); ++iE )
 723       {
 724         TopoDS_Edge E = TopoDS::Edge( shape2ShapeMap( srcWire->Edge( iE ), /*isSrc=*/true));
 725         // reverse a seam edge encountered for the second time
 726         const int index = edgeMap.Add( E );
 727         if ( index < edgeMap.Extent() ) // E is a seam
 728         {
 729           // check which of edges to reverse, E or one already being in tgtEdges
 730           if ( are2dConnected( tgtEdges.back(), E, tgtFace ))
 731           {
 732             list< TopoDS_Edge >::iterator eIt = tgtEdges.begin();
 733             std::advance( eIt, index-1 );
 734             eIt->Reverse();
 735           }
 736           else
 737           {
 738             E.Reverse();
 739           }
 740         }
 741         tgtEdges.push_back( E );
 742       }
 743       tgtWires[ iW ].reset( new StdMeshers_FaceSide( tgtFace, tgtEdges, tgtMesh,
 744                                                      /*theIsForward = */ true,
 745                                                      /*theIgnoreMediumNodes = */false));
 746       if ( is1DComputed &&
 747            srcWires[iW]->GetUVPtStruct().size() !=
 748            tgtWires[iW]->GetUVPtStruct().size())
 749         return false;
 750     }
 751
 752     // 2) Find transformation
 753
 754     gp_Trsf2d trsf;
 755     {
 756       // get 2 pairs of corresponding UVs
 757       gp_Pnt2d srcP0 = srcWires[0]->Value2d(0.0);
 758       gp_Pnt2d srcP1 = srcWires[0]->Value2d(0.333);
 759       gp_Pnt2d tgtP0 = tgtWires[0]->Value2d(0.0);
 760       gp_Pnt2d tgtP1 = tgtWires[0]->Value2d(0.333);
 761
 762       // make transformation
 763       gp_Trsf2d fromTgtCS, toSrcCS; // from/to global CS
 764       gp_Ax2d srcCS( srcP0, gp_Vec2d( srcP0, srcP1 ));
 765       gp_Ax2d tgtCS( tgtP0, gp_Vec2d( tgtP0, tgtP1 ));
 766       toSrcCS  .SetTransformation( srcCS );
 767       fromTgtCS.SetTransformation( tgtCS );
 768       fromTgtCS.Invert();
 769
 770       trsf = fromTgtCS * toSrcCS;
 771
 772       // check transformation
 773       const double tol = 1e-5 * gp_Vec2d( srcP0, srcP1 ).Magnitude();
 774       for ( double u = 0.12; u < 1.; u += 0.1 )
 775       {
 776         gp_Pnt2d srcUV = srcWires[0]->Value2d( u );
 777         gp_Pnt2d tgtUV = tgtWires[0]->Value2d( u );
 778         gp_Pnt2d tgtUV2 = srcUV.Transformed( trsf );
 779         if ( tgtUV.Distance( tgtUV2 ) > tol )
 780           return false;
 781       }
 782     }
 783
 784     // 3) Projection
 785
 786     typedef map<const SMDS_MeshNode* , const SMDS_MeshNode*, TIDCompare> TN2NMap;
 787     TN2NMap src2tgtNodes;
 788     TN2NMap::iterator srcN_tgtN;
 789
 790     // fill src2tgtNodes in with nodes on EDGEs
 791     for ( unsigned iW = 0; iW < srcWires.size(); ++iW )
 792       if ( is1DComputed )
 793       {
 794         const vector<UVPtStruct>& srcUVs = srcWires[iW]->GetUVPtStruct();
 795         const vector<UVPtStruct>& tgtUVs = tgtWires[iW]->GetUVPtStruct();
 796         for ( unsigned i = 0; i < srcUVs.size(); ++i )
 797           src2tgtNodes.insert( make_pair( srcUVs[i].node, tgtUVs[i].node ));
 798       }
 799       else
 800       {
 801         for ( int iE = 0; iE < srcWires[iW]->NbEdges(); ++iE )
 802         {
 803           TopoDS_Vertex srcV = srcWires[iW]->FirstVertex(iE);
 804           TopoDS_Vertex tgtV = tgtWires[iW]->FirstVertex(iE);
 805           const SMDS_MeshNode* srcNode = SMESH_Algo::VertexNode( srcV, srcMesh->GetMeshDS() );
 806           const SMDS_MeshNode* tgtNode = SMESH_Algo::VertexNode( tgtV, tgtMesh->GetMeshDS() );
 807           if ( tgtNode && srcNode )
 808             src2tgtNodes.insert( make_pair( srcNode, tgtNode ));
 809         }
 810       }
 811
 812     // make elements
 813
 814     SMESHDS_SubMesh* srcSubDS = srcMesh->GetMeshDS()->MeshElements( srcFace );
 815
 816     SMESH_MesherHelper helper( *tgtMesh );
 817     helper.SetSubShape( tgtFace );
 818     if ( is1DComputed )
 819       helper.IsQuadraticSubMesh( tgtFace );
 820     else
 821       helper.SetIsQuadratic( srcSubDS->GetElements()->next()->IsQuadratic() );
 822     helper.SetElementsOnShape( true );
 823     Handle(Geom_Surface) tgtSurface = BRep_Tool::Surface( tgtFace );
 824     SMESHDS_Mesh* tgtMeshDS = tgtMesh->GetMeshDS();
 825
 826     SMESH_MesherHelper srcHelper( *srcMesh );
 827     srcHelper.SetSubShape( srcFace );
 828
 829     const SMDS_MeshNode* nullNode = 0;
 830
 831     SMDS_ElemIteratorPtr elemIt = srcSubDS->GetElements();
 832     vector< const SMDS_MeshNode* > tgtNodes;
 833     bool uvOK;
 834     while ( elemIt->more() ) // loop on all mesh faces on srcFace
 835     {
 836       const SMDS_MeshElement* elem = elemIt->next();
 837       const int nbN = elem->NbCornerNodes();
 838       tgtNodes.resize( nbN );
 839       for ( int i = 0; i < nbN; ++i ) // loop on nodes of the source element
 840       {
 841         const SMDS_MeshNode* srcNode = elem->GetNode(i);
 842         srcN_tgtN = src2tgtNodes.insert( make_pair( srcNode, nullNode )).first;
 843         if ( srcN_tgtN->second == nullNode )
 844         {
 845           // create a new node
 846           gp_Pnt2d srcUV = srcHelper.GetNodeUV( srcFace, srcNode,
 847                                                 elem->GetNode( helper.WrapIndex(i+1,nbN)), &uvOK);
 848           gp_Pnt2d tgtUV = srcUV.Transformed( trsf );
 849           gp_Pnt   tgtP  = tgtSurface->Value( tgtUV.X(), tgtUV.Y() );
 850           SMDS_MeshNode* n = tgtMeshDS->AddNode( tgtP.X(), tgtP.Y(), tgtP.Z() );
 851           switch ( srcNode->GetPosition()->GetTypeOfPosition() )
 852           {
 853           case SMDS_TOP_FACE: {
 854             tgtMeshDS->SetNodeOnFace( n, helper.GetSubShapeID(), tgtUV.X(), tgtUV.Y() );
 855             break;
 856           }
 857           case SMDS_TOP_EDGE: {
 858             TopoDS_Shape srcEdge = srcHelper.GetSubShapeByNode( srcNode, srcHelper.GetMeshDS() );
 859             TopoDS_Edge  tgtEdge = TopoDS::Edge( shape2ShapeMap( srcEdge, /*isSrc=*/true ));
 860             tgtMeshDS->SetNodeOnEdge( n, TopoDS::Edge( tgtEdge ));
 861             double U = srcHelper.GetNodeU( TopoDS::Edge( srcEdge ), srcNode );
 862             helper.CheckNodeU( tgtEdge, n, U, Precision::PConfusion());
 863             n->SetPosition(SMDS_PositionPtr(new SMDS_EdgePosition( U )));
 864             break;
 865           }
 866           case SMDS_TOP_VERTEX: {
 867             TopoDS_Shape srcV = srcHelper.GetSubShapeByNode( srcNode, srcHelper.GetMeshDS() );
 868             TopoDS_Shape tgtV = shape2ShapeMap( srcV, /*isSrc=*/true );
 869             tgtMeshDS->SetNodeOnVertex( n, TopoDS::Vertex( tgtV ));
 870             break;
 871           }
 872           }
 873           srcN_tgtN->second = n;
 874         }
 875         tgtNodes[i] = srcN_tgtN->second;
 876       }
 877       // create a new face (with reversed orientation)
 878       switch ( nbN )
 879       {
 880       case 3: helper.AddFace(tgtNodes[0], tgtNodes[2], tgtNodes[1]); break;
 881       case 4: helper.AddFace(tgtNodes[0], tgtNodes[3], tgtNodes[2], tgtNodes[1]); break;
 882       }
 883     }
 884     return true;
 885
 886   } // bool projectBy2DSimilarity(...)
 887
 888 } // namespace
 889
 890
 891 //=======================================================================
 892 //function : Compute
 893 //purpose  :
 894 //=======================================================================
 895
 896 bool StdMeshers_Projection_2D::Compute(SMESH_Mesh& theMesh, const TopoDS_Shape& theShape)
 897 {
 898   MESSAGE("Projection_2D Compute");
 899   if ( !_sourceHypo )
 900     return false;
 901
 902   SMESH_Mesh * srcMesh = _sourceHypo->GetSourceMesh();
 903   SMESH_Mesh * tgtMesh = & theMesh;
 904   if ( !srcMesh )
 905     srcMesh = tgtMesh;
 906
 907   SMESHDS_Mesh * meshDS = theMesh.GetMeshDS();
 908
 909   // ---------------------------
 910   // Make sub-shapes association
 911   // ---------------------------
 912
 913   TopoDS_Face   tgtFace = TopoDS::Face( theShape.Oriented(TopAbs_FORWARD));
 914   TopoDS_Shape srcShape = _sourceHypo->GetSourceFace().Oriented(TopAbs_FORWARD);
 915
 916   TAssocTool::TShapeShapeMap shape2ShapeMap;
 917   TAssocTool::InitVertexAssociation( _sourceHypo, shape2ShapeMap );
 918   if ( !TAssocTool::FindSubShapeAssociation( tgtFace, tgtMesh, srcShape, srcMesh,
 919                                              shape2ShapeMap)  ||
 920        !shape2ShapeMap.IsBound( tgtFace ))
 921   {
 922     if ( srcShape.ShapeType() == TopAbs_FACE )
 923     {
 924       int nbE1 = SMESH_MesherHelper::Count( tgtFace, TopAbs_EDGE, /*ignoreSame=*/true );
 925       int nbE2 = SMESH_MesherHelper::Count( srcShape, TopAbs_EDGE, /*ignoreSame=*/true );
 926       if ( nbE1 != nbE2 )
 927         return error(COMPERR_BAD_SHAPE,
 928                      SMESH_Comment("Different number of edges in source and target faces: ")
 929                      << nbE2 << " and " << nbE1 );
 930     }
 931     return error(COMPERR_BAD_SHAPE,"Topology of source and target faces seems different" );
 932   }
 933   TopoDS_Face srcFace = TopoDS::Face( shape2ShapeMap( tgtFace ).Oriented(TopAbs_FORWARD));
 934
 935   // ----------------------------------------------
 936   // Assure that mesh on a source Face is computed
 937   // ----------------------------------------------
 938
 939   SMESH_subMesh* srcSubMesh = srcMesh->GetSubMesh( srcFace );
 940   SMESH_subMesh* tgtSubMesh = tgtMesh->GetSubMesh( tgtFace );
 941
 942   string srcMeshError;
 943   if ( tgtMesh == srcMesh ) {
 944     if ( !TAssocTool::MakeComputed( srcSubMesh ))
 945       srcMeshError = TAssocTool::SourceNotComputedError( srcSubMesh, this );
 946   }
 947   else {
 948     if ( !srcSubMesh->IsMeshComputed() )
 949       srcMeshError = TAssocTool::SourceNotComputedError();
 950   }
 951   if ( !srcMeshError.empty() )
 952     return error(COMPERR_BAD_INPUT_MESH, srcMeshError );
 953
 954   // ===========
 955   // Projection
 956   // ===========
 957
 958   // find out if EDGEs are meshed or not
 959   bool is1DComputed = false;
 960   SMESH_subMeshIteratorPtr smIt = tgtSubMesh->getDependsOnIterator(/*includeSelf=*/false,
 961                                                                    /*complexShapeFirst=*/true);
 962   while ( smIt->more() && !is1DComputed )
 963   {
 964     SMESH_subMesh* sm = smIt->next();
 965     if ( sm->GetSubShape().ShapeType() == TopAbs_EDGE )
 966       is1DComputed = sm->IsMeshComputed();
 967   }
 968
 969   bool done = false;
 970
 971   if ( !done )
 972   {
 973     // try to project from the same face with different location
 974     done = projectPartner( tgtFace, srcFace, tgtMesh, srcMesh, shape2ShapeMap );
 975   }
 976   if ( !done )
 977   {
 978     // projection in case if the faces are similar in 2D space
 979     done = projectBy2DSimilarity( tgtFace, srcFace, tgtMesh, srcMesh, shape2ShapeMap, is1DComputed);
 980   }
 981
 982   SMESH_MesherHelper helper( theMesh );
 983   helper.SetSubShape( tgtFace );
 984
 985   if ( !done )
 986   {
 987     // --------------------
 988     // Prepare to mapping
 989     // --------------------
 990
 991     // Check if node projection to a face is needed
 992     Bnd_B2d uvBox;
 993     SMDS_ElemIteratorPtr faceIt = srcSubMesh->GetSubMeshDS()->GetElements();
 994     int nbFaceNodes = 0;
 995     for ( ; nbFaceNodes < 3 && faceIt->more();  ) {
 996       const SMDS_MeshElement* face = faceIt->next();
 997       SMDS_ElemIteratorPtr nodeIt = face->nodesIterator();
 998       while ( nodeIt->more() ) {
 999         const SMDS_MeshNode* node = static_cast<const SMDS_MeshNode*>( nodeIt->next() );
1000         if ( node->GetPosition()->GetTypeOfPosition() == SMDS_TOP_FACE ) {
1001           nbFaceNodes++;
1002           uvBox.Add( helper.GetNodeUV( srcFace, node ));
1003         }
1004       }
1005     }
1006     const bool toProjectNodes =
1007       ( nbFaceNodes > 0 && ( uvBox.IsVoid() || uvBox.SquareExtent() < DBL_MIN ));
1008
1009     // Find the corresponding source and target vertex
1010     // and <theReverse> flag needed to call mapper.Apply()
1011
1012     TopoDS_Vertex srcV1, tgtV1;
1013     bool reverse = false;
1014
1015     if ( _sourceHypo->HasVertexAssociation() ) {
1016       srcV1 = _sourceHypo->GetSourceVertex(1);
1017       tgtV1 = _sourceHypo->GetTargetVertex(1);
1018     } else {
1019       srcV1 = TopoDS::Vertex( TopExp_Explorer( srcFace, TopAbs_VERTEX ).Current() );
1020       tgtV1 = TopoDS::Vertex( shape2ShapeMap( srcV1, /*isSrc=*/true ));
1021     }
1022     list< TopoDS_Edge > tgtEdges, srcEdges;
1023     list< int > nbEdgesInWires;
1024     SMESH_Block::GetOrderedEdges( tgtFace, tgtEdges, nbEdgesInWires, tgtV1 );
1025     SMESH_Block::GetOrderedEdges( srcFace, srcEdges, nbEdgesInWires, srcV1 );
1026
1027     if ( nbEdgesInWires.front() > 1 ) // possible to find out orientation
1028     {
1029       TopoDS_Edge srcE1 = srcEdges.front(), tgtE1 = tgtEdges.front();
1030       TopoDS_Shape srcE1bis = shape2ShapeMap( tgtE1 );
1031       reverse = ( ! srcE1.IsSame( srcE1bis ));
1032       if ( reverse &&
1033            _sourceHypo->HasVertexAssociation() &&
1034            nbEdgesInWires.front() > 2 &&
1035            helper.IsRealSeam( tgtEdges.front() ))
1036       {
1037         // projection to a face with seam EDGE; pb is that GetOrderedEdges()
1038         // always puts a seam EDGE first (if possible) and as a result
1039         // we can't use only theReverse flag to correctly associate source
1040         // and target faces in the mapper. Thus we select srcV1 so that
1041         // GetOrderedEdges() to return EDGEs in a needed order
1042         list< TopoDS_Edge >::iterator edge = srcEdges.begin();
1043         for ( ; edge != srcEdges.end(); ++edge ) {
1044           if ( srcE1bis.IsSame( *edge )) {
1045             srcV1 = helper.IthVertex( 0, *edge );
1046             break;
1047           }
1048         }
1049       }
1050     }
1051     else if ( nbEdgesInWires.front() == 1 )
1052     {
1053       // TODO::Compare orientation of curves in a sole edge
1054       //RETURN_BAD_RESULT("Not implemented case");
1055     }
1056     else
1057     {
1058       RETURN_BAD_RESULT("Bad result from SMESH_Block::GetOrderedEdges()");
1059     }
1060
1061     // Load pattern from the source face
1062     SMESH_Pattern mapper;
1063     mapper.Load( srcMesh, srcFace, toProjectNodes, srcV1 );
1064     if ( mapper.GetErrorCode() != SMESH_Pattern::ERR_OK )
1065       return error(COMPERR_BAD_INPUT_MESH,"Can't load mesh pattern from the source face");
1066
1067     // --------------------
1068     // Perform 2D mapping
1069     // --------------------
1070
1071     // Compute mesh on a target face
1072
1073     mapper.Apply( tgtFace, tgtV1, reverse );
1074     if ( mapper.GetErrorCode() != SMESH_Pattern::ERR_OK )
1075       return error("Can't apply source mesh pattern to the face");
1076
1077     // Create the mesh
1078
1079     const bool toCreatePolygons = false, toCreatePolyedrs = false;
1080     mapper.MakeMesh( tgtMesh, toCreatePolygons, toCreatePolyedrs );
1081     if ( mapper.GetErrorCode() != SMESH_Pattern::ERR_OK )
1082       return error("Can't make mesh by source mesh pattern");
1083
1084     // it will remove mesh built by pattern mapper on edges and vertices
1085     // in failure case
1086     MeshCleaner cleaner( tgtSubMesh );
1087
1088     // -------------------------------------------------------------------------
1089     // mapper doesn't take care of nodes already existing on edges and vertices,
1090     // so we must merge nodes created by it with existing ones
1091     // -------------------------------------------------------------------------
1092
1093     SMESH_MeshEditor::TListOfListOfNodes groupsOfNodes;
1094
1095     // Make groups of nodes to merge
1096
1097     // loop on EDGE and VERTEX sub-meshes of a target FACE
1098     smIt = tgtSubMesh->getDependsOnIterator(/*includeSelf=*/false,/*complexShapeFirst=*/false);
1099     while ( smIt->more() )
1100     {
1101       SMESH_subMesh*     sm = smIt->next();
1102       SMESHDS_SubMesh* smDS = sm->GetSubMeshDS();
1103       if ( !smDS || smDS->NbNodes() == 0 )
1104         continue;
1105       //if ( !is1DComputed && sm->GetSubShape().ShapeType() == TopAbs_EDGE )
1106       //break;
1107
1108       if ( helper.IsDegenShape( sm->GetId() ) ) // to merge all nodes on degenerated
1109       {
1110         if ( sm->GetSubShape().ShapeType() == TopAbs_EDGE )
1111         {
1112           groupsOfNodes.push_back( list< const SMDS_MeshNode* >() );
1113           SMESH_subMeshIteratorPtr smDegenIt
1114             = sm->getDependsOnIterator(/*includeSelf=*/true,/*complexShapeFirst=*/false);
1115           while ( smDegenIt->more() )
1116             if (( smDS = smDegenIt->next()->GetSubMeshDS() ))
1117             {
1118               SMDS_NodeIteratorPtr nIt = smDS->GetNodes();
1119               while ( nIt->more() )
1120                 groupsOfNodes.back().push_back( nIt->next() );
1121             }
1122         }
1123         continue; // do not treat sm of degen VERTEX
1124       }
1125
1126       // Sort new and old nodes of a submesh separately
1127
1128       bool isSeam = helper.IsRealSeam( sm->GetId() );
1129
1130       enum { NEW_NODES = 0, OLD_NODES };
1131       map< double, const SMDS_MeshNode* > u2nodesMaps[2], u2nodesOnSeam;
1132       map< double, const SMDS_MeshNode* >::iterator u_oldNode, u_newNode, u_newOnSeam, newEnd;
1133       set< const SMDS_MeshNode* > seamNodes;
1134
1135       // mapper changed, no more "mapper puts on a seam edge nodes from 2 edges"
1136       if ( isSeam && ! getBoundaryNodes ( sm, tgtFace, u2nodesOnSeam, seamNodes ))
1137         ;//RETURN_BAD_RESULT("getBoundaryNodes() failed");
1138
1139       SMDS_NodeIteratorPtr nIt = smDS->GetNodes();
1140       while ( nIt->more() )
1141       {
1142         const SMDS_MeshNode* node = nIt->next();
1143         bool isOld = isOldNode( node );
1144
1145         if ( !isOld && isSeam ) { // new node on a seam edge
1146           if ( seamNodes.count( node ) )
1147             continue; // node is already in the map
1148         }
1149
1150         // sort nodes on edges by their position
1151         map< double, const SMDS_MeshNode* > & pos2nodes = u2nodesMaps[isOld ? OLD_NODES : NEW_NODES];
1152         switch ( node->GetPosition()->GetTypeOfPosition() )
1153         {
1154         case  SMDS_TOP_VERTEX: {
1155           if ( !is1DComputed && !pos2nodes.empty() )
1156             u2nodesMaps[isOld ? NEW_NODES : OLD_NODES].insert( make_pair( 0, node ));
1157           else
1158             pos2nodes.insert( make_pair( 0, node ));
1159           break;
1160         }
1161         case  SMDS_TOP_EDGE:   {
1162           const SMDS_EdgePosition* pos =
1163             static_cast<const SMDS_EdgePosition*>(node->GetPosition());
1164           pos2nodes.insert( make_pair( pos->GetUParameter(), node ));
1165           break;
1166         }
1167         default:
1168           RETURN_BAD_RESULT("Wrong node position type: "<<
1169                             node->GetPosition()->GetTypeOfPosition());
1170         }
1171       }
1172       const bool mergeNewToOld =
1173         ( u2nodesMaps[ NEW_NODES ].size() == u2nodesMaps[ OLD_NODES ].size() );
1174       const bool mergeSeamToNew =
1175         ( u2nodesMaps[ NEW_NODES ].size() == u2nodesOnSeam.size() );
1176
1177       if ( !mergeNewToOld )
1178         if ( u2nodesMaps[ NEW_NODES ].size() > 0 &&
1179              u2nodesMaps[ OLD_NODES ].size() > 0 )
1180         {
1181           u_oldNode = u2nodesMaps[ OLD_NODES ].begin();
1182           newEnd    = u2nodesMaps[ OLD_NODES ].end();
1183           for ( ; u_oldNode != newEnd; ++u_oldNode )
1184             SMESH_Algo::addBadInputElement( u_oldNode->second );
1185           return error( COMPERR_BAD_INPUT_MESH,
1186                         SMESH_Comment( "Existing mesh mismatches the projected 2D mesh on " )
1187                         << ( sm->GetSubShape().ShapeType() == TopAbs_EDGE ? "edge" : "vertex" )
1188                         << " #" << sm->GetId() );
1189         }
1190       if ( isSeam && !mergeSeamToNew ) {
1191         const TopoDS_Shape& seam = sm->GetSubShape();
1192         if ( u2nodesMaps[ NEW_NODES ].size() > 0 &&
1193              u2nodesOnSeam.size()            > 0 &&
1194              seam.ShapeType() == TopAbs_EDGE )
1195         {
1196           int nbE1 = SMESH_MesherHelper::Count( tgtFace, TopAbs_EDGE, /*ignoreSame=*/true );
1197           int nbE2 = SMESH_MesherHelper::Count( srcFace, TopAbs_EDGE, /*ignoreSame=*/true );
1198           if ( nbE1 != nbE2 ) // 2 EDGEs are mapped to a seam EDGE
1199           {
1200             // find the 2 EDGEs of srcFace
1201             TopTools_DataMapIteratorOfDataMapOfShapeShape src2tgtIt( shape2ShapeMap._map2to1 );
1202             for ( ; src2tgtIt.More(); src2tgtIt.Next() )
1203               if ( seam.IsSame( src2tgtIt.Value() ))
1204                 SMESH_Algo::addBadInputElements
1205                   ( srcMesh->GetMeshDS()->MeshElements( src2tgtIt.Key() ));
1206             return error( COMPERR_BAD_INPUT_MESH,
1207                           "Different number of nodes on two edges projected to a seam edge" );
1208           }
1209         }
1210       }
1211
1212       // Make groups of nodes to merge
1213
1214       u_oldNode = u2nodesMaps[ OLD_NODES ].begin();
1215       u_newNode = u2nodesMaps[ NEW_NODES ].begin();
1216       newEnd    = u2nodesMaps[ NEW_NODES ].end();
1217       u_newOnSeam = u2nodesOnSeam.begin();
1218       if ( mergeNewToOld )
1219         for ( ; u_newNode != newEnd; ++u_newNode, ++u_oldNode )
1220         {
1221           groupsOfNodes.push_back( list< const SMDS_MeshNode* >() );
1222           groupsOfNodes.back().push_back( u_oldNode->second );
1223           groupsOfNodes.back().push_back( u_newNode->second );
1224           if ( mergeSeamToNew )
1225             groupsOfNodes.back().push_back( (u_newOnSeam++)->second );
1226         }
1227       else if ( mergeSeamToNew )
1228         for ( ; u_newNode != newEnd; ++u_newNode, ++u_newOnSeam )
1229         {
1230           groupsOfNodes.push_back( list< const SMDS_MeshNode* >() );
1231           groupsOfNodes.back().push_back( u_newNode->second );
1232           groupsOfNodes.back().push_back( u_newOnSeam->second );
1233         }
1234
1235     } // loop on EDGE and VERTEX submeshes of a target FACE
1236
1237     // Merge
1238
1239     SMESH_MeshEditor editor( tgtMesh );
1240     int nbFaceBeforeMerge = tgtSubMesh->GetSubMeshDS()->NbElements();
1241     editor.MergeNodes( groupsOfNodes );
1242     int nbFaceAtferMerge = tgtSubMesh->GetSubMeshDS()->NbElements();
1243     if ( nbFaceBeforeMerge != nbFaceAtferMerge && !helper.HasDegeneratedEdges() )
1244       return error(COMPERR_BAD_INPUT_MESH, "Probably invalid node parameters on geom faces");
1245
1246     // ----------------------------------------------------------------
1247     // The mapper can't create quadratic elements, so convert if needed
1248     // ----------------------------------------------------------------
1249
1250     faceIt         = srcSubMesh->GetSubMeshDS()->GetElements();
1251     bool srcIsQuad = faceIt->next()->IsQuadratic();
1252     faceIt         = tgtSubMesh->GetSubMeshDS()->GetElements();
1253     bool tgtIsQuad = faceIt->next()->IsQuadratic();
1254     if ( srcIsQuad && !tgtIsQuad )
1255     {
1256       TIDSortedElemSet tgtFaces;
1257       faceIt = tgtSubMesh->GetSubMeshDS()->GetElements();
1258       while ( faceIt->more() )
1259         tgtFaces.insert( tgtFaces.end(), faceIt->next() );
1260
1261       editor.ConvertToQuadratic(/*theForce3d=*/false, tgtFaces, false);
1262     }
1263
1264     cleaner.Release(); // not to remove mesh
1265
1266   } // end of projection using Pattern mapping
1267
1268
1269   // ---------------------------
1270   // Check elements orientation
1271   // ---------------------------
1272
1273   TopoDS_Face face = TopoDS::Face( theShape );
1274   if ( !theMesh.IsMainShape( tgtFace ))
1275   {
1276     // find the main shape
1277     TopoDS_Shape mainShape = meshDS->ShapeToMesh();
1278     switch ( mainShape.ShapeType() ) {
1279     case TopAbs_SHELL:
1280     case TopAbs_SOLID: break;
1281     default:
1282       TopTools_ListIteratorOfListOfShape ancestIt = theMesh.GetAncestors( face );
1283       for ( ; ancestIt.More(); ancestIt.Next() ) {
1284         TopAbs_ShapeEnum type = ancestIt.Value().ShapeType();
1285         if ( type == TopAbs_SOLID ) {
1286           mainShape = ancestIt.Value();
1287           break;
1288         } else if ( type == TopAbs_SHELL ) {
1289           mainShape = ancestIt.Value();
1290         }
1291       }
1292     }
1293     // find tgtFace in the main solid or shell to know it's true orientation.
1294     TopExp_Explorer exp( mainShape, TopAbs_FACE );
1295     for ( ; exp.More(); exp.Next() ) {
1296       if ( tgtFace.IsSame( exp.Current() )) {
1297         face = TopoDS::Face( exp.Current() );
1298         break;
1299       }
1300     }
1301   }
1302   // Fix orientation
1303   if ( helper.IsReversedSubMesh( face ))
1304   {
1305     SMESH_MeshEditor editor( tgtMesh );
1306     SMDS_ElemIteratorPtr eIt = meshDS->MeshElements( face )->GetElements();
1307     while ( eIt->more() ) {
1308       const SMDS_MeshElement* e = eIt->next();
1309       if ( e->GetType() == SMDSAbs_Face && !editor.Reorient( e ))
1310         RETURN_BAD_RESULT("Pb of SMESH_MeshEditor::Reorient()");
1311     }
1312   }
1313
1314   return true;
1315 }
1316
1317
1318 //=======================================================================
1319 //function : Evaluate
1320 //purpose  :
1321 //=======================================================================
1322
1323 bool StdMeshers_Projection_2D::Evaluate(SMESH_Mesh&         theMesh,
1324                                         const TopoDS_Shape& theShape,
1325                                         MapShapeNbElems&    aResMap)
1326 {
1327   if ( !_sourceHypo )
1328     return false;
1329
1330   SMESH_Mesh * srcMesh = _sourceHypo->GetSourceMesh();
1331   SMESH_Mesh * tgtMesh = & theMesh;
1332   if ( !srcMesh )
1333     srcMesh = tgtMesh;
1334
1335   // ---------------------------
1336   // Make sub-shapes association
1337   // ---------------------------
1338
1339   TopoDS_Face tgtFace = TopoDS::Face( theShape.Oriented(TopAbs_FORWARD));
1340   TopoDS_Shape srcShape = _sourceHypo->GetSourceFace().Oriented(TopAbs_FORWARD);
1341
1342   TAssocTool::TShapeShapeMap shape2ShapeMap;
1343   TAssocTool::InitVertexAssociation( _sourceHypo, shape2ShapeMap );
1344   if ( !TAssocTool::FindSubShapeAssociation( tgtFace, tgtMesh, srcShape, srcMesh,
1345                                              shape2ShapeMap)  ||
1346        !shape2ShapeMap.IsBound( tgtFace ))
1347     return error(COMPERR_BAD_SHAPE,"Topology of source and target faces seems different" );
1348
1349   TopoDS_Face srcFace = TopoDS::Face( shape2ShapeMap( tgtFace ).Oriented(TopAbs_FORWARD));
1350
1351   // -------------------------------------------------------
1352   // Assure that mesh on a source Face is computed/evaluated
1353   // -------------------------------------------------------
1354
1355   std::vector<int> aVec;
1356
1357   SMESH_subMesh* srcSubMesh = srcMesh->GetSubMesh( srcFace );
1358   if ( srcSubMesh->IsMeshComputed() )
1359   {
1360     aVec.resize( SMDSEntity_Last, 0 );
1361     aVec[SMDSEntity_Node] = srcSubMesh->GetSubMeshDS()->NbNodes();
1362
1363     SMDS_ElemIteratorPtr elemIt = srcSubMesh->GetSubMeshDS()->GetElements();
1364     while ( elemIt->more() )
1365       aVec[ elemIt->next()->GetEntityType() ]++;
1366   }
1367   else
1368   {
1369     MapShapeNbElems  tmpResMap;
1370     MapShapeNbElems& srcResMap = (srcMesh == tgtMesh) ? aResMap : tmpResMap;
1371     if ( !_gen->Evaluate( *srcMesh, srcShape, srcResMap ))
1372       return error(COMPERR_BAD_INPUT_MESH,"Source mesh not evaluatable");
1373     aVec = srcResMap[ srcSubMesh ];
1374     if ( aVec.empty() )
1375       return error(COMPERR_BAD_INPUT_MESH,"Source mesh is wrongly evaluated");
1376   }
1377
1378   SMESH_subMesh * sm = theMesh.GetSubMesh(theShape);
1379   aResMap.insert(std::make_pair(sm,aVec));
1380
1381   return true;
1382 }
1383
1384
1385 //=============================================================================
1386 /*!
1387  * \brief Sets a default event listener to submesh of the source face
1388   * \param subMesh - submesh where algo is set
1389  *
1390  * This method is called when a submesh gets HYP_OK algo_state.
1391  * After being set, event listener is notified on each event of a submesh.
1392  * Arranges that CLEAN event is translated from source submesh to
1393  * the submesh
1394  */
1395 //=============================================================================
1396
1397 void StdMeshers_Projection_2D::SetEventListener(SMESH_subMesh* subMesh)
1398 {
1399   TAssocTool::SetEventListener( subMesh,
1400                                 _sourceHypo->GetSourceFace(),
1401                                 _sourceHypo->GetSourceMesh() );
1402 }