1 // SMESH SMESH : implementaion of SMESH idl descriptions
3 // Copyright (C) 2003 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.opencascade.org/SALOME/ or email : webmaster.salome@opencascade.org
24 // File : SMESH_MEFISTO_2D.cxx
25 // Author : Paul RASCLE, EDF
30 #include "SMESH_MEFISTO_2D.hxx"
31 #include "SMESH_Gen.hxx"
32 #include "SMESH_Mesh.hxx"
34 #include "SMESH_MaxElementArea.hxx"
35 #include "SMESH_LengthFromEdges.hxx"
40 #include "SMDS_MeshElement.hxx"
41 #include "SMDS_MeshNode.hxx"
42 #include "SMDS_EdgePosition.hxx"
43 #include "SMDS_FacePosition.hxx"
45 #include "utilities.h"
47 #include <TopoDS_Face.hxx>
48 #include <TopoDS_Edge.hxx>
49 #include <TopoDS_Shape.hxx>
50 #include <Geom_Surface.hxx>
51 #include <GeomAdaptor_Curve.hxx>
52 #include <Geom2d_Curve.hxx>
53 #include <gp_Pnt2d.hxx>
54 #include <BRep_Tool.hxx>
55 #include <BRepTools.hxx>
56 #include <BRepTools_WireExplorer.hxx>
57 #include <GCPnts_AbscissaPoint.hxx>
58 #include <GCPnts_UniformAbscissa.hxx>
59 #include <TColStd_ListIteratorOfListOfInteger.hxx>
64 //=============================================================================
68 //=============================================================================
70 SMESH_MEFISTO_2D::SMESH_MEFISTO_2D(int hypId, int studyId,
71 SMESH_Gen * gen):SMESH_2D_Algo(hypId, studyId, gen)
73 MESSAGE("SMESH_MEFISTO_2D::SMESH_MEFISTO_2D");
75 // _shapeType = TopAbs_FACE;
76 _shapeType = (1 << TopAbs_FACE);
77 _compatibleHypothesis.push_back("MaxElementArea");
78 _compatibleHypothesis.push_back("LengthFromEdges");
82 _hypMaxElementArea = NULL;
83 _hypLengthFromEdges = NULL;
86 //=============================================================================
90 //=============================================================================
92 SMESH_MEFISTO_2D::~SMESH_MEFISTO_2D()
94 MESSAGE("SMESH_MEFISTO_2D::~SMESH_MEFISTO_2D");
97 //=============================================================================
101 //=============================================================================
103 bool SMESH_MEFISTO_2D::CheckHypothesis(SMESH_Mesh & aMesh,
104 const TopoDS_Shape & aShape)
106 //MESSAGE("SMESH_MEFISTO_2D::CheckHypothesis");
108 _hypMaxElementArea = NULL;
109 _hypLengthFromEdges = NULL;
111 list <const SMESHDS_Hypothesis * >::const_iterator itl;
112 const SMESHDS_Hypothesis *theHyp;
114 const list <const SMESHDS_Hypothesis * >&hyps = GetUsedHypothesis(aMesh, aShape);
115 int nbHyp = hyps.size();
116 if (nbHyp != 1) return false;// only one compatible hypothesis allowed
121 string hypName = theHyp->GetName();
122 int hypId = theHyp->GetID();
127 if (hypName == "MaxElementArea")
129 _hypMaxElementArea = static_cast<const SMESH_MaxElementArea *>(theHyp);
130 ASSERT(_hypMaxElementArea);
131 _maxElementArea = _hypMaxElementArea->GetMaxArea();
136 if (hypName == "LengthFromEdges")
138 _hypLengthFromEdges = static_cast<const SMESH_LengthFromEdges *>(theHyp);
139 ASSERT(_hypLengthFromEdges);
148 if (_maxElementArea > 0)
150 _edgeLength = 2 * sqrt(_maxElementArea); // triangles : minorant
154 isOk = (_hypLengthFromEdges != NULL); // **** check mode
157 //SCRUTE(_edgeLength);
158 //SCRUTE(_maxElementArea);
162 //=============================================================================
166 //=============================================================================
168 bool SMESH_MEFISTO_2D::Compute(SMESH_Mesh & aMesh, const TopoDS_Shape & aShape)
170 MESSAGE("SMESH_MEFISTO_2D::Compute");
172 if (_hypLengthFromEdges)
173 _edgeLength = ComputeEdgeElementLength(aMesh, aShape);
176 const SMESHDS_Mesh * meshDS = aMesh.GetMeshDS();
177 SMESH_subMesh *theSubMesh = aMesh.GetSubMesh(aShape);
179 const TopoDS_Face & FF = TopoDS::Face(aShape);
180 bool faceIsForward = (FF.Orientation() == TopAbs_FORWARD);
181 TopoDS_Face F = TopoDS::Face(FF.Oriented(TopAbs_FORWARD));
183 Z nblf; //nombre de lignes fermees (enveloppe en tete)
184 Z *nudslf = NULL; //numero du dernier sommet de chaque ligne fermee
186 Z nbpti = 0; //nombre points internes futurs sommets de la triangulation
195 Z nutysu = 1; // 1: il existe un fonction areteideale_()
196 // Z nutysu=0; // 0: on utilise aretmx
197 R aretmx = _edgeLength; // longueur max aretes future triangulation
200 nblf = NumberOfWires(F);
203 nudslf = new Z[1 + nblf];
208 const TopoDS_Wire OW1 = BRepTools::OuterWire(F);
209 nbpnt += NumberOfPoints(aMesh, OW1);
210 nudslf[iw++] = nbpnt;
213 for (TopExp_Explorer exp(F, TopAbs_WIRE); exp.More(); exp.Next())
215 const TopoDS_Wire & W = TopoDS::Wire(exp.Current());
218 nbpnt += NumberOfPoints(aMesh, W);
219 nudslf[iw++] = nbpnt;
224 uvslf = new R2[nudslf[nblf]];
225 //SCRUTE(nudslf[nblf]);
228 map<int, const SMDS_MeshNode*> mefistoToDS; // correspondence mefisto index--> points IDNodes
229 TopoDS_Wire OW = BRepTools::OuterWire(F);
230 LoadPoints(aMesh, F, OW, uvslf, m, mefistoToDS);
233 for (TopExp_Explorer exp(F, TopAbs_WIRE); exp.More(); exp.Next())
235 const TopoDS_Wire & W = TopoDS::Wire(exp.Current());
238 LoadPoints(aMesh, F, W, uvslf, m, mefistoToDS);
242 // SCRUTE(nudslf[nblf]);
243 // for (int i=0; i<=nblf; i++)
245 // MESSAGE(" -+- " <<i<< " "<< nudslf[i]);
247 // for (int i=0; i<nudslf[nblf]; i++)
249 // MESSAGE(" -+- " <<i<< " "<< uvslf[i]);
255 MESSAGE("MEFISTO triangulation ...");
258 aptrte(nutysu, aretmx,
259 nblf, nudslf, uvslf, nbpti, uvpti, nbst, uvst, nbt, nust, ierr);
263 MESSAGE("... End Triangulation");
266 StoreResult(aMesh, nbst, uvst, nbt, nust, F,
267 faceIsForward, mefistoToDS);
272 MESSAGE("Error in Triangulation");
286 //=============================================================================
290 //=============================================================================
292 void SMESH_MEFISTO_2D::LoadPoints(SMESH_Mesh & aMesh,
293 const TopoDS_Face & FF,
294 const TopoDS_Wire & WW, R2 * uvslf, int &m,
295 map<int, const SMDS_MeshNode*>&mefistoToDS)
297 MESSAGE("SMESH_MEFISTO_2D::LoadPoints");
299 SMDS_Mesh * meshDS = aMesh.GetMeshDS();
303 TopoDS_Face F = TopoDS::Face(FF.Oriented(TopAbs_FORWARD));
304 ComputeScaleOnFace(aMesh, F, scalex, scaley);
306 TopoDS_Wire W = TopoDS::Wire(WW.Oriented(TopAbs_FORWARD));
307 BRepTools_WireExplorer wexp(W, F);
308 for (wexp.Init(W, F); wexp.More(); wexp.Next())
310 const TopoDS_Edge & E = wexp.Current();
312 // --- IDNodes of first and last Vertex
314 TopoDS_Vertex VFirst, VLast;
315 TopExp::Vertices(E, VFirst, VLast); // corresponds to f and l
317 ASSERT(!VFirst.IsNull());
318 SMDS_Iterator<const SMDS_MeshNode *> * lid=
319 aMesh.GetSubMesh(VFirst)->GetSubMeshDS()->GetNodes();
320 const SMDS_MeshNode* idFirst = lid->next();
323 ASSERT(!VLast.IsNull());
324 lid=aMesh.GetSubMesh(VLast)->GetSubMeshDS()->GetNodes();
325 const SMDS_MeshNode* idLast = lid->next();
328 // --- edge internal IDNodes (relies on good order storage, not checked)
330 int nbPoints = aMesh.GetSubMesh(E)->GetSubMeshDS()->NbNodes();
334 Handle(Geom2d_Curve) C2d = BRep_Tool::CurveOnSurface(E, F, f, l);
336 SMDS_Iterator<const SMDS_MeshNode *> * ite=
337 aMesh.GetSubMesh(E)->GetSubMeshDS()->GetNodes();
339 bool isForward = (E.Orientation() == TopAbs_FORWARD);
340 map<double, const SMDS_MeshNode*> params;
344 const SMDS_MeshNode * node = ite->next();
345 const SMDS_EdgePosition* epos
346 = static_cast<const SMDS_EdgePosition*>(node->GetPosition());
347 double param = epos->GetUParameter();
348 params[param] = node;
351 // --- load 2D values into MEFISTO structure,
352 // add IDNodes in mefistoToDS map
354 if (E.Orientation() == TopAbs_FORWARD)
356 gp_Pnt2d p = C2d->Value(f); // first point = Vertex Forward
357 uvslf[m].x = scalex * p.X();
358 uvslf[m].y = scaley * p.Y();
359 mefistoToDS[m + 1] = idFirst;
360 //MESSAGE(" "<<m<<" "<<mefistoToDS[m+1]);
361 //MESSAGE("__ f "<<f<<" "<<uvslf[m].x <<" "<<uvslf[m].y);
363 map<double, const SMDS_MeshNode*>::iterator itp = params.begin();
364 for (int i = 1; i <= nbPoints; i++) // nbPoints internal
366 double param = (*itp).first;
367 gp_Pnt2d p = C2d->Value(param);
368 uvslf[m].x = scalex * p.X();
369 uvslf[m].y = scaley * p.Y();
370 mefistoToDS[m + 1] = (*itp).second;
371 // MESSAGE(" "<<m<<" "<<mefistoToDS[m+1]);
372 // MESSAGE("__ "<<i<<" "<<param<<" "<<uvslf[m].x <<" "<<uvslf[m].y);
379 gp_Pnt2d p = C2d->Value(l); // last point = Vertex Reversed
380 uvslf[m].x = scalex * p.X();
381 uvslf[m].y = scaley * p.Y();
382 mefistoToDS[m + 1] = idLast;
383 // MESSAGE(" "<<m<<" "<<mefistoToDS[m+1]);
384 // MESSAGE("__ l "<<l<<" "<<uvslf[m].x <<" "<<uvslf[m].y);
386 map<double, const SMDS_MeshNode*>::reverse_iterator itp = params.rbegin();
387 for (int i = nbPoints; i >= 1; i--)
389 double param = (*itp).first;
390 gp_Pnt2d p = C2d->Value(param);
391 uvslf[m].x = scalex * p.X();
392 uvslf[m].y = scaley * p.Y();
393 mefistoToDS[m + 1] = (*itp).second;
394 // MESSAGE(" "<<m<<" "<<mefistoToDS[m+1]);
395 // MESSAGE("__ "<<i<<" "<<param<<" "<<uvslf[m].x <<" "<<uvslf[m].y);
403 //=============================================================================
407 //=============================================================================
409 // **** a mettre dans SMESH_Algo ou SMESH_2D_Algo
411 void SMESH_MEFISTO_2D::ComputeScaleOnFace(SMESH_Mesh & aMesh,
412 const TopoDS_Face & aFace, double &scalex, double &scaley)
414 //MESSAGE("SMESH_MEFISTO_2D::ComputeScaleOnFace");
415 TopoDS_Face F = TopoDS::Face(aFace.Oriented(TopAbs_FORWARD));
416 TopoDS_Wire W = BRepTools::OuterWire(F);
418 BRepTools_WireExplorer wexp(W, F);
420 double xmin = 1.e300; // min & max of face 2D parametric coord.
421 double xmax = -1.e300;
422 double ymin = 1.e300;
423 double ymax = -1.e300;
427 for (wexp.Init(W, F); wexp.More(); wexp.Next())
429 const TopoDS_Edge & E = wexp.Current();
431 Handle(Geom2d_Curve) C2d = BRep_Tool::CurveOnSurface(E, F, f, l);
432 for (int i = 0; i <= nbp; i++)
434 double param = f + (double (i) / double (nbp))*(l - f);
435 gp_Pnt2d p = C2d->Value(param);
444 // MESSAGE(" "<< f<<" "<<l<<" "<<param<<" "<<xmin<<" "<<xmax<<" "<<ymin<<" "<<ymax);
451 double xmoy = (xmax + xmin) / 2.;
452 double ymoy = (ymax + ymin) / 2.;
454 Handle(Geom_Surface) S = BRep_Tool::Surface(F); // 3D surface
458 gp_Pnt PX0 = S->Value(xmin, ymoy);
459 gp_Pnt PY0 = S->Value(xmoy, ymin);
460 for (int i = 1; i <= nbp; i++)
462 double x = xmin + (double (i) / double (nbp))*(xmax - xmin);
463 gp_Pnt PX = S->Value(x, ymoy);
464 double y = ymin + (double (i) / double (nbp))*(ymax - ymin);
465 gp_Pnt PY = S->Value(xmoy, y);
466 length_x += PX.Distance(PX0);
467 length_y += PY.Distance(PY0);
468 PX0.SetCoord(PX.X(), PX.Y(), PX.Z());
469 PY0.SetCoord(PY.X(), PY.Y(), PY.Z());
473 scalex = length_x / (xmax - xmin);
474 scaley = length_y / (ymax - ymin);
481 //=============================================================================
485 //=============================================================================
487 void SMESH_MEFISTO_2D::StoreResult(SMESH_Mesh & aMesh,
488 Z nbst, R2 * uvst, Z nbt, Z * nust,
489 const TopoDS_Face & F, bool faceIsForward,
490 map<int, const SMDS_MeshNode*>&mefistoToDS)
494 ComputeScaleOnFace(aMesh, F, scalex, scaley);
496 SMESHDS_Mesh * meshDS = aMesh.GetMeshDS();
499 Handle(Geom_Surface) S = BRep_Tool::Surface(F);
501 for (n = 0; n < nbst; n++)
503 double u = uvst[n][0] / scalex;
504 double v = uvst[n][1] / scaley;
505 gp_Pnt P = S->Value(u, v);
507 if (mefistoToDS.find(n + 1) == mefistoToDS.end())
509 SMDS_MeshNode * node = meshDS->AddNode(P.X(), P.Y(), P.Z());
510 meshDS->SetNodeOnFace(node, F);
512 //MESSAGE(nodeId<<" "<<P.X()<<" "<<P.Y()<<" "<<P.Z());
513 mefistoToDS[n + 1] = node;
514 //MESSAGE(" "<<n<<" "<<mefistoToDS[n+1]);
515 SMDS_FacePosition* fpos
516 = static_cast<SMDS_FacePosition*>(node->GetPosition());
517 fpos->SetUParameter(u);
518 fpos->SetVParameter(v);
525 //SCRUTE(faceIsForward);
526 for (n = 1; n <= nbt; n++)
528 int inode1 = nust[m++];
529 int inode2 = nust[m++];
530 int inode3 = nust[m++];
532 const SMDS_MeshNode *n1, *n2, *n3;
533 n1 = mefistoToDS[inode1];
534 n2 = mefistoToDS[inode2];
535 n3 = mefistoToDS[inode3];
536 //MESSAGE("-- "<<inode1<<" "<<inode2<<" "<<inode3<<" ++ "<<nodeId1<<" "<<nodeId2<<" "<<nodeId3);
538 // triangle points must be in trigonometric order if face is Forward
539 // else they must be put clockwise
541 bool triangleIsWellOriented = faceIsForward;
543 SMDS_MeshElement * elt;
544 if (triangleIsWellOriented)
545 elt = meshDS->AddFace(n1, n2, n3);
547 elt = meshDS->AddFace(n1, n3, n2);
549 meshDS->SetMeshElementOnShape(elt, F);
554 //=============================================================================
558 //=============================================================================
560 double SMESH_MEFISTO_2D::ComputeEdgeElementLength(SMESH_Mesh & aMesh,
561 const TopoDS_Shape & aShape)
563 MESSAGE("SMESH_MEFISTO_2D::ComputeEdgeElementLength");
564 // **** a mettre dans SMESH_2D_Algo ?
566 const TopoDS_Face & FF = TopoDS::Face(aShape);
567 bool faceIsForward = (FF.Orientation() == TopAbs_FORWARD);
568 TopoDS_Face F = TopoDS::Face(FF.Oriented(TopAbs_FORWARD));
570 double meanElementLength = 100;
571 double wireLength = 0;
572 int wireElementsNumber = 0;
573 for (TopExp_Explorer exp(F, TopAbs_WIRE); exp.More(); exp.Next())
575 const TopoDS_Wire & W = TopoDS::Wire(exp.Current());
576 for (TopExp_Explorer expe(W, TopAbs_EDGE); expe.More(); expe.Next())
578 const TopoDS_Edge & E = TopoDS::Edge(expe.Current());
579 int nb = aMesh.GetSubMesh(E)->GetSubMeshDS()->NbNodes();
580 double length = EdgeLength(E);
581 wireLength += length;
582 wireElementsNumber += nb;
585 if (wireElementsNumber)
586 meanElementLength = wireLength / wireElementsNumber;
587 //SCRUTE(meanElementLength);
588 return meanElementLength;
591 //=============================================================================
595 //=============================================================================
597 ostream & SMESH_MEFISTO_2D::SaveTo(ostream & save)
602 //=============================================================================
606 //=============================================================================
608 istream & SMESH_MEFISTO_2D::LoadFrom(istream & load)
610 return load >> (*this);
613 //=============================================================================
617 //=============================================================================
619 ostream & operator <<(ostream & save, SMESH_MEFISTO_2D & hyp)
624 //=============================================================================
628 //=============================================================================
630 istream & operator >>(istream & load, SMESH_MEFISTO_2D & hyp)