b311480e |
1 | // Created on: 2000-08-01 |
2 | // Created by: Peter KURNEV |
973c2be1 |
3 | // Copyright (c) 2000-2014 OPEN CASCADE SAS |
b311480e |
4 | // |
973c2be1 |
5 | // This file is part of Open CASCADE Technology software library. |
b311480e |
6 | // |
d5f74e42 |
7 | // This library is free software; you can redistribute it and/or modify it under |
8 | // the terms of the GNU Lesser General Public License version 2.1 as published |
973c2be1 |
9 | // by the Free Software Foundation, with special exception defined in the file |
10 | // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT |
11 | // distribution for complete text of the license and disclaimer of any warranty. |
b311480e |
12 | // |
973c2be1 |
13 | // Alternatively, this file may be used under the terms of Open CASCADE |
14 | // commercial license or contractual agreement. |
7fd59977 |
15 | |
7fd59977 |
16 | |
42cf5bc1 |
17 | #include <BRep_Tool.hxx> |
18 | #include <BRepAdaptor_Curve.hxx> |
19 | #include <BRepGProp.hxx> |
20 | #include <gce_ErrorType.hxx> |
7fd59977 |
21 | #include <gce_MakeCirc.hxx> |
42cf5bc1 |
22 | #include <GCPnts_QuasiUniformDeflection.hxx> |
23 | #include <Geom_Curve.hxx> |
7fd59977 |
24 | #include <gp_Circ.hxx> |
42cf5bc1 |
25 | #include <gp_Pnt.hxx> |
26 | #include <GProp_GProps.hxx> |
27 | #include <IntTools.hxx> |
28 | #include <IntTools_Array1OfRoots.hxx> |
7fd59977 |
29 | #include <IntTools_CArray1OfReal.hxx> |
42cf5bc1 |
30 | #include <IntTools_Root.hxx> |
7fd59977 |
31 | #include <TColStd_ListIteratorOfListOfReal.hxx> |
42cf5bc1 |
32 | #include <TColStd_ListOfReal.hxx> |
33 | #include <TopoDS_Edge.hxx> |
7fd59977 |
34 | |
e35db416 |
35 | #include <algorithm> |
7fd59977 |
36 | //======================================================================= |
37 | //function : IntTools::GetRadius |
38 | //purpose : |
39 | //======================================================================= |
40 | Standard_Integer IntTools::GetRadius(const BRepAdaptor_Curve& C, |
41 | const Standard_Real t1, |
42 | const Standard_Real t3, |
43 | Standard_Real& aR) |
44 | { |
45 | GeomAbs_CurveType aType=C.GetType(); |
46 | if (aType==GeomAbs_Line) { |
47 | return 1; |
48 | } |
49 | |
50 | if (aType==GeomAbs_Circle) { |
51 | gp_Circ aCrc=C.Circle(); |
52 | aR=aCrc.Radius(); |
53 | return 0; |
54 | } |
55 | |
56 | Standard_Real t2; |
57 | gp_Pnt P1, P2, P3; |
58 | |
59 | t2=0.5*(t1+t3); |
60 | |
61 | P1=C.Value(t1); |
62 | P2=C.Value(t2); |
63 | P3=C.Value(t3); |
64 | // |
65 | // |
66 | gce_MakeCirc aMakeCirc(P1, P2, P3); |
67 | gce_ErrorType anErrorType; |
68 | |
69 | anErrorType=aMakeCirc.Status(); |
70 | |
71 | if (!aMakeCirc.IsDone()) { |
72 | |
73 | if (anErrorType==gce_ConfusedPoints || |
74 | anErrorType==gce_IntersectionError || |
75 | anErrorType==gce_ColinearPoints) {//modified by NIZNHY-PKV Fri Sep 24 09:54:05 2004ft |
76 | return 2; |
77 | } |
78 | return -1; |
79 | } |
80 | // |
81 | // |
82 | gp_Circ aCirc=aMakeCirc.Value(); |
83 | aR=aCirc.Radius(); |
84 | |
85 | return 0; |
86 | } |
87 | |
88 | //======================================================================= |
89 | //function : PrepareArgs |
90 | //purpose : |
91 | //======================================================================= |
92 | Standard_Integer IntTools::PrepareArgs(BRepAdaptor_Curve& C, |
93 | const Standard_Real Tmax, |
94 | const Standard_Real Tmin, |
95 | const Standard_Integer Discret, |
96 | const Standard_Real Deflection, |
97 | IntTools_CArray1OfReal& anArgs) |
98 | { |
99 | |
100 | TColStd_ListOfReal aPars; |
101 | Standard_Real dt, tCurrent, tNext, aR, anAbsDeflection; |
102 | Standard_Integer ip, i, j, aNbDeflectionPoints, aDiscretBis; |
103 | Standard_Boolean aRFlag; |
104 | |
105 | GeomAbs_CurveType aCurveType; |
106 | aCurveType=C.GetType(); |
107 | |
108 | dt=(Tmax-Tmin)/Discret; |
109 | aRFlag=(dt > 1.e-5); |
110 | for (i=1; i<=Discret; i++) { |
111 | tCurrent=Tmin+(i-1)*dt; |
112 | aPars.Append(tCurrent); |
113 | tNext=tCurrent+dt; |
114 | if (i==Discret) |
115 | tNext=Tmax; |
116 | /////////////////////////////////////////////////// |
117 | if (!aRFlag) { |
118 | continue; |
119 | } |
120 | if (aCurveType==GeomAbs_BSplineCurve|| |
121 | aCurveType==GeomAbs_BezierCurve || |
122 | aCurveType==GeomAbs_Ellipse || |
123 | aCurveType==GeomAbs_OtherCurve) { //modified by NIZNHY-PKV Fri Sep 24 09:52:42 2004ft |
124 | continue; |
125 | } |
126 | // |
127 | ip=IntTools::GetRadius (C, tCurrent, tNext, aR); |
128 | if (ip<0) { |
129 | return 1; |
130 | } |
131 | // |
132 | if (!ip) { |
133 | anAbsDeflection=Deflection*aR; |
134 | GCPnts_QuasiUniformDeflection anUD; |
135 | anUD.Initialize (C, anAbsDeflection, tCurrent, tNext); |
136 | if (!anUD.IsDone()) { |
137 | return 2; |
138 | } |
139 | |
140 | aNbDeflectionPoints=anUD.NbPoints(); |
141 | if (aNbDeflectionPoints > 2) { |
142 | aNbDeflectionPoints--; |
143 | for (j=2; j<=aNbDeflectionPoints; j++) { |
144 | tCurrent=anUD.Parameter(j); |
145 | aPars.Append(tCurrent); |
146 | } |
147 | } |
148 | } |
149 | } |
150 | |
151 | aPars.Append(Tmax); |
152 | aDiscretBis=aPars.Extent(); |
153 | anArgs.Resize(aDiscretBis); |
154 | TColStd_ListIteratorOfListOfReal anIt(aPars); |
155 | for (i=0; anIt.More(); anIt.Next(), i++) { |
156 | anArgs(i)=anIt.Value(); |
157 | } |
158 | return 0; |
159 | } |
160 | |
161 | //======================================================================= |
162 | //function : IntTools::Length |
163 | //purpose : |
164 | //======================================================================= |
165 | Standard_Real IntTools::Length (const TopoDS_Edge& anEdge) |
166 | { |
167 | Standard_Real aLength=0; |
168 | |
169 | if (!BRep_Tool::Degenerated(anEdge) && |
170 | BRep_Tool::IsGeometric(anEdge)) { |
171 | |
172 | GProp_GProps Temp; |
173 | BRepGProp::LinearProperties(anEdge, Temp); |
174 | aLength = Temp.Mass(); |
175 | } |
176 | return aLength; |
177 | } |
178 | |
179 | //======================================================================= |
180 | //function : RemoveIdenticalRoots |
181 | //purpose : |
182 | //======================================================================= |
183 | void IntTools::RemoveIdenticalRoots(IntTools_SequenceOfRoots& aSR, |
184 | const Standard_Real anEpsT) |
185 | { |
186 | Standard_Integer aNbRoots, j, k; |
187 | Standard_Real anEpsT2=0.5*anEpsT; |
188 | aNbRoots=aSR.Length(); |
189 | for (j=1; j<=aNbRoots; j++) { |
190 | const IntTools_Root& aRj=aSR(j); |
191 | for (k=j+1; k<=aNbRoots; k++) { |
192 | const IntTools_Root& aRk=aSR(k); |
193 | if (fabs (aRj.Root()-aRk.Root()) < anEpsT2) { |
194 | aSR.Remove(k); |
195 | aNbRoots=aSR.Length(); |
196 | } |
197 | } |
198 | } |
199 | } |
200 | |
e35db416 |
201 | //======================================================================= |
202 | |
203 | namespace { |
204 | // Auxiliary: comparator function for sorting roots |
205 | bool IntTools_RootComparator (const IntTools_Root& theLeft, const IntTools_Root& theRight) |
206 | { |
207 | return theLeft.Root() < theRight.Root(); |
208 | } |
209 | }; |
210 | |
7fd59977 |
211 | //======================================================================= |
212 | //function : SortRoots |
213 | //purpose : |
214 | //======================================================================= |
215 | void IntTools::SortRoots(IntTools_SequenceOfRoots& mySequenceOfRoots, |
e35db416 |
216 | const Standard_Real /*myEpsT*/) |
7fd59977 |
217 | { |
218 | Standard_Integer j, aNbRoots; |
219 | |
220 | aNbRoots=mySequenceOfRoots.Length(); |
221 | |
e35db416 |
222 | IntTools_Array1OfRoots anArray1OfRoots(1, aNbRoots); |
7fd59977 |
223 | for (j=1; j<=aNbRoots; j++) { |
224 | anArray1OfRoots(j)=mySequenceOfRoots(j); |
225 | } |
226 | |
e35db416 |
227 | std::sort (anArray1OfRoots.begin(), anArray1OfRoots.end(), IntTools_RootComparator); |
7fd59977 |
228 | |
229 | mySequenceOfRoots.Clear(); |
230 | for (j=1; j<=aNbRoots; j++) { |
231 | mySequenceOfRoots.Append(anArray1OfRoots(j)); |
232 | } |
233 | } |
234 | //======================================================================= |
235 | //function :FindRootStates |
236 | //purpose : |
237 | //======================================================================= |
238 | void IntTools::FindRootStates(IntTools_SequenceOfRoots& mySequenceOfRoots, |
239 | const Standard_Real myEpsNull) |
240 | { |
241 | Standard_Integer aType, j, aNbRoots; |
96a95605 |
242 | Standard_Real t1, t2, f1, f2, absf2; |
7fd59977 |
243 | |
244 | aNbRoots=mySequenceOfRoots.Length(); |
245 | |
246 | for (j=1; j<=aNbRoots; j++) { |
247 | IntTools_Root& aR=mySequenceOfRoots.ChangeValue(j); |
248 | |
7fd59977 |
249 | aR.Interval (t1, t2, f1, f2); |
250 | |
251 | aType=aR.Type(); |
252 | switch (aType) { |
253 | case 0: // Simple Root |
254 | if (f1>0. && f2<0.) { |
255 | aR.SetStateBefore(TopAbs_OUT); |
256 | aR.SetStateAfter (TopAbs_IN); |
257 | } |
258 | else { |
259 | aR.SetStateBefore(TopAbs_IN); |
260 | aR.SetStateAfter (TopAbs_OUT); |
261 | } |
262 | break; |
263 | |
264 | case 1: // Complete 0; |
265 | aR.SetStateBefore(TopAbs_ON); |
266 | aR.SetStateAfter (TopAbs_ON); |
267 | break; |
268 | |
269 | case 2: // Smart; |
7fd59977 |
270 | absf2=fabs(f2); |
271 | if (absf2 < myEpsNull) { |
272 | aR.SetStateAfter (TopAbs_ON); |
273 | if (f1>0.) { |
274 | aR.SetStateBefore(TopAbs_OUT); |
275 | } |
276 | else { |
277 | aR.SetStateBefore(TopAbs_IN); |
278 | } |
279 | } |
280 | |
281 | else { |
282 | aR.SetStateBefore(TopAbs_ON); |
283 | if (f2>0.) { |
284 | aR.SetStateAfter (TopAbs_OUT); |
285 | } |
286 | else { |
287 | aR.SetStateAfter (TopAbs_IN); |
288 | } |
289 | } |
290 | |
291 | default: break; |
292 | } // switch (aType) |
293 | } |
294 | } |
295 | |
296 | #include <GeomAdaptor_Curve.hxx> |
297 | #include <gp_Pnt.hxx> |
298 | #include <ElCLib.hxx> |
299 | #include <gp_Lin.hxx> |
300 | #include <gp_Circ.hxx> |
301 | #include <gp_Elips.hxx> |
302 | #include <gp_Hypr.hxx> |
303 | #include <gp_Parab.hxx> |
304 | #include <GeomAPI_ProjectPointOnCurve.hxx> |
305 | |
306 | //======================================================================= |
307 | //function :Parameter |
308 | //purpose : |
309 | //======================================================================= |
310 | Standard_Integer IntTools::Parameter (const gp_Pnt& aP, |
311 | const Handle(Geom_Curve)& aCurve, |
312 | Standard_Real& aParameter) |
313 | { |
314 | Standard_Real aFirst, aLast; |
315 | GeomAbs_CurveType aCurveType; |
316 | |
317 | aFirst=aCurve->FirstParameter(); |
318 | aLast =aCurve->LastParameter (); |
319 | |
320 | GeomAdaptor_Curve aGAC; |
321 | |
322 | aGAC.Load (aCurve, aFirst, aLast); |
323 | |
324 | aCurveType=aGAC.GetType(); |
325 | |
326 | switch (aCurveType){ |
327 | |
328 | case GeomAbs_Line: |
329 | { |
330 | gp_Lin aLin=aGAC.Line(); |
331 | aParameter=ElCLib::Parameter (aLin, aP); |
332 | return 0; |
333 | } |
334 | case GeomAbs_Circle: |
335 | { |
336 | gp_Circ aCircle=aGAC.Circle(); |
337 | aParameter=ElCLib::Parameter (aCircle, aP); |
338 | return 0; |
339 | } |
340 | case GeomAbs_Ellipse: |
341 | { |
342 | gp_Elips aElips=aGAC.Ellipse(); |
343 | aParameter=ElCLib::Parameter (aElips, aP); |
344 | return 0; |
345 | } |
346 | case GeomAbs_Hyperbola: |
347 | { |
348 | gp_Hypr aHypr=aGAC.Hyperbola(); |
349 | aParameter=ElCLib::Parameter (aHypr, aP); |
350 | return 0; |
351 | } |
352 | case GeomAbs_Parabola: |
353 | { |
354 | gp_Parab aParab=aGAC.Parabola(); |
355 | aParameter=ElCLib::Parameter (aParab, aP); |
356 | return 0; |
357 | } |
358 | |
359 | case GeomAbs_BezierCurve: |
360 | case GeomAbs_BSplineCurve: |
361 | { |
362 | GeomAPI_ProjectPointOnCurve aProjector; |
363 | |
364 | aProjector.Init(aP, aCurve, aFirst, aLast); |
365 | Standard_Integer aNbPoints=aProjector.NbPoints(); |
366 | if (aNbPoints) { |
367 | aParameter=aProjector.LowerDistanceParameter(); |
368 | return 0; |
369 | } |
370 | else { |
371 | return 2; |
372 | } |
7fd59977 |
373 | } |
374 | default: |
375 | break; |
376 | } |
377 | return 1; |
378 | } |
379 | |
380 | #ifdef WNT |
381 | #pragma warning ( default : 4101 ) |
382 | #endif |