1 // Copyright (C) 2007-2008 CEA/DEN, EDF R&D, OPEN CASCADE
3 // Copyright (C) 2003-2007 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.salome-platform.org/ or email : webmaster.salome@opencascade.com
22 #include <Standard_Stream.hxx>
24 #include <GEOMImpl_CircleDriver.hxx>
25 #include <GEOMImpl_ICircle.hxx>
26 #include <GEOMImpl_Types.hxx>
27 #include <GEOM_Function.hxx>
29 #include <BRepBuilderAPI_MakeEdge.hxx>
30 #include <BRep_Tool.hxx>
32 #include <TopoDS_Shape.hxx>
33 #include <TopoDS_Edge.hxx>
34 #include <TopoDS_Vertex.hxx>
38 #include <GC_MakeCircle.hxx>
39 #include <Geom_Circle.hxx>
41 #include <Standard_ConstructionError.hxx>
42 #include <Precision.hxx>
45 #include <gp_Circ.hxx>
47 //=======================================================================
50 //=======================================================================
51 const Standard_GUID& GEOMImpl_CircleDriver::GetID()
53 static Standard_GUID aCircleDriver("FF1BBB32-5D14-4df2-980B-3A668264EA16");
58 //=======================================================================
59 //function : GEOMImpl_CircleDriver
61 //=======================================================================
62 GEOMImpl_CircleDriver::GEOMImpl_CircleDriver()
66 //=======================================================================
69 //=======================================================================
70 Standard_Integer GEOMImpl_CircleDriver::Execute(TFunction_Logbook& log) const
72 if (Label().IsNull()) return 0;
73 Handle(GEOM_Function) aFunction = GEOM_Function::GetFunction(Label());
75 GEOMImpl_ICircle aCI (aFunction);
76 Standard_Integer aType = aFunction->GetType();
80 if (aType == CIRCLE_PNT_VEC_R) {
82 gp_Pnt aP = gp::Origin();
83 Handle(GEOM_Function) aRefPoint = aCI.GetCenter();
84 if (!aRefPoint.IsNull()) {
85 TopoDS_Shape aShapePnt = aRefPoint->GetValue();
86 if (aShapePnt.ShapeType() != TopAbs_VERTEX) {
87 Standard_ConstructionError::Raise
88 ("Circle creation aborted: invalid center argument, must be a point");
90 aP = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt));
94 Handle(GEOM_Function) aRefVector = aCI.GetVector();
95 if (!aRefVector.IsNull()) {
96 TopoDS_Shape aShapeVec = aRefVector->GetValue();
97 if (aShapeVec.ShapeType() != TopAbs_EDGE) {
98 Standard_ConstructionError::Raise
99 ("Circle creation aborted: invalid vector argument, must be a vector or an edge");
101 TopoDS_Edge anE = TopoDS::Edge(aShapeVec);
102 TopoDS_Vertex V1, V2;
103 TopExp::Vertices(anE, V1, V2, Standard_True);
104 if (!V1.IsNull() && !V2.IsNull()) {
105 aV = gp_Vec(BRep_Tool::Pnt(V1), BRep_Tool::Pnt(V2));
106 if (aV.Magnitude() < gp::Resolution()) {
107 Standard_ConstructionError::Raise
108 ("Circle creation aborted: vector of zero length is given");
113 gp_Ax2 anAxes (aP, aV);
115 gp_Circ aCirc (anAxes, aCI.GetRadius());
116 aShape = BRepBuilderAPI_MakeEdge(aCirc).Edge();
118 else if (aType == CIRCLE_CENTER_TWO_PNT) {
119 Handle(GEOM_Function) aRefPoint1 = aCI.GetPoint1();
120 Handle(GEOM_Function) aRefPoint2 = aCI.GetPoint2();
121 Handle(GEOM_Function) aRefPoint3 = aCI.GetPoint3();
122 TopoDS_Shape aShapePnt1 = aRefPoint1->GetValue();
123 TopoDS_Shape aShapePnt2 = aRefPoint2->GetValue();
124 TopoDS_Shape aShapePnt3 = aRefPoint3->GetValue();
125 if (aShapePnt1.ShapeType() == TopAbs_VERTEX &&
126 aShapePnt2.ShapeType() == TopAbs_VERTEX &&
127 aShapePnt3.ShapeType() == TopAbs_VERTEX)
129 gp_Pnt aP1 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt1));
130 gp_Pnt aP2 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt2));
131 gp_Pnt aP3 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt3));
133 if (aP1.Distance(aP2) < gp::Resolution() ||
134 aP1.Distance(aP3) < gp::Resolution() ||
135 aP2.Distance(aP3) < gp::Resolution())
136 Standard_ConstructionError::Raise("Circle creation aborted: coincident points given");
138 if (gp_Vec(aP1, aP2).IsParallel(gp_Vec(aP1, aP3), Precision::Angular()))
139 Standard_ConstructionError::Raise("Circle creation aborted: points lay on one line");
141 double x, y, z, x1, y1, z1, x2, y2, z2, dx, dy, dz, dx2, dy2, dz2, dx3, dy3, dz3, aRadius;
142 //Calculations for Radius
143 x = aP1.X(); y = aP1.Y(); z = aP1.Z();
144 x1 = aP2.X(); y1 = aP2.Y(); z1 = aP2.Z();
148 aRadius = sqrt(dx*dx + dy*dy + dz*dz);
149 //Calculations for Plane Vector
150 x2 = aP3.X(); y2 = aP3.Y(); z2 = aP3.Z();
151 dx2 = x2 - x; dy2 = y2 - y; dz2 = z2 - z;
152 dx3 = ((dy*dz2) - (dy2*dz))/100;
153 dy3 = ((dx2*dz) - (dx*dz2))/100;
154 dz3 = ((dx*dy2) - (dx2*dy))/100;
156 gp_Dir aDir ( dx3, dy3, dz3 );
158 gp_Ax2 anAxes (aP1, aDir);
159 gp_Circ aCirc (anAxes, aRadius);
160 aShape = BRepBuilderAPI_MakeEdge(aCirc).Edge();
163 else if (aType == CIRCLE_THREE_PNT) {
164 Handle(GEOM_Function) aRefPoint1 = aCI.GetPoint1();
165 Handle(GEOM_Function) aRefPoint2 = aCI.GetPoint2();
166 Handle(GEOM_Function) aRefPoint3 = aCI.GetPoint3();
167 TopoDS_Shape aShapePnt1 = aRefPoint1->GetValue();
168 TopoDS_Shape aShapePnt2 = aRefPoint2->GetValue();
169 TopoDS_Shape aShapePnt3 = aRefPoint3->GetValue();
170 if (aShapePnt1.ShapeType() == TopAbs_VERTEX &&
171 aShapePnt2.ShapeType() == TopAbs_VERTEX &&
172 aShapePnt3.ShapeType() == TopAbs_VERTEX) {
173 gp_Pnt aP1 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt1));
174 gp_Pnt aP2 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt2));
175 gp_Pnt aP3 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt3));
176 if (aP1.Distance(aP2) < gp::Resolution() ||
177 aP1.Distance(aP3) < gp::Resolution() ||
178 aP2.Distance(aP3) < gp::Resolution())
179 Standard_ConstructionError::Raise("Circle creation aborted: coincident points given");
180 if (gp_Vec(aP1, aP2).IsParallel(gp_Vec(aP1, aP3), Precision::Angular()))
181 Standard_ConstructionError::Raise("Circle creation aborted: points lay on one line");
182 Handle(Geom_Circle) aCirc = GC_MakeCircle(aP1, aP2, aP3).Value();
183 aShape = BRepBuilderAPI_MakeEdge(aCirc).Edge();
189 if (aShape.IsNull()) return 0;
191 aFunction->SetValue(aShape);
193 log.SetTouched(Label());
199 //=======================================================================
200 //function : GEOMImpl_CircleDriver_Type_
202 //=======================================================================
203 Standard_EXPORT Handle_Standard_Type& GEOMImpl_CircleDriver_Type_()
206 static Handle_Standard_Type aType1 = STANDARD_TYPE(TFunction_Driver);
207 if ( aType1.IsNull()) aType1 = STANDARD_TYPE(TFunction_Driver);
208 static Handle_Standard_Type aType2 = STANDARD_TYPE(MMgt_TShared);
209 if ( aType2.IsNull()) aType2 = STANDARD_TYPE(MMgt_TShared);
210 static Handle_Standard_Type aType3 = STANDARD_TYPE(Standard_Transient);
211 if ( aType3.IsNull()) aType3 = STANDARD_TYPE(Standard_Transient);
214 static Handle_Standard_Transient _Ancestors[]= {aType1,aType2,aType3,NULL};
215 static Handle_Standard_Type _aType = new Standard_Type("GEOMImpl_CircleDriver",
216 sizeof(GEOMImpl_CircleDriver),
218 (Standard_Address)_Ancestors,
219 (Standard_Address)NULL);
224 //=======================================================================
225 //function : DownCast
227 //=======================================================================
228 const Handle(GEOMImpl_CircleDriver) Handle(GEOMImpl_CircleDriver)::DownCast(const Handle(Standard_Transient)& AnObject)
230 Handle(GEOMImpl_CircleDriver) _anOtherObject;
232 if (!AnObject.IsNull()) {
233 if (AnObject->IsKind(STANDARD_TYPE(GEOMImpl_CircleDriver))) {
234 _anOtherObject = Handle(GEOMImpl_CircleDriver)((Handle(GEOMImpl_CircleDriver)&)AnObject);
238 return _anOtherObject ;