0031251: Add a new meshing parameter to enforce face linear deflection
[occt.git] / src / MeshTest / MeshTest.cxx
1 // Created on: 1993-09-22
2 // Created by: Didier PIFFAULT
3 // Copyright (c) 1993-1999 Matra Datavision
4 // Copyright (c) 1999-2014 OPEN CASCADE SAS
5 //
6 // This file is part of Open CASCADE Technology software library.
7 //
8 // This library is free software; you can redistribute it and/or modify it under
9 // the terms of the GNU Lesser General Public License version 2.1 as published
10 // by the Free Software Foundation, with special exception defined in the file
11 // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
12 // distribution for complete text of the license and disclaimer of any warranty.
13 //
14 // Alternatively, this file may be used under the terms of Open CASCADE
15 // commercial license or contractual agreement.
16
17 #include <MeshTest.hxx>
18
19 #include <stdio.h>
20
21 #include <Bnd_Box.hxx>
22 #include <BRep_Builder.hxx>
23 #include <BRepAdaptor_Surface.hxx>
24 #include <BRepBndLib.hxx>
25 #include <BRepBuilderAPI_MakeFace.hxx>
26 #include <BRepBuilderAPI_MakePolygon.hxx>
27 #include <BRepBuilderAPI_MakeVertex.hxx>
28 #include <BRepLib.hxx>
29 #include <BRepMesh_IncrementalMesh.hxx>
30 #include <BRepTest.hxx>
31 #include <BRepTools.hxx>
32 #include <CSLib.hxx>
33 #include <DBRep.hxx>
34 #include <Draw_Appli.hxx>
35 #include <Draw_Segment2D.hxx>
36 #include <DrawTrSurf.hxx>
37 #include <GeometryTest.hxx>
38 #include <IMeshData_Status.hxx>
39 #include <Poly_Connect.hxx>
40 #include <TopExp_Explorer.hxx>
41 #include <TopTools_MapIteratorOfMapOfShape.hxx>
42
43 //epa Memory leaks test
44 //OAN: for triepoints
45 #ifdef _WIN32
46 Standard_IMPORT Draw_Viewer dout;
47 #endif
48
49 #define MAX2(X, Y)      (  Abs(X) > Abs(Y)? Abs(X) : Abs(Y) )
50 #define MAX3(X, Y, Z)   ( MAX2 ( MAX2(X,Y) , Z) )
51
52 #define ONETHIRD 0.333333333333333333333333333333333333333333333333333333333333
53 #define TWOTHIRD 0.666666666666666666666666666666666666666666666666666666666666
54
55 #ifdef OCCT_DEBUG_MESH_CHRONO
56 #include <OSD_Chronometer.hxx>
57 Standard_Integer D0Control, D0Internal, D0Unif, D0Edges, NbControls;
58 OSD_Chronometer chTotal, chInternal, chControl, chUnif, chAddPoint;
59 OSD_Chronometer chEdges, chMaillEdges, chEtuInter, chLastControl, chStock;
60 OSD_Chronometer chAdd11, chAdd12, chAdd2, chUpdate, chPointValid;
61 OSD_Chronometer chIsos, chPointsOnIsos;
62 #endif
63
64 //=======================================================================
65 //function : incrementalmesh
66 //purpose  : 
67 //=======================================================================
68 static Standard_Integer incrementalmesh(Draw_Interpretor& di, Standard_Integer nbarg, const char** argv)
69 {
70   if (nbarg < 3)
71   {
72     di << "\
73 Builds triangular mesh for the shape\n\
74 usage: incmesh Shape LinearDeflection [options]\n\
75 options:\n\
76         -a val          angular deflection for edges in deg\n\
77                         (default ~28.64 deg = 0.5 rad)\n\n\
78         -ai val         angular deflection inside of faces in deg\n\
79                         (default ~57.29 deg = 1 rad)\n\n\
80         -di val         Linear deflection used to tessellate the face interior.\n\
81         -min            minimum size parameter limiting size of triangle's\n\
82                         edges to prevent sinking into amplification in case\n\
83                         of distorted curves and surfaces\n\n\
84         -relative       notifies that relative deflection is used\n\
85                         (switched off by default)\n\n\
86         -int_vert_off   disables insertion of internal vertices into mesh\n\
87                         (enabled by default)\n\
88         -surf_def_off   disables control of deflection of mesh from real\n\
89                         surface (enabled by default)\n\
90         -parallel       enables parallel execution (switched off by default)\n\
91         -adjust_min     enables local adjustment of min size depending on edge size (switched off by default)\n\
92         -force_face_def disables usage of shape tolerances for computing face deflection (switched off by default). \n";
93     return 0;
94   }
95
96   TopoDS_Shape aShape = DBRep::Get(argv[1]);
97   if (aShape.IsNull())
98   {
99     di << " Null shapes are not allowed here\n";
100     return 0;
101   }
102
103   IMeshTools_Parameters aMeshParams;
104   aMeshParams.Deflection = aMeshParams.DeflectionInterior = 
105     Max(Draw::Atof(argv[2]), Precision::Confusion());
106
107   if (nbarg > 3)
108   {
109     Standard_Integer i = 3;
110     while (i < nbarg)
111     {
112       TCollection_AsciiString aOpt(argv[i++]);
113       aOpt.LowerCase();
114
115       if (aOpt == "")
116         continue;
117       else if (aOpt == "-relative")
118         aMeshParams.Relative = Standard_True;
119       else if (aOpt == "-parallel")
120         aMeshParams.InParallel = Standard_True;
121       else if (aOpt == "-int_vert_off")
122         aMeshParams.InternalVerticesMode = Standard_False;
123       else if (aOpt == "-surf_def_off")
124         aMeshParams.ControlSurfaceDeflection = Standard_False;
125       else if (aOpt == "-adjust_min")
126         aMeshParams.AdjustMinSize = Standard_True;
127       else if (aOpt == "-force_face_def")
128         aMeshParams.ForceFaceDeflection = Standard_True;
129       else if (i < nbarg)
130       {
131         Standard_Real aVal = Draw::Atof(argv[i++]);
132         if (aOpt == "-a")
133         {
134           aMeshParams.Angle = aVal * M_PI / 180.;
135         }
136         else if (aOpt == "-ai")
137         {
138           aMeshParams.AngleInterior = aVal * M_PI / 180.;
139         }
140         else if (aOpt == "-min")
141           aMeshParams.MinSize = aVal;
142         else if (aOpt == "-di")
143         {
144           aMeshParams.DeflectionInterior = aVal;
145         }
146         else
147           --i;
148       }
149     }
150   }
151
152   di << "Incremental Mesh, multi-threading "
153      << (aMeshParams.InParallel ? "ON" : "OFF") << "\n";
154
155   BRepMesh_IncrementalMesh aMesher (aShape, aMeshParams);
156
157   di << "Meshing statuses: ";
158   const Standard_Integer aStatus = aMesher.GetStatusFlags();
159   if (!aStatus)
160   {
161     di << "NoError";
162   }
163   else
164   {
165     Standard_Integer i;
166     for (i = 0; i < 8; i++)
167     {
168       Standard_Integer aFlag = aStatus & (1 << i);
169       if (aFlag)
170       {
171         switch ((IMeshData_Status) aFlag)
172         {
173         case IMeshData_OpenWire:
174           di << "OpenWire ";
175           break;
176         case IMeshData_SelfIntersectingWire:
177           di << "SelfIntersectingWire ";
178           break;
179         case IMeshData_Failure:
180           di << "Failure ";
181           break;
182         case IMeshData_ReMesh:
183           di << "ReMesh ";
184           break;
185         case IMeshData_UnorientedWire:
186           di << "UnorientedWire ";
187           break;
188         case IMeshData_TooFewPoints:
189           di << "TooFewPoints ";
190           break;
191         case IMeshData_Outdated:
192           di << "Outdated ";
193           break;
194         case IMeshData_Reused:
195           di << "Reused ";
196           break;
197         case IMeshData_NoError:
198         default:
199           break;
200         }
201       }
202     }
203   }
204
205   return 0;
206 }
207
208 //=======================================================================
209 //function : tessellate
210 //purpose  : 
211 //=======================================================================
212 static Standard_Integer tessellate (Draw_Interpretor& /*di*/, Standard_Integer nbarg, const char** argv)
213 {
214   if (nbarg != 5)
215   {
216     std::cerr << "Builds regular triangulation with specified number of triangles\n"
217                  "    Usage: tessellate result {surface|face} nbu nbv\n"
218                  "    Triangulation is put into the face with natural bounds (result);\n"
219                  "    it will have 2*nbu*nbv triangles and (nbu+1)*(nbv+1) nodes";
220     return 1;
221   }
222
223   const char *aResName = argv[1];
224   const char *aSrcName = argv[2];
225   int aNbU = Draw::Atoi (argv[3]);
226   int aNbV = Draw::Atoi (argv[4]);
227
228   if (aNbU <= 0 || aNbV <= 0)
229   {
230     std::cerr << "Error: Arguments nbu and nbv must be both greater than 0\n";
231     return 1;
232   }
233
234   Handle(Geom_Surface) aSurf = DrawTrSurf::GetSurface(aSrcName);
235   double aUMin, aUMax, aVMin, aVMax;
236   if (! aSurf.IsNull())
237   {
238     aSurf->Bounds (aUMin, aUMax, aVMin, aVMax);
239   }
240   else
241   {
242     TopoDS_Shape aShape = DBRep::Get(aSrcName);
243     if (aShape.IsNull() || aShape.ShapeType() != TopAbs_FACE)
244     {
245       std::cerr << "Error: " << aSrcName << " is not a face\n";
246       return 1;
247     }
248     TopoDS_Face aFace = TopoDS::Face (aShape);
249     aSurf = BRep_Tool::Surface (aFace);
250     if (aSurf.IsNull())
251     {
252       std::cerr << "Error: Face " << aSrcName << " has no surface\n";
253       return 1;
254     }
255
256     BRepTools::UVBounds (aFace, aUMin, aUMax, aVMin, aVMax);
257   }
258   if (Precision::IsInfinite (aUMin) || Precision::IsInfinite (aUMax) || 
259       Precision::IsInfinite (aVMin) || Precision::IsInfinite (aVMax))
260   {
261     std::cerr << "Error: surface has infinite parametric range, aborting\n";
262     return 1;
263   }
264
265   BRepBuilderAPI_MakeFace aFaceMaker (aSurf, aUMin, aUMax, aVMin, aVMax, Precision::Confusion());
266   if (! aFaceMaker.IsDone())
267   {
268     std::cerr << "Error: cannot build face with natural bounds, aborting\n";
269     return 1;
270   }
271   TopoDS_Face aFace = aFaceMaker;
272
273   // create triangulation
274   int aNbNodes = (aNbU + 1) * (aNbV + 1);
275   int aNbTriangles = 2 * aNbU * aNbV;
276   Handle(Poly_Triangulation) aTriangulation =
277     new Poly_Triangulation (aNbNodes, aNbTriangles, Standard_False);
278
279   // fill nodes
280   TColgp_Array1OfPnt &aNodes = aTriangulation->ChangeNodes();
281   GeomAdaptor_Surface anAdSurf (aSurf);
282   double aDU = (aUMax - aUMin) / aNbU;
283   double aDV = (aVMax - aVMin) / aNbV;
284   for (int iU = 0, iShift = 1; iU <= aNbU; iU++, iShift += aNbV + 1)
285   {
286     double aU = aUMin + iU * aDU;
287     for (int iV = 0; iV <= aNbV; iV++)
288     {
289       double aV = aVMin + iV * aDV;
290       gp_Pnt aP = anAdSurf.Value (aU, aV);
291       aNodes.SetValue (iShift + iV, aP);
292     }
293   }
294
295   // fill triangles
296   Poly_Array1OfTriangle &aTriangles = aTriangulation->ChangeTriangles();
297   for (int iU = 0, iShift = 1, iTri = 0; iU < aNbU; iU++, iShift += aNbV + 1)
298   {
299     for (int iV = 0; iV < aNbV; iV++)
300     {
301       int iBase = iShift + iV;
302       Poly_Triangle aTri1 (iBase, iBase + aNbV + 2, iBase + 1);
303       Poly_Triangle aTri2 (iBase, iBase + aNbV + 1, iBase + aNbV + 2);
304       aTriangles.SetValue (++iTri, aTri1);
305       aTriangles.SetValue (++iTri, aTri2);
306     }
307   }
308
309   // put triangulation to face
310   BRep_Builder B;
311   B.UpdateFace (aFace, aTriangulation);
312
313   // fill edge polygons
314   TColStd_Array1OfInteger aUMinIso (1, aNbV + 1), aUMaxIso (1, aNbV + 1);
315   for (int iV = 0; iV <= aNbV; iV++)
316   {
317     aUMinIso.SetValue (1 + iV, 1 + iV);
318     aUMaxIso.SetValue (1 + iV, 1 + iV + aNbU * (1 + aNbV));
319   }
320   TColStd_Array1OfInteger aVMinIso (1, aNbU + 1), aVMaxIso (1, aNbU + 1);
321   for (int iU = 0; iU <= aNbU; iU++)
322   {
323     aVMinIso.SetValue (1 + iU,  1 + iU  * (1 + aNbV));
324     aVMaxIso.SetValue (1 + iU, (1 + iU) * (1 + aNbV));
325   }
326   Handle(Poly_PolygonOnTriangulation) aUMinPoly = new Poly_PolygonOnTriangulation (aUMinIso);
327   Handle(Poly_PolygonOnTriangulation) aUMaxPoly = new Poly_PolygonOnTriangulation (aUMaxIso);
328   Handle(Poly_PolygonOnTriangulation) aVMinPoly = new Poly_PolygonOnTriangulation (aVMinIso);
329   Handle(Poly_PolygonOnTriangulation) aVMaxPoly = new Poly_PolygonOnTriangulation (aVMaxIso);
330   for (TopExp_Explorer exp (aFace, TopAbs_EDGE); exp.More(); exp.Next())
331   {
332     TopoDS_Edge anEdge = TopoDS::Edge (exp.Current());
333     Standard_Real aFirst, aLast;
334     Handle(Geom2d_Curve) aC = BRep_Tool::CurveOnSurface (anEdge, aFace, aFirst, aLast);
335     gp_Pnt2d aPFirst = aC->Value (aFirst);
336     gp_Pnt2d aPLast  = aC->Value (aLast);
337     if (Abs (aPFirst.X() - aPLast.X()) < 0.1 * (aUMax - aUMin)) // U=const
338     {
339       if (BRep_Tool::IsClosed (anEdge, aFace))
340         B.UpdateEdge (anEdge, aUMinPoly, aUMaxPoly, aTriangulation);
341       else
342         B.UpdateEdge (anEdge, (aPFirst.X() < 0.5 * (aUMin + aUMax) ? aUMinPoly : aUMaxPoly), aTriangulation);
343     }
344     else // V=const
345     {
346       if (BRep_Tool::IsClosed (anEdge, aFace))
347         B.UpdateEdge (anEdge, aVMinPoly, aVMaxPoly, aTriangulation);
348       else
349         B.UpdateEdge (anEdge, (aPFirst.Y() < 0.5 * (aVMin + aVMax) ? aVMinPoly : aVMaxPoly), aTriangulation);
350     }
351   }
352
353   DBRep::Set (aResName, aFace);
354   return 0;
355 }
356
357 //=======================================================================
358 //function : MemLeakTest
359 //purpose  : 
360 //=======================================================================
361 static Standard_Integer MemLeakTest(Draw_Interpretor&, Standard_Integer /*nbarg*/, const char** /*argv*/)
362 {
363   for(int i=0;i<10000;i++)
364   {
365     BRepBuilderAPI_MakePolygon w(gp_Pnt(0,0,0),gp_Pnt(0,100,0),gp_Pnt(20,100,0),gp_Pnt(20,0,0));
366     w.Close();     
367     TopoDS_Wire wireShape( w.Wire());
368     BRepBuilderAPI_MakeFace faceBuilder(wireShape);          
369     TopoDS_Face f( faceBuilder.Face());
370     BRepMesh_IncrementalMesh im(f,1);
371     BRepTools::Clean(f);      
372   }
373   return 0;
374 }
375
376 //=======================================================================
377 //function : trianglesinfo
378 //purpose  : 
379 //=======================================================================
380 static Standard_Integer trianglesinfo(Draw_Interpretor& di, Standard_Integer n, const char** a)
381 {
382   if (n != 2) return 1;
383   TopoDS_Shape S = DBRep::Get(a[1]);
384   if (S.IsNull()) return 1;
385   TopExp_Explorer ex;
386   Handle(Poly_Triangulation) T;
387   TopLoc_Location L;
388
389   Standard_Real MaxDeflection = 0.0;
390   Standard_Integer nbtriangles = 0, nbnodes = 0;
391   for (ex.Init(S, TopAbs_FACE); ex.More(); ex.Next()) {
392     TopoDS_Face F = TopoDS::Face(ex.Current());
393     T = BRep_Tool::Triangulation(F, L);
394     if (!T.IsNull()) {
395       nbtriangles += T->NbTriangles();
396       nbnodes += T->NbNodes();
397       if (T->Deflection() > MaxDeflection)
398         MaxDeflection = T->Deflection();
399     }
400   }
401
402   di<<"\n";
403   di<<"This shape contains " <<nbtriangles<<" triangles.\n";
404   di<<"                    " <<nbnodes    <<" nodes.\n";
405   di<<"Maximal deflection " <<MaxDeflection<<"\n";
406   di<<"\n";
407 #ifdef OCCT_DEBUG_MESH_CHRONO
408   Standard_Real tot, addp, unif, contr, inter;
409   Standard_Real edges, mailledges, etuinter, lastcontrol, stock;
410   Standard_Real add11, add12, add2, upda, pointvalid;
411   Standard_Real isos, pointsisos;
412   chTotal.Show(tot); chAddPoint.Show(addp); chUnif.Show(unif); 
413   chControl.Show(contr); chInternal.Show(inter);
414   chEdges.Show(edges); chMaillEdges.Show(mailledges);
415   chEtuInter.Show(etuinter); chLastControl.Show(lastcontrol); 
416   chStock.Show(stock);
417   chAdd11.Show(add11); chAdd12.Show(add12); chAdd2.Show(add2); chUpdate.Show(upda);
418   chPointValid.Show(pointvalid); chIsos.Show(isos); chPointsOnIsos.Show(pointsisos);
419
420   if (tot > 0.00001) {
421     di <<"temps total de maillage:     "<<tot        <<" seconds\n";
422     di <<"dont: \n";
423     di <<"discretisation des edges:    "<<edges      <<" seconds---> "<< 100*edges/tot      <<" %\n";
424     di <<"maillage des edges:          "<<mailledges <<" seconds---> "<< 100*mailledges/tot <<" %\n";
425     di <<"controle et points internes: "<<etuinter   <<" seconds---> "<< 100*etuinter/tot   <<" %\n";
426     di <<"derniers controles:          "<<lastcontrol<<" seconds---> "<< 100*lastcontrol/tot<<" %\n";
427     di <<"stockage dans la S.D.        "<<stock      <<" seconds---> "<< 100*stock/tot      <<" %\n";
428     di << "\n";
429     di <<"et plus precisement: \n";
430     di <<"Add 11ere partie :           "<<add11     <<" seconds---> "<<100*add11/tot      <<" %\n";
431     di <<"Add 12ere partie :           "<<add12     <<" seconds---> "<<100*add12/tot      <<" %\n";
432     di <<"Add 2eme partie :            "<<add2      <<" seconds---> "<<100*add2/tot       <<" %\n";
433     di <<"Update :                     "<<upda      <<" seconds---> "<<100*upda/tot       <<" %\n";
434     di <<"AddPoint :                   "<<addp      <<" seconds---> "<<100*addp/tot       <<" %\n";
435     di <<"UniformDeflection            "<<unif      <<" seconds---> "<<100*unif/tot       <<" %\n";
436     di <<"Controle :                   "<<contr     <<" seconds---> "<<100*contr/tot      <<" %\n";
437     di <<"Points Internes:             "<<inter     <<" seconds---> "<<100*inter/tot      <<" %\n";
438     di <<"calcul des isos et du, dv:   "<<isos      <<" seconds---> "<<100*isos/tot       <<" %\n";
439     di <<"calcul des points sur isos:  "<<pointsisos<<" seconds---> "<<100*pointsisos/tot <<" %\n";
440     di <<"IsPointValid:                "<<pointvalid<<" seconds---> "<<100*pointvalid/tot <<" %\n";
441     di << "\n";
442
443
444     di <<"nombre d'appels de controle apres points internes          : "<< NbControls << "\n";
445     di <<"nombre de points sur restrictions                          : "<< D0Edges    << "\n";
446     di <<"nombre de points calcules par UniformDeflection            : "<< D0Unif     << "\n";
447     di <<"nombre de points calcules dans InternalVertices            : "<< D0Internal << "\n";
448     di <<"nombre de points calcules dans Control                     : "<< D0Control  << "\n";
449     if (nbnodes-D0Edges != 0) { 
450       Standard_Real ratio = (Standard_Real)(D0Internal+D0Control)/ (Standard_Real)(nbnodes-D0Edges);
451       di <<"---> Ratio: (D0Internal+D0Control) / (nbNodes-nbOnEdges)   : "<< ratio      << "\n";
452     }
453
454     di << "\n";
455
456     chTotal.Reset(); chAddPoint.Reset(); chUnif.Reset(); 
457     chControl.Reset(); chInternal.Reset();
458     chEdges.Reset(); chMaillEdges.Reset();
459     chEtuInter.Reset(); chLastControl.Reset(); 
460     chStock.Reset();
461     chAdd11.Reset(); chAdd12.Reset(); chAdd2.Reset(); chUpdate.Reset();
462     chPointValid.Reset(); chIsos.Reset(); chPointsOnIsos.Reset();
463
464   }
465 #endif
466   return 0;
467 }
468
469 //=======================================================================
470 //function : veriftriangles
471 //purpose  : 
472 //=======================================================================
473 static Standard_Integer veriftriangles(Draw_Interpretor& di, Standard_Integer n, const char** a)
474 {
475   if (n < 2) return 1;
476   Standard_Boolean quiet = 1;
477   if (n == 3) quiet = 0;
478   TopoDS_Shape Sh = DBRep::Get(a[1]);
479   if (Sh.IsNull()) return 1;
480   TopExp_Explorer ex;
481   Handle(Poly_Triangulation) T;
482   TopLoc_Location L;
483   Standard_Integer i, n1, n2, n3;
484   gp_Pnt2d mitri, v1, v2, v3, mi2d1, mi2d2, mi2d3;
485   gp_XYZ vecEd1, vecEd2, vecEd3;
486   //  Standard_Real dipo, dm, dv, d1, d2, d3, defle;
487   Standard_Real dipo, dv, d1, d2, d3, defle;
488   Handle(Geom_Surface) S;
489   Standard_Integer nbface = 0;
490   gp_Pnt PP;
491
492   for (ex.Init(Sh, TopAbs_FACE); ex.More(); ex.Next()) {
493     TopoDS_Face F = TopoDS::Face(ex.Current());
494     nbface++;
495     T = BRep_Tool::Triangulation(F, L);
496     Standard_Real deflemax = 0, deflemin = 1.e100;
497     if (!T.IsNull()) {
498       Standard_Real defstock = T->Deflection();
499       const Poly_Array1OfTriangle& triangles  = T->Triangles();
500       const TColgp_Array1OfPnt2d&  Nodes2d    = T->UVNodes();
501       const TColgp_Array1OfPnt&    Nodes      = T->Nodes();
502
503       S = BRep_Tool::Surface(F, L);
504
505       for(i = 1; i <= triangles.Length(); i++) {
506         if (F.Orientation() == TopAbs_REVERSED) 
507           triangles(i).Get(n1,n3,n2);
508         else 
509           triangles(i).Get(n1,n2,n3);
510
511         const gp_XY& xy1 = Nodes2d(n1).XY();
512         const gp_XY& xy2 = Nodes2d(n2).XY();
513         const gp_XY& xy3 = Nodes2d(n3).XY();
514
515         mi2d1.SetCoord((xy2.X()+xy3.X())*0.5, 
516           (xy2.Y()+xy3.Y())*0.5);
517         mi2d2.SetCoord((xy1.X()+xy3.X())*0.5, 
518           (xy1.Y()+xy3.Y())*0.5);
519         mi2d3.SetCoord((xy1.X()+xy2.X())*0.5, 
520           (xy1.Y()+xy2.Y())*0.5);
521
522         gp_XYZ p1 = Nodes(n1).Transformed(L.Transformation()).XYZ();
523         gp_XYZ p2 = Nodes(n2).Transformed(L.Transformation()).XYZ();
524         gp_XYZ p3 = Nodes(n3).Transformed(L.Transformation()).XYZ();
525
526         vecEd1=p2-p1;
527         vecEd2=p3-p2;
528         vecEd3=p1-p3;
529         d1=vecEd1.SquareModulus();
530         d2=vecEd2.SquareModulus();
531         d3=vecEd3.SquareModulus();
532
533         if (d1!=0. && d2!=0. && d3!=0.) {
534           gp_XYZ equa(vecEd1^vecEd2);
535           dv=equa.Modulus();
536           if (dv>0.) {
537             equa.SetCoord(equa.X()/dv, equa.Y()/dv, equa.Z()/dv);
538             dipo=equa*p1;
539
540
541             mitri.SetCoord(ONETHIRD*(xy1.X()+xy2.X()+xy3.X()),
542               ONETHIRD*(xy1.Y()+xy2.Y()+xy3.Y()));
543             v1.SetCoord(ONETHIRD*mi2d1.X()+TWOTHIRD*xy1.X(), 
544               ONETHIRD*mi2d1.Y()+TWOTHIRD*xy1.Y());
545             v2.SetCoord(ONETHIRD*mi2d2.X()+TWOTHIRD*xy2.X(), 
546               ONETHIRD*mi2d2.Y()+TWOTHIRD*xy2.Y());
547             v3.SetCoord(ONETHIRD*mi2d3.X()+TWOTHIRD*xy3.X(), 
548               ONETHIRD*mi2d3.Y()+TWOTHIRD*xy3.Y());
549
550             S->D0(mi2d1.X(), mi2d1.Y(), PP);
551             PP = PP.Transformed(L.Transformation());
552             defle = Abs((equa*PP.XYZ())-dipo);
553             deflemax = Max(deflemax, defle);
554             deflemin = Min(deflemin, defle);
555
556             S->D0(mi2d2.X(), mi2d2.Y(), PP);
557             PP = PP.Transformed(L.Transformation());
558             defle = Abs((equa*PP.XYZ())-dipo);
559             deflemax = Max(deflemax, defle);
560             deflemin = Min(deflemin, defle);
561
562             S->D0(mi2d3.X(), mi2d3.Y(), PP);
563             PP = PP.Transformed(L.Transformation());
564             defle = Abs((equa*PP.XYZ())-dipo);
565             deflemax = Max(deflemax, defle);
566             deflemin = Min(deflemin, defle);
567
568             S->D0(v1.X(), v1.Y(), PP);
569             PP = PP.Transformed(L.Transformation());
570             defle = Abs((equa*PP.XYZ())-dipo);
571             deflemax = Max(deflemax, defle);
572             deflemin = Min(deflemin, defle);
573
574             S->D0(v2.X(), v2.Y(), PP);
575             PP = PP.Transformed(L.Transformation());
576             defle = Abs((equa*PP.XYZ())-dipo);
577             deflemax = Max(deflemax, defle);
578             deflemin = Min(deflemin, defle);
579
580             S->D0(v3.X(), v3.Y(), PP);
581             PP = PP.Transformed(L.Transformation());
582             defle = Abs((equa*PP.XYZ())-dipo);
583             deflemax = Max(deflemax, defle);
584             deflemin = Min(deflemin, defle);
585
586             S->D0(mitri.X(), mitri.Y(), PP);
587             PP = PP.Transformed(L.Transformation());
588             defle = Abs((equa*PP.XYZ())-dipo);
589             deflemax = Max(deflemax, defle);
590             deflemin = Min(deflemin, defle);
591
592             if (defle > defstock) {
593               di <<"face "<< nbface <<" deflection = " << defle <<" pour "<<defstock <<" stockee.\n";
594             }
595           }
596         }
597       }
598       if (!quiet) {
599         di <<"face "<< nbface<<", deflemin = "<< deflemin<<", deflemax = "<<deflemax<<"\n";
600       }
601
602     }
603   }
604
605
606   return 0;
607 }
608
609 //=======================================================================
610 //function : tri2d
611 //purpose  : 
612 //=======================================================================
613 static Standard_Integer tri2d(Draw_Interpretor&, Standard_Integer n, const char** a)
614 {
615
616   if (n != 2) return 1;
617   TopoDS_Shape aLocalShape = DBRep::Get(a[1]);
618   TopoDS_Face F = TopoDS::Face(aLocalShape);
619   //  TopoDS_Face F = TopoDS::Face(DBRep::Get(a[1]));
620   if (F.IsNull()) return 1;
621   Handle(Poly_Triangulation) T;
622   TopLoc_Location L;
623
624   T = BRep_Tool::Triangulation(F, L);
625   if (!T.IsNull()) {
626     // Build the connect tool
627     Poly_Connect pc(T);
628
629     Standard_Integer i,j, nFree, nInternal, nbTriangles = T->NbTriangles();
630     Standard_Integer t[3];
631
632     // count the free edges
633     nFree = 0;
634     for (i = 1; i <= nbTriangles; i++) {
635       pc.Triangles(i,t[0],t[1],t[2]);
636       for (j = 0; j < 3; j++)
637         if (t[j] == 0) nFree++;
638     }
639
640     // allocate the arrays
641     TColStd_Array1OfInteger Free(1,2*nFree);
642     nInternal = (3*nbTriangles - nFree) / 2;
643     TColStd_Array1OfInteger Internal(0,2*nInternal);
644
645     Standard_Integer fr = 1, in = 1;
646     const Poly_Array1OfTriangle& triangles = T->Triangles();
647     Standard_Integer nodes[3];
648     for (i = 1; i <= nbTriangles; i++) {
649       pc.Triangles(i,t[0],t[1],t[2]);
650       triangles(i).Get(nodes[0],nodes[1],nodes[2]);
651       for (j = 0; j < 3; j++) {
652         Standard_Integer k = (j+1) % 3;
653         if (t[j] == 0) {
654           Free(fr)   = nodes[j];
655           Free(fr+1) = nodes[k];
656           fr += 2;
657         }
658         // internal edge if this triangle has a lower index than the adjacent
659         else if (i < t[j]) {
660           Internal(in)   = nodes[j];
661           Internal(in+1) = nodes[k];
662           in += 2;
663         }
664       }
665     }
666
667     // Display the edges
668     if (T->HasUVNodes()) {
669       const TColgp_Array1OfPnt2d& Nodes2d = T->UVNodes();
670
671       Handle(Draw_Segment2D) Seg;
672
673       // free edges
674       Standard_Integer nn;
675       nn = Free.Length() / 2;
676       for (i = 1; i <= nn; i++) {
677         Seg = new Draw_Segment2D(Nodes2d(Free(2*i-1)),
678           Nodes2d(Free(2*i)),
679           Draw_rouge);
680         dout << Seg;
681       }
682
683       // internal edges
684
685       nn = nInternal;
686       for (i = 1; i <= nn; i++) {
687         Seg = new Draw_Segment2D(Nodes2d(Internal(2*i-1)),
688           Nodes2d(Internal(2*i)),
689           Draw_bleu);
690         dout << Seg;
691       }
692     }
693     dout.Flush();
694   }
695
696   return 0;
697 }
698
699 //=======================================================================
700 //function : wavefront
701 //purpose  : 
702 //=======================================================================
703 static Standard_Integer wavefront(Draw_Interpretor&, Standard_Integer nbarg, const char** argv)
704 {
705   if (nbarg < 2) return 1;
706
707   TopoDS_Shape S = DBRep::Get(argv[1]);
708   if (S.IsNull()) return 1;
709
710   // creation du maillage s'il n'existe pas.
711
712   Bnd_Box B;
713   Standard_Real aXmin, aYmin, aZmin, aXmax, aYmax, aZmax;
714   BRepBndLib::Add(S, B);
715   B.Get(aXmin, aYmin, aZmin, aXmax, aYmax, aZmax);
716   Standard_Real aDeflection = 
717     MAX3( aXmax-aXmin , aYmax-aYmin , aZmax-aZmin) * 0.004;
718
719   BRepMesh_IncrementalMesh aMesh (S, aDeflection);
720
721
722   TopLoc_Location L;
723   TopExp_Explorer ex;
724
725   Standard_Integer i, nbface = 0;
726   Standard_Boolean OK = Standard_True;
727   gp_Vec D1U,D1V;
728   gp_Vec D2U,D2V,D2UV;
729   gp_Dir Nor;
730   gp_Pnt P;
731   Standard_Real U, V;
732   CSLib_DerivativeStatus aStatus;
733   CSLib_NormalStatus NStat;
734   Standard_Real x, y, z;
735   Standard_Integer n1, n2, n3;
736   Standard_Integer k1, k2, k3;
737
738   char ffile[100];
739
740   if (nbarg == 3) {
741     strcpy(ffile, argv[2]);
742     strcat(ffile, ".obj");
743   }
744   else  strcpy(ffile, "wave.obj");
745   FILE* outfile = fopen(ffile, "w");
746
747
748   fprintf(outfile, "%s  %s\n%s %s\n\n", "# CASCADE   ","MATRA DATAVISION", "#", ffile);
749
750   Standard_Integer nbNodes, totalnodes = 0, nbpolygons = 0;
751   for (ex.Init(S, TopAbs_FACE); ex.More(); ex.Next()) {
752     nbface++;
753     TopoDS_Face F = TopoDS::Face(ex.Current());
754     Handle(Poly_Triangulation) Tr = BRep_Tool::Triangulation(F, L);
755
756     if (!Tr.IsNull()) {
757       nbNodes = Tr->NbNodes();
758       const TColgp_Array1OfPnt& Nodes = Tr->Nodes();
759
760       // les noeuds.
761       for (i = 1; i <= nbNodes; i++) {
762         gp_Pnt Pnt = Nodes(i).Transformed(L.Transformation());
763         x = Pnt.X();
764         y = Pnt.Y();
765         z = Pnt.Z();
766         fprintf(outfile, "%s      %f  %f  %f\n", "v", x, y, z);
767       }
768
769       fprintf(outfile, "\n%s    %d\n\n", "# number of vertex", nbNodes);
770
771
772       // les normales.
773
774       if (Tr->HasUVNodes()) {
775         const TColgp_Array1OfPnt2d& UVNodes = Tr->UVNodes();
776         BRepAdaptor_Surface BS(F, Standard_False);
777
778         for (i = 1; i <= nbNodes; i++) {
779           U = UVNodes(i).X();
780           V = UVNodes(i).Y();
781
782           BS.D1(U,V,P,D1U,D1V);
783           CSLib::Normal (D1U, D1V, Precision::Angular(), aStatus, Nor);
784           if (aStatus != CSLib_Done) {
785             BS.D2(U,V,P,D1U,D1V,D2U,D2V,D2UV);
786             CSLib::Normal(D1U,D1V,D2U,D2V,D2UV,Precision::Angular(),OK,NStat,Nor);
787           }
788           if (F.Orientation() == TopAbs_REVERSED) Nor.Reverse();
789
790           fprintf(outfile, "%s      %f  %f  %f\n", "vn", Nor.X(), Nor.Y(), Nor.Z());
791         }
792
793         fprintf(outfile, "\n%s    %d\n\n", "# number of vertex normals", nbNodes);
794       }
795
796       fprintf(outfile, "%s    %d\n", "s", nbface);
797
798       // les triangles.
799       Standard_Integer nbTriangles = Tr->NbTriangles();
800       const Poly_Array1OfTriangle& triangles = Tr->Triangles();
801
802
803       for (i = 1; i <= nbTriangles; i++) {
804         if (F.Orientation()  == TopAbs_REVERSED)
805           triangles(i).Get(n1, n3, n2);
806         else 
807           triangles(i).Get(n1, n2, n3);
808         k1 = n1+totalnodes;
809         k2 = n2+totalnodes;
810         k3 = n3+totalnodes;
811         fprintf(outfile, "f %d%s%d %d%s%d %d%s%d\n", k1,"//", k1, k2,"//", k2, k3,"//", k3);
812       }
813       nbpolygons += nbTriangles;
814       totalnodes += nbNodes;
815
816       fprintf(outfile, "\n%s    %d\n", "# number of smooth groups", nbface);
817       fprintf(outfile, "\n%s    %d\n", "# number of polygons", nbpolygons);
818
819     }
820   }
821
822   fclose(outfile);
823
824   return 0;
825 }
826
827 //=======================================================================
828 //function : triedgepoints
829 //purpose  : 
830 //=======================================================================
831 static Standard_Integer triedgepoints(Draw_Interpretor& di, Standard_Integer nbarg, const char** argv)
832 {
833   if( nbarg < 2 )
834     return 1;
835
836   for( Standard_Integer i = 1; i < nbarg; i++ )
837   {
838     TopoDS_Shape aShape = DBRep::Get(argv[i]);
839     if ( aShape.IsNull() )
840       continue;
841
842     Handle(Poly_PolygonOnTriangulation) aPoly;
843     Handle(Poly_Triangulation)          aT;
844     TopLoc_Location                     aLoc;
845     TopTools_MapOfShape                 anEdgeMap;
846     TopTools_MapIteratorOfMapOfShape    it;
847     
848     if( aShape.ShapeType() == TopAbs_EDGE )
849     {
850       anEdgeMap.Add( aShape );
851     }
852     else
853     {
854       TopExp_Explorer ex(aShape, TopAbs_EDGE);
855       for(; ex.More(); ex.Next() )
856         anEdgeMap.Add( ex.Current() );
857     }
858
859     if ( anEdgeMap.Extent() == 0 )
860       continue;
861
862     char newname[1024];
863     strcpy(newname,argv[i]);
864     char* p = newname;
865     while (*p != '\0') p++;
866     *p = '_';
867     p++;
868
869     Standard_Integer nbEdge = 1;
870     for(it.Initialize(anEdgeMap); it.More(); it.Next())
871     {
872       BRep_Tool::PolygonOnTriangulation(TopoDS::Edge(it.Key()), aPoly, aT, aLoc);
873       if ( aT.IsNull() || aPoly.IsNull() )
874         continue;
875       
876       const TColgp_Array1OfPnt&      Nodes   = aT->Nodes();
877       const TColStd_Array1OfInteger& Indices = aPoly->Nodes();
878       const Standard_Integer         nbnodes = Indices.Length();
879
880       for( Standard_Integer j = 1; j <= nbnodes; j++ )
881       {
882         gp_Pnt P3d = Nodes(Indices(j));
883         if( !aLoc.IsIdentity() )
884           P3d.Transform(aLoc.Transformation());
885
886         if( anEdgeMap.Extent() > 1 )
887           Sprintf(p,"%d_%d",nbEdge,j);
888         else
889           Sprintf(p,"%d",j);
890               DBRep::Set( newname, BRepBuilderAPI_MakeVertex(P3d) );
891               di.AppendElement(newname);
892       }
893       nbEdge++;
894     }
895   }
896   return 0;
897 }
898
899 //=======================================================================
900 //function : correctnormals
901 //purpose  : Corrects normals in shape triangulation nodes (...)
902 //=======================================================================
903 static Standard_Integer correctnormals(Draw_Interpretor& theDI,
904                                        Standard_Integer /*theNArg*/,
905                                        const char** theArgVal)
906 {
907   TopoDS_Shape S = DBRep::Get(theArgVal[1]);
908
909   //Use "correctnormals shape"
910
911   
912   if(!BRepLib::EnsureNormalConsistency(S))
913   {
914     theDI << "Normals have not been changed!\n";
915   }
916   else
917   {
918     theDI << "Some corrections in source shape have been made!\n";
919   }
920
921   return 0;
922 }
923
924 //=======================================================================
925 void  MeshTest::Commands(Draw_Interpretor& theCommands)
926 //=======================================================================
927 {
928   Draw::Commands(theCommands);
929   BRepTest::AllCommands(theCommands);
930   GeometryTest::AllCommands(theCommands);
931   MeshTest::PluginCommands(theCommands);
932   const char* g;
933
934   g = "Mesh Commands";
935
936   theCommands.Add("incmesh","Builds triangular mesh for the shape, run w/o args for help",__FILE__, incrementalmesh, g);
937   theCommands.Add("tessellate","Builds triangular mesh for the surface, run w/o args for help",__FILE__, tessellate, g);
938   theCommands.Add("MemLeakTest","MemLeakTest",__FILE__, MemLeakTest, g);
939
940   theCommands.Add("tri2d", "tri2d facename",__FILE__, tri2d, g);
941   theCommands.Add("trinfo","trinfo name, print triangles information on objects",__FILE__,trianglesinfo,g);
942   theCommands.Add("veriftriangles","veriftriangles name, verif triangles",__FILE__,veriftriangles,g);
943   theCommands.Add("wavefront","wavefront name",__FILE__, wavefront, g);
944   theCommands.Add("triepoints", "triepoints shape1 [shape2 ...]",__FILE__, triedgepoints, g);
945
946   theCommands.Add("correctnormals", "correctnormals shape",__FILE__, correctnormals, g);
947 }