0024624: Lost word in license statement in source files
[occt.git] / src / BRepBuilderAPI / BRepBuilderAPI_FindPlane.cxx
1 // Created on: 1995-11-02
2 // Created by: Jing Cheng MEI
3 // Copyright (c) 1995-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 <BRepBuilderAPI_FindPlane.ixx>
18
19 #include <Precision.hxx>
20 #include <gp_Dir.hxx>
21 #include <gp_Vec.hxx>
22 #include <gp_Pln.hxx>
23 #include <TColgp_SequenceOfPnt.hxx>
24 #include <TopoDS.hxx>
25 #include <TopLoc_Location.hxx>
26 #include <TopExp_Explorer.hxx>
27 #include <BRep_Tool.hxx>
28
29 #include <Geom_Line.hxx> 
30 #include <Geom_Conic.hxx>
31 #include <Geom_Circle.hxx> 
32 #include <Geom_Ellipse.hxx> 
33 #include <Geom_Parabola.hxx> 
34 #include <Geom_Hyperbola.hxx> 
35 #include <Geom_BezierCurve.hxx>
36 #include <Geom_BSplineCurve.hxx>
37
38
39
40 //=======================================================================
41 //function : BRepBuilderAPI_FindPlane
42 //purpose  : 
43 //=======================================================================
44
45 BRepBuilderAPI_FindPlane::BRepBuilderAPI_FindPlane() 
46 {
47 }
48
49 //=======================================================================
50 //function : BRepBuilderAPI_FindPlane
51 //purpose  : 
52 //=======================================================================
53
54 BRepBuilderAPI_FindPlane::BRepBuilderAPI_FindPlane(const TopoDS_Shape&    S, 
55                                      const Standard_Real    Tol)
56 {
57   Init(S,Tol);
58 }
59
60 //=======================================================================
61 //function : Init
62 //purpose  : 
63 //=======================================================================
64
65 void BRepBuilderAPI_FindPlane::Init(const TopoDS_Shape&    S, 
66                              const Standard_Real    Tol)
67 {
68   Standard_Real tolerance = Tol;
69   myPlane.Nullify();
70
71   // compute the tolerance
72   TopExp_Explorer ex;
73   for (ex.Init(S,TopAbs_EDGE); ex.More(); ex.Next()) {
74     Standard_Real t = BRep_Tool::Tolerance(TopoDS::Edge(ex.Current()));
75     if (t > tolerance) tolerance = t;
76   }
77   
78   Standard_Real tol2 = tolerance*tolerance;
79   // try to find an analytical curve and calculate points
80   TopLoc_Location loc;
81   Standard_Real first, last;
82   Standard_Boolean found = Standard_False;  
83   Handle(Geom_Plane) P;
84   TColgp_SequenceOfPnt points;
85   Standard_Integer nbPnts;
86
87   for (ex.Init(S,TopAbs_EDGE); ex.More(); ex.Next()) {
88     Handle(Geom_Curve) c3d = 
89       BRep_Tool::Curve(TopoDS::Edge(ex.Current()), loc, first, last);
90
91     if (!c3d.IsNull()) {
92       Handle(Geom_Curve) c3dptr = 
93         Handle(Geom_Curve)::DownCast(c3d->Transformed(loc.Transformation()));
94
95       Handle(Standard_Type) cType = c3dptr->DynamicType();
96       
97       if (cType == STANDARD_TYPE(Geom_Line)) {
98         nbPnts = 3;
99       }
100       else if ((cType == STANDARD_TYPE(Geom_Circle)) ||
101                (cType == STANDARD_TYPE(Geom_Ellipse)) ||
102                (cType == STANDARD_TYPE(Geom_Parabola)) ||
103                (cType == STANDARD_TYPE(Geom_Hyperbola))) {
104         nbPnts = 4; 
105         if (!found) {
106           found = Standard_True;
107           Handle(Geom_Conic) Co = Handle(Geom_Conic)::DownCast(c3dptr);
108           P = new Geom_Plane(gp_Ax3(Co->Position()));
109         }
110       }
111       else if (cType == STANDARD_TYPE(Geom_BezierCurve)) {
112         Handle(Geom_BezierCurve) Co = 
113           Handle(Geom_BezierCurve)::DownCast(c3dptr);
114         nbPnts = Co->NbPoles();
115       }
116       else if (cType == STANDARD_TYPE(Geom_BSplineCurve)) {
117         Handle(Geom_BSplineCurve) Co = 
118           Handle(Geom_BSplineCurve)::DownCast(c3dptr);
119         nbPnts = Co->NbPoles();
120       }
121       else {
122         nbPnts = 10;
123       }
124       
125       gp_Pnt p0;
126       for (Standard_Integer i=1; i<=nbPnts; i++) {
127         if (i == 1) {
128           c3dptr->D0(first, p0);
129         }
130         else if (i == nbPnts) {
131           c3dptr->D0(last, p0);
132         }
133         else {
134           c3dptr->D0(first+(last-first)/(nbPnts-1)*(i-1), p0);
135         }
136         points.Append(p0);
137       }
138     }
139   }
140
141   if (!found) {
142     // try to find a plane with the points
143     if (points.Length() > 2) {    
144
145       Standard_Real disMax = 0.0;
146       gp_Pnt p0 = points(1);
147       gp_Pnt p1;
148       for (Standard_Integer i=2; i<=points.Length(); i++) {
149         Standard_Real dist = p0.SquareDistance(points(i));
150         if (dist > disMax) {
151           disMax = dist;
152           p1 = points(i); // it will be faster to store the point, otherwise it is necessary to find a value in a sequence
153         }
154       }
155
156       if (disMax > tol2) {
157         gp_Vec V1(p0, p1), V3;
158         Standard_Real proMax = 0.0;
159         gp_Pnt p2 = p0 ;
160         for (Standard_Integer j=2; j<=points.Length(); j++) {
161           V3 = V1^gp_Vec(p0, points(j));
162           Standard_Real pro = V3.SquareMagnitude();
163           if (pro > proMax) {
164             proMax = pro;
165             p2 = points(j);
166           }
167         }
168         
169         if (p0.SquareDistance(p2) > tol2) {
170           gp_Dir D1(V1), D2(gp_Vec(p0, p2));
171           if (!D1.IsParallel(D2, Precision::Angular())) {
172             P = new Geom_Plane(gp_Ax3(p0, D1.Crossed(D2), D1));
173             found = Standard_True;
174           }
175         }
176       }
177     }
178   }
179   
180   if (found) {
181     // test if all points are on the plane
182     const gp_Pln& pln = P->Pln();
183     for (Standard_Integer i=1; i<=points.Length(); i++) {
184       if (pln.SquareDistance(points(i)) > tol2) {
185         found = Standard_False;
186         break;
187       }
188     } 
189   }
190   
191   if (found) {
192     myPlane = P;
193   }
194 }
195
196 //=======================================================================
197 //function : Found
198 //purpose  : 
199 //=======================================================================
200
201 Standard_Boolean BRepBuilderAPI_FindPlane::Found() const 
202 {
203   return !myPlane.IsNull();
204 }
205
206 //=======================================================================
207 //function : Plane
208 //purpose  : 
209 //=======================================================================
210
211 Handle(Geom_Plane) BRepBuilderAPI_FindPlane::Plane() const 
212 {
213   return myPlane;
214 }
215