0024624: Lost word in license statement in source files
[occt.git] / src / BRepBuilderAPI / BRepBuilderAPI_FindPlane.cxx
CommitLineData
b311480e 1// Created on: 1995-11-02
2// Created by: Jing Cheng MEI
3// Copyright (c) 1995-1999 Matra Datavision
973c2be1 4// Copyright (c) 1999-2014 OPEN CASCADE SAS
b311480e 5//
973c2be1 6// This file is part of Open CASCADE Technology software library.
b311480e 7//
d5f74e42 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
973c2be1 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.
b311480e 13//
973c2be1 14// Alternatively, this file may be used under the terms of Open CASCADE
15// commercial license or contractual agreement.
7fd59977 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
45BRepBuilderAPI_FindPlane::BRepBuilderAPI_FindPlane()
46{
47}
48
49//=======================================================================
50//function : BRepBuilderAPI_FindPlane
51//purpose :
52//=======================================================================
53
54BRepBuilderAPI_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
65void 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;
0d969553 152 p1 = points(i); // it will be faster to store the point, otherwise it is necessary to find a value in a sequence
7fd59977 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
201Standard_Boolean BRepBuilderAPI_FindPlane::Found() const
202{
203 return !myPlane.IsNull();
204}
205
206//=======================================================================
207//function : Plane
208//purpose :
209//=======================================================================
210
211Handle(Geom_Plane) BRepBuilderAPI_FindPlane::Plane() const
212{
213 return myPlane;
214}
215