Salome HOME
EDF 2281 : Add 2 primitives for hexa mesh
[modules/geom.git] / src / GEOMImpl / GEOMImpl_ArcDriver.cxx
1 // Copyright (C) 2007-2012  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 <Standard_Stream.hxx>
24
25 #include <GEOMImpl_ArcDriver.hxx>
26 #include <GEOMImpl_IArc.hxx>
27 #include <GEOMImpl_Types.hxx>
28 #include <GEOM_Function.hxx>
29
30 #include <BRepBuilderAPI_MakeEdge.hxx>
31 #include <BRep_Tool.hxx>
32 #include <TopoDS.hxx>
33 #include <TopoDS_Shape.hxx>
34 #include <TopoDS_Edge.hxx>
35 #include <TopoDS_Vertex.hxx>
36 #include <TopAbs.hxx>
37 #include <TopExp.hxx>
38
39 #include <GC_MakeArcOfCircle.hxx>
40 #include <GC_MakeCircle.hxx>
41 #include <GC_MakeArcOfEllipse.hxx>
42 #include <GC_MakeEllipse.hxx>
43 #include <Standard_ConstructionError.hxx>
44 #include <Precision.hxx>
45 #include <gp_Pnt.hxx>
46 #include <gp_Vec.hxx>
47 #include <gp_Circ.hxx>
48 #include <gp_Elips.hxx>
49 #include <Geom_Circle.hxx>
50 #include <Geom_Ellipse.hxx>
51
52 #include "utilities.h"
53
54 //=======================================================================
55 //function : GetID
56 //purpose  :
57 //======================================================================= 
58 const Standard_GUID& GEOMImpl_ArcDriver::GetID()
59 {
60   static Standard_GUID aArcDriver("FF1BBB35-5D14-4df2-980B-3A668264EA16");
61   return aArcDriver; 
62 }
63
64
65 //=======================================================================
66 //function : GEOMImpl_ArcDriver
67 //purpose  : 
68 //=======================================================================
69 GEOMImpl_ArcDriver::GEOMImpl_ArcDriver() 
70 {
71 }
72
73 //=======================================================================
74 //function : Execute
75 //purpose  :
76 //======================================================================= 
77 Standard_Integer GEOMImpl_ArcDriver::Execute(TFunction_Logbook& log) const
78 {
79   if (Label().IsNull()) return 0;    
80   Handle(GEOM_Function) aFunction = GEOM_Function::GetFunction(Label());
81
82   GEOMImpl_IArc aCI (aFunction);
83   Standard_Integer aType = aFunction->GetType();
84
85   TopoDS_Shape aShape;
86   if ((aType == CIRC_ARC_THREE_PNT) || (aType == CIRC_ARC_CENTER) || (aType == ELLIPSE_ARC_CENTER_TWO_PNT))
87   {
88     Handle(GEOM_Function) aRefPoint1 = aCI.GetPoint1();
89     Handle(GEOM_Function) aRefPoint2 = aCI.GetPoint2();
90     Handle(GEOM_Function) aRefPoint3 = aCI.GetPoint3();
91
92     TopoDS_Shape aShapePnt1 = aRefPoint1->GetValue();
93     TopoDS_Shape aShapePnt2 = aRefPoint2->GetValue();
94     TopoDS_Shape aShapePnt3 = aRefPoint3->GetValue();
95
96     if (aShapePnt1.ShapeType() == TopAbs_VERTEX &&
97         aShapePnt2.ShapeType() == TopAbs_VERTEX &&
98         aShapePnt3.ShapeType() == TopAbs_VERTEX)
99     {
100       gp_Pnt aP1 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt1));
101       gp_Pnt aP2 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt2));
102       gp_Pnt aP3 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt3));
103
104       if (aP1.Distance(aP2) < gp::Resolution() ||
105           aP1.Distance(aP3) < gp::Resolution() ||
106           aP2.Distance(aP3) < gp::Resolution())
107         Standard_ConstructionError::Raise("Arc creation aborted: coincident points given");
108
109       if (gp_Vec(aP1, aP2).IsParallel(gp_Vec(aP1, aP3), Precision::Angular()))
110         Standard_ConstructionError::Raise("Arc creation aborted: points lay on one line");
111
112       if (aType == CIRC_ARC_THREE_PNT)
113       {
114         GC_MakeArcOfCircle arc (aP1, aP2, aP3);
115         aShape = BRepBuilderAPI_MakeEdge(arc).Edge();
116       } else if ( aType == CIRC_ARC_CENTER ) { // CIRC_ARC_CENTER
117         Standard_Boolean sense = aCI.GetSense();
118
119         Standard_Real aRad = aP1.Distance(aP2);
120         gp_Vec aV1 (aP1, aP2);
121         gp_Vec aV2 (aP1, aP3);
122         gp_Vec aN = aV1 ^ aV2;
123
124         if (sense)
125           aN = -aN;
126
127         GC_MakeCircle circ (aP1, aN, aRad);
128         Handle(Geom_Circle) aGeomCirc = circ.Value();
129
130         GC_MakeArcOfCircle arc (aGeomCirc->Circ(), aP2, aP3, Standard_True);
131         aShape = BRepBuilderAPI_MakeEdge(arc).Edge();
132       } else if ( aType == ELLIPSE_ARC_CENTER_TWO_PNT ) { // ELLIPSE_ARC_CENTER_TWO_PNT
133         if ( aP1.Distance(aP2) <= aP1.Distance(aP3) ) {
134           // Standard_ConstructionError::Raise("Arc creation aborted: the distance from Center Point to Point 1 needs to be bigger than the distance from Center Point to Point 2");      
135           cout << "aP1.Distance(aP2) <= aP1.Distance(aP3)" << endl;
136           gp_Pnt aTmpP = aP2;
137           aP2 = aP3;
138           aP3 = aTmpP;
139         }
140
141         GC_MakeEllipse ellipse (aP2, aP3, aP1);
142         Handle(Geom_Ellipse) aGeomEllipse = ellipse.Value();
143
144 //         gp_Vec aV1 (aP1, aP2);
145 //         gp_Vec aV2 (aP1, aP3);
146 // 
147 //         double alpha = fabs(aV1.Angle(aV2));
148         
149         GC_MakeArcOfEllipse arc (aGeomEllipse->Elips(), aP2, aP3, Standard_True);
150         aShape = BRepBuilderAPI_MakeEdge(arc).Edge();
151       }
152     }
153   }
154   else {
155   }
156
157   if (aShape.IsNull()) return 0;
158
159   aFunction->SetValue(aShape);
160
161   log.SetTouched(Label());
162   return 1;
163 }
164
165
166 //=======================================================================
167 //function :  GEOMImpl_ArcDriver_Type_
168 //purpose  :
169 //======================================================================= 
170 Standard_EXPORT Handle_Standard_Type& GEOMImpl_ArcDriver_Type_()
171 {
172
173   static Handle_Standard_Type aType1 = STANDARD_TYPE(TFunction_Driver);
174   if ( aType1.IsNull()) aType1 = STANDARD_TYPE(TFunction_Driver);
175   static Handle_Standard_Type aType2 = STANDARD_TYPE(MMgt_TShared);
176   if ( aType2.IsNull()) aType2 = STANDARD_TYPE(MMgt_TShared); 
177   static Handle_Standard_Type aType3 = STANDARD_TYPE(Standard_Transient);
178   if ( aType3.IsNull()) aType3 = STANDARD_TYPE(Standard_Transient);
179  
180
181   static Handle_Standard_Transient _Ancestors[]= {aType1,aType2,aType3,NULL};
182   static Handle_Standard_Type _aType = new Standard_Type("GEOMImpl_ArcDriver",
183                                                          sizeof(GEOMImpl_ArcDriver),
184                                                          1,
185                                                          (Standard_Address)_Ancestors,
186                                                          (Standard_Address)NULL);
187
188   return _aType;
189 }
190
191 //=======================================================================
192 //function : DownCast
193 //purpose  :
194 //======================================================================= 
195 const Handle(GEOMImpl_ArcDriver) Handle(GEOMImpl_ArcDriver)::DownCast(const Handle(Standard_Transient)& AnObject)
196 {
197   Handle(GEOMImpl_ArcDriver) _anOtherObject;
198
199   if (!AnObject.IsNull()) {
200      if (AnObject->IsKind(STANDARD_TYPE(GEOMImpl_ArcDriver))) {
201        _anOtherObject = Handle(GEOMImpl_ArcDriver)((Handle(GEOMImpl_ArcDriver)&)AnObject);
202      }
203   }
204
205   return _anOtherObject ;
206 }