Salome HOME
Added 2 new operations:
[modules/geom.git] / src / GEOMImpl / GEOMImpl_PrismDriver.cxx
1 // Copyright (C) 2007-2011  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.
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 #include <GEOMImpl_PrismDriver.hxx>
24
25 #include <GEOMImpl_IPrism.hxx>
26 #include <GEOMImpl_IShapesOperations.hxx>
27 #include <GEOMImpl_IMeasureOperations.hxx>
28 #include <GEOMImpl_GlueDriver.hxx>
29 #include <GEOMImpl_PipeDriver.hxx>
30 #include <GEOMImpl_Types.hxx>
31 #include <GEOM_Function.hxx>
32
33 #include <BRepPrimAPI_MakePrism.hxx>
34 #include <BRepFeat_MakeDPrism.hxx>
35
36 #include <BRep_Builder.hxx>
37 #include <BRepBuilderAPI_MakeEdge.hxx>
38 #include <BRepBuilderAPI_MakeWire.hxx>
39 #include <BRepBuilderAPI_MakeFace.hxx>
40 #include <BRepBuilderAPI_MakeVertex.hxx>
41 #include <BRepBuilderAPI_Sewing.hxx>
42 #include <BRepBuilderAPI_Transform.hxx>
43 #include <BRepCheck_Shell.hxx>
44 #include <BRepClass3d_SolidClassifier.hxx>
45 #include <BRep_Tool.hxx>
46 #include <BRepTools.hxx>
47
48 #include <TopAbs.hxx>
49 #include <TopExp.hxx>
50 #include <TopExp_Explorer.hxx>
51 #include <TopoDS.hxx>
52 #include <TopoDS_Compound.hxx>
53 #include <TopoDS_Edge.hxx>
54 #include <TopoDS_Shape.hxx>
55 #include <TopoDS_Shell.hxx>
56 #include <TopoDS_Solid.hxx>
57 #include <TopoDS_Vertex.hxx>
58 #include <TopTools_HSequenceOfShape.hxx>
59 #include <TopTools_IndexedDataMapOfShapeListOfShape.hxx>
60
61 #include <Precision.hxx>
62 #include <gp_Ax3.hxx>
63 #include <gp_Pnt.hxx>
64 #include <gp_Vec.hxx>
65 #include <gp_Trsf.hxx>
66
67 #include <Standard_Stream.hxx>
68
69 #include <Standard_ConstructionError.hxx>
70
71 #include "utilities.h"
72
73 //=======================================================================
74 //function : GetID
75 //purpose  :
76 //=======================================================================
77 const Standard_GUID& GEOMImpl_PrismDriver::GetID()
78 {
79   static Standard_GUID aPrismDriver("FF1BBB17-5D14-4df2-980B-3A668264EA16");
80   return aPrismDriver;
81 }
82
83
84 //=======================================================================
85 //function : GEOMImpl_PrismDriver
86 //purpose  :
87 //=======================================================================
88 GEOMImpl_PrismDriver::GEOMImpl_PrismDriver()
89 {
90 }
91
92 //=======================================================================
93 //function : Execute
94 //purpose  :
95 //=======================================================================
96 Standard_Integer GEOMImpl_PrismDriver::Execute(TFunction_Logbook& log) const
97 {
98   if (Label().IsNull()) return 0;
99   Handle(GEOM_Function) aFunction = GEOM_Function::GetFunction(Label());
100
101   GEOMImpl_IPrism aCI (aFunction);
102   Standard_Integer aType = aFunction->GetType();
103
104   TopoDS_Shape aShape;
105
106   if (aType == PRISM_BASE_VEC_H || aType == PRISM_BASE_VEC_H_2WAYS) {
107     Handle(GEOM_Function) aRefBase = aCI.GetBase();
108     Handle(GEOM_Function) aRefVector = aCI.GetVector();
109     TopoDS_Shape aShapeBase = aRefBase->GetValue();
110     TopoDS_Shape aShapeVec = aRefVector->GetValue();
111     if (aShapeVec.ShapeType() == TopAbs_EDGE) {
112       TopoDS_Edge anE = TopoDS::Edge(aShapeVec);
113       TopoDS_Vertex V1, V2;
114       TopExp::Vertices(anE, V1, V2, Standard_True);
115       if (!V1.IsNull() && !V2.IsNull()) {
116         gp_Vec aV (BRep_Tool::Pnt(V1), BRep_Tool::Pnt(V2));
117         if (Abs(aCI.GetH()) < Precision::Confusion()) {
118           Standard_ConstructionError::Raise("Absolute value of prism height is too small");
119         }
120         if (aV.Magnitude() > Precision::Confusion()) {
121           aV.Normalize();
122           if (aType != PRISM_BASE_DXDYDZ_2WAYS && aCI.GetScale() > Precision::Confusion()) {
123             aShape = MakeScaledPrism(aShapeBase, aV * aCI.GetH(), aCI.GetScale());
124           }
125           else {
126             if (aType == PRISM_BASE_VEC_H_2WAYS) {
127               gp_Trsf aTrsf;
128               aTrsf.SetTranslation((-aV) * aCI.GetH());
129               BRepBuilderAPI_Transform aTransformation(aShapeBase, aTrsf, Standard_False);
130               aShapeBase = aTransformation.Shape();
131               aCI.SetH(aCI.GetH()*2);
132             }
133             aShape = BRepPrimAPI_MakePrism(aShapeBase, aV * aCI.GetH(), Standard_False).Shape();
134           }
135         }
136       }
137     }
138   } else if (aType == PRISM_BASE_TWO_PNT || aType == PRISM_BASE_TWO_PNT_2WAYS) {
139     Handle(GEOM_Function) aRefBase = aCI.GetBase();
140     Handle(GEOM_Function) aRefPnt1 = aCI.GetFirstPoint();
141     Handle(GEOM_Function) aRefPnt2 = aCI.GetLastPoint();
142     TopoDS_Shape aShapeBase = aRefBase->GetValue();
143     TopoDS_Shape aShapePnt1 = aRefPnt1->GetValue();
144     TopoDS_Shape aShapePnt2 = aRefPnt2->GetValue();
145     if (aShapePnt1.ShapeType() == TopAbs_VERTEX &&
146         aShapePnt2.ShapeType() == TopAbs_VERTEX) {
147       TopoDS_Vertex V1 = TopoDS::Vertex(aShapePnt1);
148       TopoDS_Vertex V2 = TopoDS::Vertex(aShapePnt2);
149       if (!V1.IsNull() && !V2.IsNull()) {
150         gp_Vec aV (BRep_Tool::Pnt(V1), BRep_Tool::Pnt(V2));
151         if (aV.Magnitude() > gp::Resolution()) {
152           if (aType != PRISM_BASE_DXDYDZ_2WAYS && aCI.GetScale() > Precision::Confusion()) {
153             aShape = MakeScaledPrism(aShapeBase, aV, aCI.GetScale());
154           }
155           else {
156             if (aType == PRISM_BASE_TWO_PNT_2WAYS) {
157               gp_Trsf aTrsf;
158               aTrsf.SetTranslation(-aV);
159               BRepBuilderAPI_Transform aTransformation(aShapeBase, aTrsf, Standard_False);
160               aShapeBase = aTransformation.Shape();
161               aV = aV * 2;
162             }
163             aShape = BRepPrimAPI_MakePrism(aShapeBase, aV, Standard_False).Shape();
164           }
165         }
166       }
167     }
168   } else if (aType == PRISM_BASE_DXDYDZ || aType == PRISM_BASE_DXDYDZ_2WAYS) {
169     Handle(GEOM_Function) aRefBase = aCI.GetBase();
170     TopoDS_Shape aShapeBase = aRefBase->GetValue();
171     gp_Vec aV (aCI.GetDX(), aCI.GetDY(), aCI.GetDZ());
172     if (aV.Magnitude() > gp::Resolution()) {
173       if (aType != PRISM_BASE_DXDYDZ_2WAYS && aCI.GetScale() > Precision::Confusion()) {
174         aShape = MakeScaledPrism(aShapeBase, aV, aCI.GetScale());
175       }
176       else {
177         if (aType == PRISM_BASE_DXDYDZ_2WAYS) {
178           gp_Trsf aTrsf;
179           aTrsf.SetTranslation(-aV);
180           BRepBuilderAPI_Transform aTransformation(aShapeBase, aTrsf, Standard_False);
181           aShapeBase = aTransformation.Shape();
182           aV = aV * 2;
183         }
184         aShape = BRepPrimAPI_MakePrism(aShapeBase, aV, Standard_False).Shape();
185       }
186     }
187   }
188   
189   else if (aType == DRAFT_PRISM_FEATURE) {
190     Handle(GEOM_Function) aRefInit = aCI.GetInitShape();
191     Handle(GEOM_Function) aRefBase = aCI.GetBase();   
192     TopoDS_Shape anInitShape = aRefInit->GetValue();        // Initial shape
193     TopoDS_Shape aSketch     = aRefBase->GetValue();  
194     Standard_Real aHeight    = aCI.GetH();                  // Height of the extrusion
195     Standard_Real anAngle    = aCI.GetDraftAngle();         // Draft angle
196     Standard_Boolean isProtrusion = (aCI.GetFuseFlag()==1); 
197     // Flag to know wether the feature is a protrusion (fuse) or a depression (cut)
198     
199     if (anInitShape.ShapeType() == TopAbs_COMPOUND)
200     {
201       TopExp_Explorer anExp(anInitShape, TopAbs_SOLID);
202       int solidCount = 0;
203       for(;anExp.More();anExp.Next())
204       {
205         solidCount++;
206       }
207       if (solidCount == 0)
208       {
209         Standard_ConstructionError::Raise("The input shape is a compound without any solid");
210       }
211       else if (solidCount > 1)
212       {
213         Standard_ConstructionError::Raise("The input shape is a compound with more than one solid");
214       }
215     }
216      
217     TopoDS_Wire aWire = TopoDS_Wire();
218     
219     if (aSketch.ShapeType() == TopAbs_EDGE)
220     {
221       aWire = BRepBuilderAPI_MakeWire(TopoDS::Edge(aSketch));
222     }
223     else if (aSketch.ShapeType() == TopAbs_WIRE)
224     {
225       aWire = TopoDS::Wire(aSketch);
226     }
227     else
228     {
229       Standard_ConstructionError::Raise("The input sketch is neither a wire nor an edge");
230     }
231     
232     if (!aWire.Closed())
233       Standard_ConstructionError::Raise("The wire has to be closed");
234        
235     // history of the Base wire (RefBase)
236     Handle(GEOM_Object) aSuppObj;
237     TDF_LabelSequence aLabelSeq;
238     aRefBase->GetDependency(aLabelSeq);
239     
240     // If the base wire has only one dependency we use it
241     // to determine the right normal of the face which
242     // must be oriented towards outside of the solid (like the support face)
243     if (aLabelSeq.Length()==1)  
244     {
245       TDF_Label anArgumentRefLabel = aLabelSeq.Value(1);
246       aSuppObj = GEOM_Object::GetReferencedObject(anArgumentRefLabel);   
247     }
248     
249     // Construction of the face if the wire hasn't any support face
250     TopoDS_Face aFaceBase = BRepBuilderAPI_MakeFace(aWire);
251  
252     if(!aSuppObj.IsNull())      // If the wire has a support
253     {
254       TopoDS_Shape aSupport = aSuppObj->GetValue();
255       if (aSupport.ShapeType() == TopAbs_FACE)
256       {
257         Handle(Geom_Surface) aSurf = BRep_Tool::Surface(TopoDS::Face(aSupport));
258         TopoDS_Face aTempFace = BRepBuilderAPI_MakeFace(aSurf, aWire);
259         
260         if(aTempFace.Orientation() != TopoDS::Face(aSupport).Orientation())
261         {
262           aFaceBase=TopoDS::Face(aTempFace.Reversed());
263         }
264         else
265           aFaceBase=aTempFace;
266       }
267     }
268     
269     // Invert height and angle if the operation is an extruded cut
270     bool invert = !isProtrusion; 
271     
272     // If the face has a reverse orientation invert for extruded boss operations
273     if(aFaceBase.Orientation() == TopAbs_REVERSED)
274       invert = isProtrusion;
275
276     if(invert)
277     {
278       anAngle = -anAngle;  // Invert angle and height
279       aHeight = -aHeight;
280     }
281     
282     BRepFeat_MakeDPrism thePrism(anInitShape, aFaceBase, TopoDS_Face(),
283                                  anAngle*PI180, isProtrusion, Standard_True); 
284     
285     thePrism.Perform(aHeight);
286     
287     aShape = thePrism.Shape();
288   }
289
290   if (aShape.IsNull()) return 0;
291   
292   
293   if (aType == DRAFT_PRISM_FEATURE)
294   {
295     TopoDS_Shape aRes = aShape;
296     
297     // If the result is a compound with only one solid,
298     // return the solid
299     if (aShape.ShapeType() == TopAbs_COMPOUND)  
300     {
301       TopExp_Explorer anExp(aShape, TopAbs_SOLID);
302       
303       int solidNb = 0;
304       TopoDS_Solid aSolid;
305       
306       for(;anExp.More();anExp.Next())
307       {
308         aSolid = TopoDS::Solid(anExp.Current());
309         solidNb++;
310       }
311       if (solidNb == 1)
312       {
313         aRes = aSolid;
314       } 
315     } 
316     
317     aFunction->SetValue(aRes);
318   }
319   else
320   {
321     TopoDS_Shape aRes = GEOMImpl_IShapesOperations::CompsolidToCompound(aShape);
322     aFunction->SetValue(aRes);
323   }
324   
325
326   log.SetTouched(Label());
327
328   return 1;
329 }
330
331 //=======================================================================
332 //function : MakeScaledPrism
333 //purpose  :
334 //=======================================================================
335 TopoDS_Shape GEOMImpl_PrismDriver::MakeScaledPrism (const TopoDS_Shape& theShapeBase,
336                                                     const gp_Vec&       theVector,
337                                                     const Standard_Real theScaleFactor,
338                                                     const gp_Pnt&       theCDG,
339                                                     bool                isCDG)
340 {
341   TopoDS_Shape aShape;
342   BRep_Builder B;
343
344   // 1. aCDG = geompy.MakeCDG(theBase)
345   gp_Pnt aCDG = theCDG;
346   if (!isCDG) {
347     gp_Ax3 aPos = GEOMImpl_IMeasureOperations::GetPosition(theShapeBase);
348     aCDG = aPos.Location();
349   }
350   TopoDS_Shape aShapeCDG_1 = BRepBuilderAPI_MakeVertex(aCDG).Shape();
351
352   // Process case of several given shapes
353   if (theShapeBase.ShapeType() == TopAbs_COMPOUND ||
354       theShapeBase.ShapeType() == TopAbs_SHELL) {
355     int nbSub = 0;
356     TopoDS_Shape aShapeI;
357     TopoDS_Compound aCompound;
358     B.MakeCompound(aCompound);
359     TopoDS_Iterator It (theShapeBase, Standard_True, Standard_True);
360     for (; It.More(); It.Next()) {
361       nbSub++;
362       aShapeI = MakeScaledPrism(It.Value(), theVector, theScaleFactor, aCDG, true);
363       B.Add(aCompound, aShapeI);
364     }
365     if (nbSub == 1)
366       aShape = aShapeI;
367     else if (nbSub > 1)
368       aShape = GEOMImpl_GlueDriver::GlueFaces(aCompound, Precision::Confusion(), Standard_True);
369     return aShape;
370   }
371
372   // 2. Scale = geompy.MakeScaleTransform(theBase, aCDG, theScaleFactor)
373
374   // Bug 6839: Check for standalone (not included in faces) degenerated edges
375   TopTools_IndexedDataMapOfShapeListOfShape aEFMap;
376   TopExp::MapShapesAndAncestors(theShapeBase, TopAbs_EDGE, TopAbs_FACE, aEFMap);
377   Standard_Integer i, nbE = aEFMap.Extent();
378   for (i = 1; i <= nbE; i++) {
379     TopoDS_Shape anEdgeSh = aEFMap.FindKey(i);
380     if (BRep_Tool::Degenerated(TopoDS::Edge(anEdgeSh))) {
381       const TopTools_ListOfShape& aFaces = aEFMap.FindFromIndex(i);
382       if (aFaces.IsEmpty())
383         Standard_ConstructionError::Raise
384           ("Scaling aborted : cannot scale standalone degenerated edge");
385     }
386   }
387
388   // Perform Scaling
389   gp_Trsf aTrsf;
390   aTrsf.SetScale(aCDG, theScaleFactor);
391   BRepBuilderAPI_Transform aBRepTrsf (theShapeBase, aTrsf, Standard_False);
392   TopoDS_Shape aScale = aBRepTrsf.Shape();
393
394   // 3. aBase2 = geompy.MakeTranslationVectorDistance(Scale, theVec, theH)
395   gp_Trsf aTrsf3;
396   aTrsf3.SetTranslation(theVector);
397   TopLoc_Location aLocOrig = aScale.Location();
398   gp_Trsf aTrsfOrig = aLocOrig.Transformation();
399   TopLoc_Location aLocRes (aTrsf3 * aTrsfOrig);
400   TopoDS_Shape aBase2 = aScale.Located(aLocRes);
401
402   // 4. aCDG_2 = geompy.MakeTranslationVectorDistance(aCDG, theVec, theH)
403   gp_Pnt aCDG_2 = aCDG.Translated(theVector);
404   TopoDS_Shape aShapeCDG_2 = BRepBuilderAPI_MakeVertex(aCDG_2).Shape();
405
406   // 5. Vector = geompy.MakeVector(aCDG, aCDG_2)
407   TopoDS_Shape aShapeVec = BRepBuilderAPI_MakeEdge(aCDG, aCDG_2).Shape();
408   TopoDS_Edge anEdge = TopoDS::Edge(aShapeVec);
409   TopoDS_Wire aWirePath = BRepBuilderAPI_MakeWire(anEdge);
410
411   // 6. aPrism = geompy.MakePipeWithDifferentSections([theBase, aBase2], [aCDG, aCDG_2], Vector, False, False)
412   Handle(TopTools_HSequenceOfShape) aBases = new TopTools_HSequenceOfShape;
413   aBases->Append(theShapeBase);
414   aBases->Append(aBase2);
415
416   Handle(TopTools_HSequenceOfShape) aLocs = new TopTools_HSequenceOfShape;
417   aLocs->Append(aShapeCDG_1);
418   aLocs->Append(aShapeCDG_2);
419
420   aShape = GEOMImpl_PipeDriver::CreatePipeWithDifferentSections(aWirePath, aBases, aLocs, false, false);
421
422   // 7. Make a solid, if possible
423   if (theShapeBase.ShapeType() == TopAbs_FACE) {
424     BRepBuilderAPI_Sewing aSewing (Precision::Confusion()*10.0);
425     TopExp_Explorer expF (aShape, TopAbs_FACE);
426     Standard_Integer ifa = 0;
427     for (; expF.More(); expF.Next()) {
428       aSewing.Add(expF.Current());
429       ifa++;
430     }
431     if (ifa > 0) {
432       aSewing.Perform();
433       TopoDS_Shape aShell;
434
435       TopoDS_Shape sh = aSewing.SewedShape();
436       if (sh.ShapeType() == TopAbs_FACE && ifa == 1) {
437         // case for creation of shell from one face
438         TopoDS_Shell ss;
439         B.MakeShell(ss);
440         B.Add(ss,sh);
441         aShell = ss;
442       }
443       else {
444         TopExp_Explorer exp (sh, TopAbs_SHELL);
445         Standard_Integer ish = 0;
446         for (; exp.More(); exp.Next()) {
447           aShell = exp.Current();
448           ish++;
449         }
450         if (ish != 1)
451           aShell = sh;
452       }
453       BRepCheck_Shell chkShell (TopoDS::Shell(aShell));
454       if (chkShell.Closed() == BRepCheck_NoError) {
455         TopoDS_Solid Sol;
456         B.MakeSolid(Sol);
457         B.Add(Sol, aShell);
458         BRepClass3d_SolidClassifier SC (Sol);
459         SC.PerformInfinitePoint(Precision::Confusion());
460         if (SC.State() == TopAbs_IN) {
461           B.MakeSolid(Sol);
462           B.Add(Sol, aShell.Reversed());
463         }
464         aShape = Sol;
465       }
466     }
467   }
468
469   return aShape;
470 }
471
472 //=======================================================================
473 //function : GEOMImpl_PrismDriver_Type_
474 //purpose  :
475 //=======================================================================
476 Standard_EXPORT Handle_Standard_Type& GEOMImpl_PrismDriver_Type_()
477 {
478
479   static Handle_Standard_Type aType1 = STANDARD_TYPE(TFunction_Driver);
480   if (aType1.IsNull()) aType1 = STANDARD_TYPE(TFunction_Driver);
481   static Handle_Standard_Type aType2 = STANDARD_TYPE(MMgt_TShared);
482   if (aType2.IsNull()) aType2 = STANDARD_TYPE(MMgt_TShared);
483   static Handle_Standard_Type aType3 = STANDARD_TYPE(Standard_Transient);
484   if (aType3.IsNull()) aType3 = STANDARD_TYPE(Standard_Transient);
485
486   static Handle_Standard_Transient _Ancestors[]= {aType1,aType2,aType3,NULL};
487   static Handle_Standard_Type _aType = new Standard_Type("GEOMImpl_PrismDriver",
488                                                          sizeof(GEOMImpl_PrismDriver),
489                                                          1,
490                                                          (Standard_Address)_Ancestors,
491                                                          (Standard_Address)NULL);
492
493   return _aType;
494 }
495
496 //=======================================================================
497 //function : DownCast
498 //purpose  :
499 //=======================================================================
500 const Handle(GEOMImpl_PrismDriver) Handle(GEOMImpl_PrismDriver)::DownCast(const Handle(Standard_Transient)& AnObject)
501 {
502   Handle(GEOMImpl_PrismDriver) _anOtherObject;
503
504   if (!AnObject.IsNull()) {
505      if (AnObject->IsKind(STANDARD_TYPE(GEOMImpl_PrismDriver))) {
506        _anOtherObject = Handle(GEOMImpl_PrismDriver)((Handle(GEOMImpl_PrismDriver)&)AnObject);
507      }
508   }
509
510   return _anOtherObject;
511 }