1 // Copyright (C) 2005 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
2 // CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
4 // This library is free software; you can redistribute it and/or
5 // modify it under the terms of the GNU Lesser General Public
6 // License as published by the Free Software Foundation; either
7 // version 2.1 of the License.
9 // This library is distributed in the hope that it will be useful
10 // but WITHOUT ANY WARRANTY; without even the implied warranty of
11 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 // Lesser General Public License for more details.
14 // You should have received a copy of the GNU Lesser General Public
15 // License along with this library; if not, write to the Free Software
16 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
18 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
21 #include <Standard_Stream.hxx>
23 #include <GEOMImpl_CircleDriver.hxx>
24 #include <GEOMImpl_ICircle.hxx>
25 #include <GEOMImpl_Types.hxx>
26 #include <GEOM_Function.hxx>
28 #include <BRepBuilderAPI_MakeEdge.hxx>
29 #include <BRep_Tool.hxx>
31 #include <TopoDS_Shape.hxx>
32 #include <TopoDS_Edge.hxx>
33 #include <TopoDS_Vertex.hxx>
37 #include <GC_MakeCircle.hxx>
38 #include <Geom_Circle.hxx>
40 #include <Standard_ConstructionError.hxx>
41 #include <Precision.hxx>
44 #include <gp_Circ.hxx>
46 //=======================================================================
49 //=======================================================================
50 const Standard_GUID& GEOMImpl_CircleDriver::GetID()
52 static Standard_GUID aCircleDriver("FF1BBB32-5D14-4df2-980B-3A668264EA16");
57 //=======================================================================
58 //function : GEOMImpl_CircleDriver
60 //=======================================================================
61 GEOMImpl_CircleDriver::GEOMImpl_CircleDriver()
65 //=======================================================================
68 //=======================================================================
69 Standard_Integer GEOMImpl_CircleDriver::Execute(TFunction_Logbook& log) const
71 if (Label().IsNull()) return 0;
72 Handle(GEOM_Function) aFunction = GEOM_Function::GetFunction(Label());
74 GEOMImpl_ICircle aCI (aFunction);
75 Standard_Integer aType = aFunction->GetType();
79 if (aType == CIRCLE_PNT_VEC_R) {
81 gp_Pnt aP = gp::Origin();
82 Handle(GEOM_Function) aRefPoint = aCI.GetCenter();
83 if (!aRefPoint.IsNull()) {
84 TopoDS_Shape aShapePnt = aRefPoint->GetValue();
85 if (aShapePnt.ShapeType() != TopAbs_VERTEX) {
86 Standard_ConstructionError::Raise
87 ("Circle creation aborted: invalid center argument, must be a point");
89 aP = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt));
93 Handle(GEOM_Function) aRefVector = aCI.GetVector();
94 if (!aRefVector.IsNull()) {
95 TopoDS_Shape aShapeVec = aRefVector->GetValue();
96 if (aShapeVec.ShapeType() != TopAbs_EDGE) {
97 Standard_ConstructionError::Raise
98 ("Circle creation aborted: invalid vector argument, must be a vector or an edge");
100 TopoDS_Edge anE = TopoDS::Edge(aShapeVec);
101 TopoDS_Vertex V1, V2;
102 TopExp::Vertices(anE, V1, V2, Standard_True);
103 if (!V1.IsNull() && !V2.IsNull()) {
104 aV = gp_Vec(BRep_Tool::Pnt(V1), BRep_Tool::Pnt(V2));
105 if (aV.Magnitude() < gp::Resolution()) {
106 Standard_ConstructionError::Raise
107 ("Circle creation aborted: vector of zero length is given");
112 gp_Ax2 anAxes (aP, aV);
114 gp_Circ aCirc (anAxes, aCI.GetRadius());
115 aShape = BRepBuilderAPI_MakeEdge(aCirc).Edge();
117 else if (aType == CIRCLE_CENTER_TWO_PNT) {
118 Handle(GEOM_Function) aRefPoint1 = aCI.GetPoint1();
119 Handle(GEOM_Function) aRefPoint2 = aCI.GetPoint2();
120 Handle(GEOM_Function) aRefPoint3 = aCI.GetPoint3();
121 TopoDS_Shape aShapePnt1 = aRefPoint1->GetValue();
122 TopoDS_Shape aShapePnt2 = aRefPoint2->GetValue();
123 TopoDS_Shape aShapePnt3 = aRefPoint3->GetValue();
124 if (aShapePnt1.ShapeType() == TopAbs_VERTEX &&
125 aShapePnt2.ShapeType() == TopAbs_VERTEX &&
126 aShapePnt3.ShapeType() == TopAbs_VERTEX)
128 gp_Pnt aP1 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt1));
129 gp_Pnt aP2 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt2));
130 gp_Pnt aP3 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt3));
132 if (aP1.Distance(aP2) < gp::Resolution() ||
133 aP1.Distance(aP3) < gp::Resolution() ||
134 aP2.Distance(aP3) < gp::Resolution())
135 Standard_ConstructionError::Raise("Circle creation aborted: coincident points given");
137 if (gp_Vec(aP1, aP2).IsParallel(gp_Vec(aP1, aP3), Precision::Angular()))
138 Standard_ConstructionError::Raise("Circle creation aborted: points lay on one line");
140 double x, y, z, x1, y1, z1, x2, y2, z2, dx, dy, dz, dx2, dy2, dz2, dx3, dy3, dz3, aRadius;
141 //Calculations for Radius
142 x = aP1.X(); y = aP1.Y(); z = aP1.Z();
143 x1 = aP2.X(); y1 = aP2.Y(); z1 = aP2.Z();
147 aRadius = sqrt(dx*dx + dy*dy + dz*dz);
148 //Calculations for Plane Vector
149 x2 = aP3.X(); y2 = aP3.Y(); z2 = aP3.Z();
150 dx2 = x2 - x; dy2 = y2 - y; dz2 = z2 - z;
151 dx3 = ((dy*dz2) - (dy2*dz))/100;
152 dy3 = ((dx2*dz) - (dx*dz2))/100;
153 dz3 = ((dx*dy2) - (dx2*dy))/100;
155 gp_Dir aDir ( dx3, dy3, dz3 );
157 gp_Ax2 anAxes (aP1, aDir);
158 gp_Circ aCirc (anAxes, aRadius);
159 aShape = BRepBuilderAPI_MakeEdge(aCirc).Edge();
162 else if (aType == CIRCLE_THREE_PNT) {
163 Handle(GEOM_Function) aRefPoint1 = aCI.GetPoint1();
164 Handle(GEOM_Function) aRefPoint2 = aCI.GetPoint2();
165 Handle(GEOM_Function) aRefPoint3 = aCI.GetPoint3();
166 TopoDS_Shape aShapePnt1 = aRefPoint1->GetValue();
167 TopoDS_Shape aShapePnt2 = aRefPoint2->GetValue();
168 TopoDS_Shape aShapePnt3 = aRefPoint3->GetValue();
169 if (aShapePnt1.ShapeType() == TopAbs_VERTEX &&
170 aShapePnt2.ShapeType() == TopAbs_VERTEX &&
171 aShapePnt3.ShapeType() == TopAbs_VERTEX) {
172 gp_Pnt aP1 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt1));
173 gp_Pnt aP2 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt2));
174 gp_Pnt aP3 = BRep_Tool::Pnt(TopoDS::Vertex(aShapePnt3));
175 if (aP1.Distance(aP2) < gp::Resolution() ||
176 aP1.Distance(aP3) < gp::Resolution() ||
177 aP2.Distance(aP3) < gp::Resolution())
178 Standard_ConstructionError::Raise("Circle creation aborted: coincident points given");
179 if (gp_Vec(aP1, aP2).IsParallel(gp_Vec(aP1, aP3), Precision::Angular()))
180 Standard_ConstructionError::Raise("Circle creation aborted: points lay on one line");
181 Handle(Geom_Circle) aCirc = GC_MakeCircle(aP1, aP2, aP3).Value();
182 aShape = BRepBuilderAPI_MakeEdge(aCirc).Edge();
188 if (aShape.IsNull()) return 0;
190 aFunction->SetValue(aShape);
192 log.SetTouched(Label());
198 //=======================================================================
199 //function : GEOMImpl_CircleDriver_Type_
201 //=======================================================================
202 Standard_EXPORT Handle_Standard_Type& GEOMImpl_CircleDriver_Type_()
205 static Handle_Standard_Type aType1 = STANDARD_TYPE(TFunction_Driver);
206 if ( aType1.IsNull()) aType1 = STANDARD_TYPE(TFunction_Driver);
207 static Handle_Standard_Type aType2 = STANDARD_TYPE(MMgt_TShared);
208 if ( aType2.IsNull()) aType2 = STANDARD_TYPE(MMgt_TShared);
209 static Handle_Standard_Type aType3 = STANDARD_TYPE(Standard_Transient);
210 if ( aType3.IsNull()) aType3 = STANDARD_TYPE(Standard_Transient);
213 static Handle_Standard_Transient _Ancestors[]= {aType1,aType2,aType3,NULL};
214 static Handle_Standard_Type _aType = new Standard_Type("GEOMImpl_CircleDriver",
215 sizeof(GEOMImpl_CircleDriver),
217 (Standard_Address)_Ancestors,
218 (Standard_Address)NULL);
223 //=======================================================================
224 //function : DownCast
226 //=======================================================================
227 const Handle(GEOMImpl_CircleDriver) Handle(GEOMImpl_CircleDriver)::DownCast(const Handle(Standard_Transient)& AnObject)
229 Handle(GEOMImpl_CircleDriver) _anOtherObject;
231 if (!AnObject.IsNull()) {
232 if (AnObject->IsKind(STANDARD_TYPE(GEOMImpl_CircleDriver))) {
233 _anOtherObject = Handle(GEOMImpl_CircleDriver)((Handle(GEOMImpl_CircleDriver)&)AnObject);
237 return _anOtherObject ;