projects / occt.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
0025194: It is necessary to orthogonalize transformation matrix in gp_Trsf and gp_Trs...
[occt.git] / src / GeomFill / GeomFill_Sweep.cxx
CommitLineData
b311480e 1// Created on: 1997-11-21
2// Created by: Philippe MANGIN
3// Copyright (c) 1997-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// Modified by skv - Fri Feb 6 11:44:48 2004 OCC5073
18
19#include <GeomFill_Sweep.ixx>
20#include <GeomFill_SweepFunction.hxx>
21#include <GeomFill_LocFunction.hxx>
22
23#include <Standard_ErrorHandler.hxx>
24
25#include <gp_Pnt2d.hxx>
26#include <gp_Dir2d.hxx>
27#include <gp_Pnt.hxx>
28#include <gp_Dir.hxx>
29#include <gp_Lin.hxx>
30#include <gp_Circ.hxx>
31#include <gp_GTrsf.hxx>
32#include <gp_Mat.hxx>
33#include <gp_Ax2.hxx>
9ba2c30f 34#include <gp_Sphere.hxx>
7fd59977 35
36#include <TColgp_Array1OfPnt.hxx>
37#include <TColgp_Array2OfPnt.hxx>
38#include <TColgp_HArray2OfPnt.hxx>
39//#include <GeomLib_Array1OfMat.hxx>
40#include <TColStd_Array1OfInteger.hxx>
41#include <TColStd_Array1OfReal.hxx>
42#include <TColStd_Array2OfReal.hxx>
43
44#include <GeomAbs_CurveType.hxx>
45#include <GeomAdaptor_Curve.hxx>
46#include <GeomLib.hxx>
47
48#include <Geom2d_Line.hxx>
49#include <Geom2d_BSplineCurve.hxx>
50#include <Geom2d_TrimmedCurve.hxx>
51
52#include <Geom_Circle.hxx>
53#include <Geom_Line.hxx>
54#include <Geom_BSplineSurface.hxx>
55#include <Geom_Plane.hxx>
56#include <Geom_SurfaceOfLinearExtrusion.hxx>
57#include <Geom_CylindricalSurface.hxx>
58#include <Geom_ConicalSurface.hxx>
59#include <Geom_ToroidalSurface.hxx>
60#include <Geom_SphericalSurface.hxx>
61#include <Geom_SurfaceOfRevolution.hxx>
62#include <Geom_RectangularTrimmedSurface.hxx>
9ba2c30f 63#include <Geom_TrimmedCurve.hxx>
7fd59977 64
65#include <Approx_SweepApproximation.hxx>
66#include <AdvApprox_PrefAndRec.hxx>
67#include <AdvApprox_ApproxAFunction.hxx>
a31abc03 68#include <GeomConvert_ApproxSurface.hxx>
7fd59977 69
70#include <Precision.hxx>
71#include <ElCLib.hxx>
9ba2c30f 72#include <ElSLib.hxx>
7fd59977 73
74//=======================================================================
75//class : GeomFill_Sweep_Eval
76//purpose: The evaluator for curve approximation
77//=======================================================================
78
79class GeomFill_Sweep_Eval : public AdvApprox_EvaluatorFunction
80{
81 public:
82 GeomFill_Sweep_Eval (GeomFill_LocFunction& theTool)
83 : theAncore(theTool) {}
84
85 virtual void Evaluate (Standard_Integer *Dimension,
86 Standard_Real StartEnd[2],
87 Standard_Real *Parameter,
88 Standard_Integer *DerivativeRequest,
89 Standard_Real *Result, // [Dimension]
90 Standard_Integer *ErrorCode);
91
92 private:
93 GeomFill_LocFunction& theAncore;
94};
95
96void GeomFill_Sweep_Eval::Evaluate (Standard_Integer *,/*Dimension*/
97 Standard_Real StartEnd[2],
98 Standard_Real *Parameter,
99 Standard_Integer *DerivativeRequest,
100 Standard_Real *Result,// [Dimension]
101 Standard_Integer *ErrorCode)
102{
103 theAncore.DN (*Parameter,
104 StartEnd[0],
105 StartEnd[1],
106 *DerivativeRequest,
107 Result[0],
108 ErrorCode[0]);
109}
110
111//===============================================================
112// Function : Create
113// Purpose :
114//===============================================================
115GeomFill_Sweep::GeomFill_Sweep(const Handle(GeomFill_LocationLaw)& Location,
116 const Standard_Boolean WithKpart)
117{
118 done = Standard_False;
119
120 myLoc = Location;
121 myKPart = WithKpart;
122 SetTolerance(1.e-4);
a31abc03 123 myForceApproxC1 = Standard_False;
7fd59977 124
125 myLoc->GetDomain(First, Last);
126 SFirst = SLast = 30.081996;
127 SError = RealLast();
128}
129
130//===============================================================
131// Function : SetDomain
132// Purpose :
133//===============================================================
134 void GeomFill_Sweep::SetDomain(const Standard_Real LocFirst,
135 const Standard_Real LocLast,
136 const Standard_Real SectionFirst,
137 const Standard_Real SectionLast)
138{
139 First = LocFirst;
140 Last = LocLast;
141 SFirst = SectionFirst;
142 SLast = SectionLast;
143}
144
145//===============================================================
146// Function : SetTolerance
147// Purpose :
148//===============================================================
149 void GeomFill_Sweep::SetTolerance(const Standard_Real Tolerance3d,
150 const Standard_Real BoundTolerance,
151 const Standard_Real Tolerance2d,
152 const Standard_Real ToleranceAngular)
153{
154 Tol3d = Tolerance3d;
155 BoundTol = BoundTolerance;
156 Tol2d =Tolerance2d;
157 TolAngular = ToleranceAngular;
158}
159
a31abc03 160//=======================================================================
161//Function : SetForceApproxC1
162//Purpose : Set the flag that indicates attempt to approximate
163// a C1-continuous surface if a swept surface proved
164// to be C0.
165//=======================================================================
166 void GeomFill_Sweep::SetForceApproxC1(const Standard_Boolean ForceApproxC1)
167{
168 myForceApproxC1 = ForceApproxC1;
169}
170
171
7fd59977 172//===============================================================
173// Function : ExchangeUV
174// Purpose :
175//===============================================================
176 Standard_Boolean GeomFill_Sweep::ExchangeUV() const
177{
178 return myExchUV;
179}
180
181//===============================================================
182// Function : UReversed
183// Purpose :
184//===============================================================
185 Standard_Boolean GeomFill_Sweep::UReversed() const
186{
187 return isUReversed;
188}
189
190//===============================================================
191// Function : VReversed
192// Purpose :
193//===============================================================
194 Standard_Boolean GeomFill_Sweep::VReversed() const
195{
196 return isVReversed;
197}
198
199//===============================================================
200// Function : Build
201// Purpose :
202//===============================================================
203 void GeomFill_Sweep::Build(const Handle(GeomFill_SectionLaw)& Section,
204 const GeomFill_ApproxStyle Methode,
205 const GeomAbs_Shape Continuity,
206 const Standard_Integer Degmax,
207 const Standard_Integer Segmax)
208{
209 // Inits
210 done = Standard_False;
211 myExchUV = Standard_False;
212 isUReversed = isVReversed = Standard_False;
213 mySec = Section;
214
215 if ((SFirst == SLast) && (SLast == 30.081996)) {
216 mySec->GetDomain(SFirst, SLast);
217 }
218
219 Standard_Boolean isKPart = Standard_False,
220 isProduct = Standard_False;
221
222 // Traitement des KPart
223 if (myKPart) isKPart = BuildKPart();
224
225 // Traitement des produits Formelles
226 if ((!isKPart) && (Methode == GeomFill_Location)) {
227 Handle(Geom_BSplineSurface) BS;
228 BS = mySec->BSplineSurface();
229 if (! BS.IsNull()) {
230 // Approx de la loi
231// isProduct = BuildProduct(Continuity, Degmax, Segmax);
232 }
233 }
234
235 if (isKPart || isProduct) {
236 // Approx du 2d
237 done = Build2d(Continuity, Degmax, Segmax);
238 }
239 else {
240 // Approx globale
241 done = BuildAll(Continuity, Degmax, Segmax);
242 }
243}
244
245//===============================================================
246// Function ::Build2d
247// Purpose :A venir...
248//===============================================================
249// Standard_Boolean GeomFill_Sweep::Build2d(const GeomAbs_Shape Continuity,
250 Standard_Boolean GeomFill_Sweep::Build2d(const GeomAbs_Shape ,
251// const Standard_Integer Degmax,
252 const Standard_Integer ,
253// const Standard_Integer Segmax)
254 const Standard_Integer )
255{
256 Standard_Boolean Ok = Standard_False;
257 if (myLoc->Nb2dCurves() == 0) {
258 Ok = Standard_True;
259 }
260 return Ok;
261}
262
263//===============================================================
264// Function : BuildAll
265// Purpose :
266//===============================================================
267 Standard_Boolean GeomFill_Sweep::BuildAll(const GeomAbs_Shape Continuity,
268 const Standard_Integer Degmax,
269 const Standard_Integer Segmax)
270{
271 Standard_Boolean Ok = Standard_False;
7fd59977 272
273 Handle(GeomFill_SweepFunction) Func
274 = new (GeomFill_SweepFunction) (mySec, myLoc, First, SFirst,
275 (SLast-SFirst)/(Last-First) );
276 Approx_SweepApproximation Approx( Func );
277
278 Approx.Perform(First, Last,
279 Tol3d, BoundTol, Tol2d, TolAngular,
280 Continuity, Degmax, Segmax);
281
282 if (Approx.IsDone()) {
283 Ok = Standard_True;
284
285#if DEB
286 Approx.Dump(cout);
287#endif
288
289 // La surface
290 Standard_Integer UDegree,VDegree,NbUPoles,
291 NbVPoles,NbUKnots,NbVKnots;
292 Approx.SurfShape(UDegree,VDegree,NbUPoles,
293 NbVPoles,NbUKnots,NbVKnots);
294
295 TColgp_Array2OfPnt Poles(1,NbUPoles, 1,NbVPoles);
296 TColStd_Array2OfReal Weights(1,NbUPoles, 1,NbVPoles);
297 TColStd_Array1OfReal UKnots(1, NbUKnots),VKnots(1, NbVKnots);
298 TColStd_Array1OfInteger UMults(1, NbUKnots), VMults(1, NbVKnots);
299
300 Approx.Surface(Poles, Weights,
301 UKnots,VKnots,
302 UMults,VMults);
303
304 mySurface = new (Geom_BSplineSurface)
305 (Poles, Weights,
306 UKnots,VKnots,
307 UMults,VMults,
308 Approx.UDegree(), Approx.VDegree(),
309 mySec->IsUPeriodic());
310 SError = Approx. MaxErrorOnSurf();
a31abc03 311
312 if (myForceApproxC1 && !mySurface->IsCNv(1))
313 {
314 Standard_Real theTol = 1.e-4;
315 GeomAbs_Shape theUCont = GeomAbs_C1, theVCont = GeomAbs_C1;
316 Standard_Integer degU = 14, degV = 14;
317 Standard_Integer nmax = 16;
318 Standard_Integer thePrec = 1;
319
320 GeomConvert_ApproxSurface ConvertApprox(mySurface,theTol,theUCont,theVCont,
321 degU,degV,nmax,thePrec);
322 if (ConvertApprox.HasResult())
323 {
324 mySurface = ConvertApprox.Surface();
325 myCurve2d = new (TColGeom2d_HArray1OfCurve) (1, 2);
326 CError = new (TColStd_HArray2OfReal) (1,2, 1,2);
327
328 const Handle(Geom_BSplineSurface)& BSplSurf =
329 Handle(Geom_BSplineSurface)::DownCast(mySurface);
330
331 gp_Dir2d D(0., 1.);
332 gp_Pnt2d P(BSplSurf->UKnot(1), 0);
333 Handle(Geom2d_Line) LC1 = new (Geom2d_Line) (P, D);
334 Handle(Geom2d_TrimmedCurve) TC1 =
335 new (Geom2d_TrimmedCurve) (LC1, 0, BSplSurf->VKnot(BSplSurf->NbVKnots()));
336
337 myCurve2d->SetValue(1, TC1);
338 CError->SetValue(1, 1, 0.);
339 CError->SetValue(2, 1, 0.);
340
341 P.SetCoord(BSplSurf->UKnot(BSplSurf->NbUKnots()), 0);
342 Handle(Geom2d_Line) LC2 = new (Geom2d_Line) (P, D);
343 Handle(Geom2d_TrimmedCurve) TC2 =
344 new (Geom2d_TrimmedCurve) (LC2, 0, BSplSurf->VKnot(BSplSurf->NbVKnots()));
345
346 myCurve2d->SetValue(myCurve2d->Length(), TC2);
347 CError->SetValue(1, myCurve2d->Length(), 0.);
348 CError->SetValue(2, myCurve2d->Length(), 0.);
349
350 SError = theTol;
351 }
352 } //if (!mySurface->IsCNv(1))
7fd59977 353
354 // Les Courbes 2d
a31abc03 355 if (myCurve2d.IsNull())
356 {
357 myCurve2d = new (TColGeom2d_HArray1OfCurve) (1, 2+myLoc->TraceNumber());
358 CError = new (TColStd_HArray2OfReal) (1,2, 1, 2+myLoc->TraceNumber());
359 Standard_Integer kk,ii, ifin = 1, ideb;
360
361 if (myLoc->HasFirstRestriction()) {
362 ideb = 1;
363 }
364 else {
365 ideb = 2;
366 }
367 ifin += myLoc->TraceNumber();
368 if (myLoc->HasLastRestriction()) ifin++;
369
370 for (ii=ideb, kk=1; ii<=ifin; ii++, kk++) {
371 Handle(Geom2d_BSplineCurve) C
372 = new (Geom2d_BSplineCurve) (Approx.Curve2dPoles(kk),
373 Approx.Curves2dKnots(),
374 Approx.Curves2dMults(),
375 Approx.Curves2dDegree());
376 myCurve2d->SetValue(ii, C);
377 CError->SetValue(1, ii, Approx.Max2dError(kk));
378 CError->SetValue(2, ii, Approx.Max2dError(kk));
379 }
380
381 // Si les courbes de restriction, ne sont pas calcules, on prend
382 // les iso Bords.
383 if (! myLoc->HasFirstRestriction()) {
384 gp_Dir2d D(0., 1.);
385 gp_Pnt2d P(UKnots(UKnots.Lower()), 0);
386 Handle(Geom2d_Line) LC = new (Geom2d_Line) (P, D);
387 Handle(Geom2d_TrimmedCurve) TC = new (Geom2d_TrimmedCurve)
388 (LC, First, Last);
389
390 myCurve2d->SetValue(1, TC);
391 CError->SetValue(1, 1, 0.);
392 CError->SetValue(2, 1, 0.);
393 }
394
395 if (! myLoc->HasLastRestriction()) {
396 gp_Dir2d D(0., 1.);
397 gp_Pnt2d P(UKnots(UKnots.Upper()), 0);
398 Handle(Geom2d_Line) LC = new (Geom2d_Line) (P, D);
399 Handle(Geom2d_TrimmedCurve) TC =
400 new (Geom2d_TrimmedCurve) (LC, First, Last);
401 myCurve2d->SetValue(myCurve2d->Length(), TC);
402 CError->SetValue(1, myCurve2d->Length(), 0.);
403 CError->SetValue(2, myCurve2d->Length(), 0.);
404 }
405 } //if (myCurve2d.IsNull())
7fd59977 406 }
407 return Ok;
408}
409
410//===============================================================
411// Function : BuildProduct
412// Purpose : A venir...
413//===============================================================
414 Standard_Boolean GeomFill_Sweep::BuildProduct(const GeomAbs_Shape Continuity,
415 const Standard_Integer Degmax,
416 const Standard_Integer Segmax)
417{
418 Standard_Boolean Ok = Standard_False;
419
420 Handle(Geom_BSplineSurface) BSurf;
421 BSurf = Handle(Geom_BSplineSurface)::DownCast(
422 mySec->BSplineSurface()->Copy());
423 if (BSurf.IsNull()) return Ok; // Ce mode de construction est impossible
424
425
426 Standard_Integer NbIntervalC2, NbIntervalC3;
427 GeomFill_LocFunction Func(myLoc);
428
429 NbIntervalC2 = myLoc->NbIntervals(GeomAbs_C2);
430 NbIntervalC3 = myLoc->NbIntervals(GeomAbs_C3);
431 TColStd_Array1OfReal Param_de_decoupeC2 (1, NbIntervalC2+1);
432 myLoc->Intervals(Param_de_decoupeC2, GeomAbs_C2);
433 TColStd_Array1OfReal Param_de_decoupeC3 (1, NbIntervalC3+1);
434 myLoc->Intervals(Param_de_decoupeC3, GeomAbs_C3);
435
436
437 AdvApprox_PrefAndRec Preferentiel(Param_de_decoupeC2,
438 Param_de_decoupeC3);
439
440 Handle(TColStd_HArray1OfReal) ThreeDTol = new (TColStd_HArray1OfReal) (1,4);
441 ThreeDTol->Init(Tol3d); // A Affiner...
442
443 GeomFill_Sweep_Eval eval (Func);
444 AdvApprox_ApproxAFunction Approx(0, 0, 4,
445 ThreeDTol,
446 ThreeDTol,
447 ThreeDTol,
448 First,
449 Last,
450 Continuity,
451 Degmax,
452 Segmax,
453 eval,
454 Preferentiel);
455#if DEB
456 Approx.Dump(cout);
457#endif
458
459 Ok = Approx.HasResult();
460 if (Ok) {
461/* TColgp_Array1OfMat TM(1, nbpoles);
462 Handle(TColgp_HArray2OfPnt) ResPoles;
463 ResPoles = Approx.Poles();
464
465 // Produit Tensoriel
466 for (ii=1; ii<=nbpoles; ii++) {
467 TM(ii).SetCols(ResPoles->Value(ii,2).XYZ(),
468 ResPoles->Value(ii,3).XYZ(),
469 ResPoles->Value(ii,4).XYZ());
470 TR(ii) = ResPoles->Value(ii,1);
471 }
472 GeomLib::TensorialProduct(BSurf, TM, TR,
473 Approx.Knots()->Array1(),
474 Approx.Multiplicities()->Array1());
475
476 // Somme
477 TColgp_Array1OfPnt TPoles(1, nbpoles);
478 for (ii=1; ii<=nbpoles; ii++) {
479 TPoles(ii) = ResPoles->Value(ii,1);
480 }
481 Handle(Geom_BsplineCurve) BS =
482 new (Geom_BsplineCurve) (Poles,
483 Approx.Knots()->Array1(),
484 Approx.Multiplicities()->Array1(),
485 Approx.Degree());
486 for (ii=1; ii<=BSurf->NbVKnots(); ii++)
487 BS->InsertKnot( BSurf->VKnot(ii),
488 BSurf->VMultiplicity(ii),
489 Precision::Confusion());
490 TColgp_Array2OfPnt SurfPoles (1, BSurf->NbUPoles());
491 for (ii=1;
492
493*/
494 mySurface = BSurf;
495 }
496 return Ok;
497}
498
499// Modified by skv - Thu Feb 5 18:05:03 2004 OCC5073 Begin
500// Conditions:
501// * theSec should be constant
502// * the type of section should be a line
503// * theLoc should represent a translation.
504
505static Standard_Boolean IsSweepParallelSpine (const Handle(GeomFill_LocationLaw) &theLoc,
506 const Handle(GeomFill_SectionLaw) &theSec,
507 const Standard_Real theTol)
508{
509 // Get the first and last transformations of the location
510 Standard_Real aFirst;
511 Standard_Real aLast;
512 gp_Vec VBegin;
513 gp_Vec VEnd;
514 gp_Mat M;
515 gp_GTrsf GTfBegin;
516 gp_Trsf TfBegin;
517 gp_GTrsf GTfEnd;
518 gp_Trsf TfEnd;
519
520 theLoc->GetDomain(aFirst, aLast);
521
522// Get the first transformation
523 theLoc->D0(aFirst, M, VBegin);
524
525 GTfBegin.SetVectorialPart(M);
526 GTfBegin.SetTranslationPart(VBegin.XYZ());
527
528 TfBegin.SetValues(GTfBegin(1,1), GTfBegin(1,2), GTfBegin(1,3), GTfBegin(1,4),
529 GTfBegin(2,1), GTfBegin(2,2), GTfBegin(2,3), GTfBegin(2,4),
7a8c6a36 530 GTfBegin(3,1), GTfBegin(3,2), GTfBegin(3,3), GTfBegin(3,4));
7fd59977 531
532// Get the last transformation
533 theLoc->D0(aLast, M, VEnd);
534
535 GTfEnd.SetVectorialPart(M);
536 GTfEnd.SetTranslationPart(VEnd.XYZ());
537
538 TfEnd.SetValues(GTfEnd(1,1), GTfEnd(1,2), GTfEnd(1,3), GTfEnd(1,4),
539 GTfEnd(2,1), GTfEnd(2,2), GTfEnd(2,3), GTfEnd(2,4),
7a8c6a36 540 GTfEnd(3,1), GTfEnd(3,2), GTfEnd(3,3), GTfEnd(3,4));
7fd59977 541
542 Handle(Geom_Surface) aSurf = theSec->BSplineSurface();
543 Standard_Real Umin;
544 Standard_Real Umax;
545 Standard_Real Vmin;
546 Standard_Real Vmax;
547
548 aSurf->Bounds(Umin, Umax, Vmin, Vmax);
549
550 // Get and transform the first section
551 Handle(Geom_Curve) FirstSection = theSec->ConstantSection();
552 GeomAdaptor_Curve ACFirst(FirstSection);
553
554 Standard_Real UFirst = ACFirst.FirstParameter();
555 gp_Lin L = ACFirst.Line();
556
557 L.Transform(TfBegin);
558
559 // Get and transform the last section
560 Handle(Geom_Curve) aLastSection = aSurf->VIso(Vmax);
561 Standard_Real aFirstParameter = aLastSection->FirstParameter();
562 gp_Pnt aPntLastSec = aLastSection->Value(aFirstParameter);
563
564 aPntLastSec.Transform(TfEnd);
565
566 gp_Pnt aPntFirstSec = ElCLib::Value( UFirst, L );
567 gp_Vec aVecSec( aPntFirstSec, aPntLastSec );
568 gp_Vec aVecSpine = VEnd - VBegin;
569
570 Standard_Boolean isParallel = aVecSec.IsParallel(aVecSpine, theTol);
571
572 return isParallel;
573}
574// Modified by skv - Thu Feb 5 18:05:01 2004 OCC5073 End
575
576//===============================================================
577// Function : BuildKPart
578// Purpose :
579//===============================================================
580 Standard_Boolean GeomFill_Sweep::BuildKPart()
581{
582 Standard_Boolean Ok = Standard_False;
583 Standard_Boolean isUPeriodic = Standard_False;
584 Standard_Boolean isVPeriodic = Standard_False;
585 Standard_Boolean IsTrsf = Standard_True;
586
587 isUPeriodic = mySec->IsUPeriodic();
588 Handle(Geom_Surface) S;
589 GeomAbs_CurveType SectionType;
590 gp_Vec V;
591 gp_Mat M;
592 Standard_Real levier, error = 0 ;
593 Standard_Real UFirst=0, VFirst=First, ULast=0, VLast=Last;
594 Standard_Real Tol = Min (Tol3d, BoundTol);
595
596 // (1) Trajectoire Rectilignes -------------------------
597 if (myLoc->IsTranslation(error)) {
598 // Donne de la translation
599 gp_Vec DP, DS;
600 myLoc->D0(1, M, DS);
601 myLoc->D0(0, M, V);
602 DP = DS - V;
603 DP.Normalize();
604 gp_GTrsf Tf;
605 gp_Trsf Tf2;
606 Tf.SetVectorialPart(M);
607 Tf.SetTranslationPart(V.XYZ());
608 try { // Pas joli mais il n'y as pas d'autre moyens de tester SetValues
609 OCC_CATCH_SIGNALS
610 Tf2.SetValues(Tf(1,1), Tf(1,2), Tf(1,3), Tf(1,4),
611 Tf(2,1), Tf(2,2), Tf(2,3), Tf(2,4),
7a8c6a36 612 Tf(3,1), Tf(3,2), Tf(3,3), Tf(3,4));
7fd59977 613 }
614 catch (Standard_ConstructionError) {
615 IsTrsf = Standard_False;
616 }
617 if (!IsTrsf) {
618 return Standard_False;
619 }
620
621 // (1.1) Cas Extrusion
622 if (mySec->IsConstant(error)) {
623 Handle(Geom_Curve) Section;
624 Section = mySec->ConstantSection();
625 GeomAdaptor_Curve AC(Section);
626 SectionType = AC.GetType();
627 UFirst = AC.FirstParameter();
628 ULast = AC.LastParameter();
629 // (1.1.a) Cas Plan
630 if ( (SectionType == GeomAbs_Line) && IsTrsf) {
631// Modified by skv - Thu Feb 5 11:39:06 2004 OCC5073 Begin
632 if (!IsSweepParallelSpine(myLoc, mySec, Tol))
633 return Standard_False;
634// Modified by skv - Thu Feb 5 11:39:08 2004 OCC5073 End
635 gp_Lin L = AC.Line();
636 L.Transform(Tf2);
637 DS.SetXYZ(L.Position().Direction().XYZ());
638 DS.Normalize();
639 levier = Abs(DS.Dot(DP));
640 SError = error + levier * Abs(Last-First);
641 if (SError <= Tol) {
642 Ok = Standard_True;
643 gp_Ax2 AxisOfPlane (L.Location(), DS^DP, DS);
644 S = new (Geom_Plane) (AxisOfPlane);
645 }
646 else SError = 0.;
647 }
648
649 // (1.1.b) Cas Cylindrique
650 if ( (SectionType == GeomAbs_Circle) && IsTrsf) {
651 gp_Circ C = AC.Circle();
652 C.Transform(Tf2);
653
654 DS.SetXYZ (C.Position().Direction().XYZ());
655 DS.Normalize();
656 levier = Abs(DS.CrossMagnitude(DP)) * C.Radius();
657 SError = levier * Abs(Last - First);
658 if (SError <= Tol) {
659 Ok = Standard_True;
660 gp_Ax3 axe (C.Location(), DP, C.Position().XDirection());
661 S = new (Geom_CylindricalSurface)
662 (axe, C.Radius());
663 if (C.Position().Direction().
664 IsOpposite(axe.Direction(), 0.1) ) {
665 Standard_Real f, l;
666 // L'orientation parametrique est inversee
c6541a0c
D		 667 l = 2*M_PI - UFirst;
668 f = 2*M_PI - ULast;
7fd59977 669 UFirst = f;
670 ULast = l;
671 isUReversed = Standard_True;
672 }
673 }
674 else SError = 0.;
675 }
676
677 // (1.1.c) C'est bien une extrusion
678 if (!Ok) {
679 if (IsTrsf) {
680 Section->Transform(Tf2);
681 S = new (Geom_SurfaceOfLinearExtrusion)
682 (Section, DP);
683 SError = 0.;
684 Ok = Standard_True;
685 }
686 else { // extrusion sur BSpline
687
688 }
689 }
690 }
691
692 // (1.2) Cas conique
693 else if (mySec->IsConicalLaw(error)) {
694
695 gp_Pnt P1, P2, Centre0, Centre1, Centre2;
696 gp_Vec dsection;
697 Handle(Geom_Curve) Section;
698 GeomAdaptor_Curve AC;
699 gp_Circ C;
700 Standard_Real R1, R2;
701
702
703 Section = mySec->CirclSection(SLast);
704 Section->Transform(Tf2);
705 Section->Translate(Last*DP);
706 AC.Load(Section);
707 C = AC.Circle();
708 Centre2 = C.Location();
709 AC.D1(0, P2, dsection);
710 R2 = C.Radius();
711
712 Section = mySec->CirclSection(SFirst);
713 Section->Transform(Tf2);
714 Section->Translate(First*DP);
715 AC.Load(Section);
716 C = AC.Circle();
717 Centre1 = C.Location();
718 P1 = AC.Value(0);
719 R1 = C.Radius();
720
721 Section = mySec->CirclSection(SFirst - First*(SLast-SFirst)/(Last-First));
722 Section->Transform(Tf2);
723 AC.Load(Section);
724 C = AC.Circle();
725 Centre0 = C.Location();
726
727 Standard_Real Angle;
728 gp_Vec N(Centre1, P1);
729 if (N.Magnitude() < 1.e-9) {
730 gp_Vec Bis(Centre2, P2);
731 N = Bis;
732 }
733 gp_Vec L(P1, P2), Dir(Centre1,Centre2);
734
735 Angle = L.Angle(Dir);
c6541a0c 736 if ((Angle > 0.01) && (Angle < M_PI/2-0.01)) {
7fd59977 737 if (R2<R1) Angle = -Angle;
738 SError = error;
739 gp_Ax3 Axis(Centre0, Dir, N);
740 S = new (Geom_ConicalSurface)
741 (Axis, Angle, C.Radius());
742 // Calcul du glissement parametrique
743 VFirst = First / Cos(Angle);
744 VLast = Last / Cos(Angle);
745
746 // Bornes en U
747 UFirst = AC.FirstParameter();
748 ULast = AC.LastParameter();
749 gp_Vec diso;
750 gp_Pnt pbis;
751 S->VIso(VLast)->D1(0, pbis, diso);
752 if (diso.Magnitude()>1.e-9 && dsection.Magnitude()>1.e-9)
753 isUReversed = diso.IsOpposite(dsection, 0.1);
754 if (isUReversed ) {
755 Standard_Real f, l;
756 // L'orientation parametrique est inversee
c6541a0c
D		 757 l = 2*M_PI - UFirst;
758 f = 2*M_PI - ULast;
7fd59977 759 UFirst = f;
760 ULast = l;
761 }
762
763 // C'est un cone
764 Ok = Standard_True;
765 }
766 }
767 }
768
769 // (2) Trajectoire Circulaire
770 if (myLoc->IsRotation(error)) {
771 if (mySec->IsConstant(error)) {
772 // La trajectoire
773 gp_Pnt Centre;
c6541a0c 774 isVPeriodic = (Abs(Last-First -2*M_PI) < 1.e-15);
7fd59977 775 Standard_Real RotRadius;
776 gp_Vec DP, DS, DN;
777 myLoc->D0(0.1, M, DS);
778 myLoc->D0(0, M, V);
779 myLoc->Rotation(Centre);
780
781 DP = DS - V;
782 DS.SetXYZ(V.XYZ() - Centre.XYZ());
783 RotRadius = DS.Magnitude();
784 if (RotRadius > 1.e-15) DS.Normalize();
785 else return Standard_False; // Pas de KPart, rotation degeneree
786 DN = DS ^ DP;
787 DN.Normalize();
788 DP = DN ^ DS;
789 DP.Normalize();
790
791 gp_GTrsf Tf;
792 gp_Trsf Tf2;
793 Tf.SetVectorialPart(M);
794 Tf.SetTranslationPart(V.XYZ());
795// try { // Pas joli mais il n'y as pas d'autre moyens de tester SetValues
796// OCC_CATCH_SIGNALS
797 Tf2.SetValues(Tf(1,1), Tf(1,2), Tf(1,3), Tf(1,4),
798 Tf(2,1), Tf(2,2), Tf(2,3), Tf(2,4),
7a8c6a36 799 Tf(3,1), Tf(3,2), Tf(3,3), Tf(3,4));
7fd59977 800// }
801// catch (Standard_ConstructionError) {
802// IsTrsf = Standard_False;
803// }
804 // La section
805 Handle(Geom_Curve) Section;
806 Section = mySec->ConstantSection();
807 GeomAdaptor_Curve AC(Section);
808 SectionType = AC.GetType();
809 UFirst = AC.FirstParameter();
810 ULast = AC.LastParameter();
811
812 // (2.1) Tore/Sphere ?
813 if ((SectionType == GeomAbs_Circle) && IsTrsf) {
814 gp_Circ C = AC.Circle();
815 Standard_Real Radius;
816 Standard_Boolean IsGoodSide = Standard_True;;
817 C.Transform(Tf2);
818 gp_Vec DC;
819 // On calcul le centre eventuel
820 DC.SetXYZ(C.Location().XYZ() - Centre.XYZ());
821 Centre.ChangeCoord() += (DC.Dot(DN))*DN.XYZ();
822 DC.SetXYZ(C.Location().XYZ() - Centre.XYZ());
823 Radius = DC.Magnitude(); //grand Rayon du tore
824 if ((Radius > Tol) && (DC.Dot(DS) < 0)) IsGoodSide = Standard_False;
825 if (Radius < Tol/100) DC = DS; // Pour definir le tore
826
827 // On verifie d'abord que le plan de la section est // a
828 // l'axe de rotation
829 gp_Vec NC;
830 NC.SetXYZ (C.Position().Direction().XYZ());
831 NC.Normalize();
832 error = Abs(NC.Dot(DN));
833 // Puis on evalue l'erreur commise sur la section,
834 // en pivotant son plan ( pour contenir l'axe de rotation)
835 error += Abs(NC.Dot(DS));
836 error *= C.Radius();
837 if (error <= Tol) {
838 SError = error;
839 error += Radius + Abs(RotRadius - C.Radius())/2;
840 if (error <= Tol) {
841 // (2.1.a) Sphere
842 Standard_Real f = UFirst , l = ULast;
843 SError = error;
844 Centre.BaryCenter(1.0, C.Location(), 1.0);
9ba2c30f 845 gp_Ax3 AxisOfSphere(Centre, DN, DS);
846 gp_Sphere theSphere( AxisOfSphere, (RotRadius + C.Radius())/2 );
847 S = new Geom_SphericalSurface(theSphere);
7fd59977 848 // Pour les spheres on ne peut pas controler le parametre
849 // V (donc U car myExchUV = Standard_True)
850 // Il faut donc modifier UFirst, ULast...
9ba2c30f 851 Standard_Real fpar = AC.FirstParameter();
852 Standard_Real lpar = AC.LastParameter();
853 Handle(Geom_Curve) theSection = new Geom_TrimmedCurve(Section, fpar, lpar);
854 theSection->Transform(Tf2);
855 gp_Pnt FirstPoint = theSection->Value(theSection->FirstParameter());
856 gp_Pnt LastPoint = theSection->Value(theSection->LastParameter());
857 Standard_Real UfirstOnSec, VfirstOnSec, UlastOnSec, VlastOnSec;
858 ElSLib::Parameters(theSphere, FirstPoint, UfirstOnSec, VfirstOnSec);
859 ElSLib::Parameters(theSphere, LastPoint, UlastOnSec, VlastOnSec);
860 if (VfirstOnSec < VlastOnSec)
861 {
862 f = VfirstOnSec;
863 l = VlastOnSec;
864 }
865 else
866 {
7fd59977 867 // L'orientation parametrique est inversee
9ba2c30f 868 f = VlastOnSec;
869 l = VfirstOnSec;
7fd59977 870 isUReversed = Standard_True;
871 }
7fd59977 872
c6541a0c 873 if ( (f >= -M_PI/2) && (l <= M_PI/2)) {
7fd59977 874 Ok = Standard_True;
875 myExchUV = Standard_True;
876 UFirst = f;
877 ULast = l;
878 }
879 else { // On restaure ce qu'il faut
880 isUReversed = Standard_False;
881 }
882 }
883 else if (IsGoodSide) {
884 // (2.1.b) Tore
885 gp_Ax3 AxisOfTore(Centre, DN, DC);
886 S = new (Geom_ToroidalSurface) (AxisOfTore,
887 Radius , C.Radius());
888
889 // Pour les tores on ne peut pas controler le parametre
890 // V (donc U car myExchUV = Standard_True)
891 // Il faut donc modifier UFirst, ULast...
892 Handle(Geom_Circle) Iso;
893 Iso = Handle(Geom_Circle)::DownCast(S->UIso(0.));
894 gp_Ax2 axeiso;
895 axeiso = Iso->Circ().Position();
896
897 if (C.Position().Direction().
898 IsOpposite(axeiso.Direction(), 0.1) ) {
899 Standard_Real f, l;
900 // L'orientation parametrique est inversee
c6541a0c
D		 901 l = 2*M_PI - UFirst;
902 f = 2*M_PI - ULast;
7fd59977 903 UFirst = f;
904 ULast = l;
905 isUReversed = Standard_True;
906 }
907 // On calcul le "glissement" parametrique.
908 Standard_Real rot;
909 rot = C.Position().XDirection().AngleWithRef
910 (axeiso.XDirection(), axeiso.Direction());
911 UFirst -= rot;
912 ULast -= rot;
913
914 myExchUV = Standard_True;
915 // Attention l'arete de couture dans le cas periodique
916 // n'est peut etre pas a la bonne place...
917 if (isUPeriodic && Abs(UFirst)>Precision::PConfusion())
918 isUPeriodic = Standard_False; //Pour trimmer la surface...
919 Ok = Standard_True;
920 }
921 }
922 else {
923 SError = 0.;
924 }
925 }
926 // (2.2) Cone / Cylindre
927 if ((SectionType == GeomAbs_Line) && IsTrsf) {
928 gp_Lin L = AC.Line();
929 L.Transform(Tf2);
930 gp_Vec DL;
931 DL.SetXYZ(L.Direction().XYZ());
932 levier = Max(Abs(AC.FirstParameter()), AC.LastParameter());
933 // si la line est ortogonale au cercle de rotation
934 SError = error + levier * Abs(DL.Dot(DP));
935 if (SError <= Tol) {
936 Standard_Boolean reverse;
937 gp_Lin Dir(Centre, DN);
938 Standard_Real aux;
939 aux = DL.Dot(DN);
940 reverse = (aux < 0); // On choisit ici le sens de parametrisation
941
942 // Calcul du centre du vecteur supportant la "XDirection"
943 gp_Pnt CentreOfSurf;
944 gp_Vec O1O2(Centre, L.Location()), trans;
945 trans = DN;
946 trans *= DN.Dot(O1O2);
947 CentreOfSurf = Centre.Translated(trans);
948 DS.SetXYZ(L.Location().XYZ() - CentreOfSurf.XYZ());
949
950 error = SError;
951 error += (DL.XYZ()).CrossMagnitude(DN.XYZ())*levier;
952 if (error <= Tol) {
953 // (2.2.a) Cylindre
954 // si la line est orthogonale au plan de rotation
955 SError = error;
956 gp_Ax3 Axis(CentreOfSurf, Dir.Direction(), DS);
957 S = new (Geom_CylindricalSurface)
958 (Axis, L.Distance(CentreOfSurf));
959 Ok = Standard_True;
960 myExchUV = Standard_True;
961 }
962 else {
963 // On evalue l'angle du cone
964 Standard_Real Angle = Abs(Dir.Angle(L));
c6541a0c 965 if (Angle > M_PI/2) Angle = M_PI -Angle;
7fd59977 966 if (reverse) Angle = -Angle;
967 aux = DS.Dot(DL);
968 if (aux < 0) {
969 Angle = - Angle;
970 }
c6541a0c 971 if (Abs(Abs(Angle) - M_PI/2) > 0.01) {
7fd59977 972 // (2.2.b) Cone
973 // si les 2 droites ne sont pas orthogonales
974 Standard_Real Radius = CentreOfSurf.Distance(L.Location());
975 gp_Ax3 Axis(CentreOfSurf, Dir.Direction(), DS);
976 S = new (Geom_ConicalSurface)
977 (Axis, Angle, Radius);
978 myExchUV = Standard_True;
979 Ok = Standard_True;
980 }
981 else {
982 // On n'as pas conclue, on remet l'erreur a 0.
983 SError = 0.;
984 }
985 }
986 if (Ok && reverse) {
987 // On reverse le parametre
988 Standard_Real uf, ul;
989 Handle(Geom_Line) CL = new (Geom_Line)(L);
990 uf = CL->ReversedParameter(ULast);
991 ul = CL->ReversedParameter(UFirst);
992 UFirst = uf;
993 ULast = ul;
994 isUReversed = Standard_True;
995 }
996 }
997 else SError = 0.;
998 }
999
1000 // (2.3) Revolution
1001 if (!Ok) {
1002 if (IsTrsf) {
1003 Section->Transform(Tf2);
1004 gp_Ax1 Axis (Centre, DN);
1005 S = new (Geom_SurfaceOfRevolution)
1006 (Section, Axis);
1007 myExchUV = Standard_True;
1008 SError = 0.;
1009 Ok = Standard_True;
1010 }
1011 }
1012 }
1013 }
1014
1015
1016 if (Ok) { // On trimme la surface
1017 if (myExchUV) {
1018 Standard_Boolean b;
1019 b = isUPeriodic; isUPeriodic = isVPeriodic; isVPeriodic = b;
1020 Standard_Real r;
1021 r = UFirst; UFirst = VFirst; VFirst = r;
1022 r = ULast; ULast = VLast; VLast = r;
1023 }
1024
1025 if (!isUPeriodic && !isVPeriodic)
1026 mySurface = new (Geom_RectangularTrimmedSurface)
1027 (S, UFirst, ULast, VFirst, VLast);
1028 else if (isUPeriodic) {
1029 if (isVPeriodic) mySurface = S;
1030 else mySurface = new (Geom_RectangularTrimmedSurface)
1031 (S, VFirst, VLast, Standard_False);
1032 }
1033 else
1034 mySurface = new (Geom_RectangularTrimmedSurface)
1035 (S,UFirst, ULast, Standard_True);
1036
1037#if DEB
1038 if (isUPeriodic && !mySurface->IsUPeriodic())
1039 cout<<"Pb de periodicite en U" << endl;
1040 if (isUPeriodic && !mySurface->IsUClosed())
1041 cout<<"Pb de fermeture en U" << endl;
1042 if (isVPeriodic && !mySurface->IsVPeriodic())
1043 cout << "Pb de periodicite en V" << endl;
1044 if (isVPeriodic && !mySurface->IsVClosed())
1045 cout<<"Pb de fermeture en V" << endl;
1046#endif
1047 }
1048
1049
1050 return Ok;
1051}
1052
1053//===============================================================
1054// Function : IsDone
1055// Purpose :
1056//===============================================================
1057 Standard_Boolean GeomFill_Sweep::IsDone() const
1058{
1059 return done;
1060}
1061
1062//===============================================================
1063// Function :ErrorOnSurface
1064// Purpose :
1065//===============================================================
1066 Standard_Real GeomFill_Sweep::ErrorOnSurface() const
1067{
1068 return SError;
1069}
1070
1071//===============================================================
1072// Function ::ErrorOnRestriction
1073// Purpose :
1074//===============================================================
1075 void GeomFill_Sweep::ErrorOnRestriction(const Standard_Boolean IsFirst,
1076 Standard_Real& UError,
1077 Standard_Real& VError) const
1078{
1079 Standard_Integer ind;
1080 if (IsFirst) ind=1;
1081 else ind = myCurve2d->Length();
1082
1083 UError = CError->Value(1, ind);
1084 VError = CError->Value(2, ind);
1085}
1086
1087//===============================================================
1088// Function :ErrorOnTrace
1089// Purpose :
1090//===============================================================
1091 void GeomFill_Sweep::ErrorOnTrace(const Standard_Integer IndexOfTrace,
1092 Standard_Real& UError,
1093 Standard_Real& VError) const
1094{
1095 Standard_Integer ind = IndexOfTrace+1;
1096 if (IndexOfTrace > myLoc->TraceNumber())
1097 Standard_OutOfRange::Raise(" GeomFill_Sweep::ErrorOnTrace");
1098
1099 UError = CError->Value(1, ind);
1100 VError = CError->Value(2, ind);
1101}
1102
1103//===============================================================
1104// Function :Surface
1105// Purpose :
1106//===============================================================
1107 Handle(Geom_Surface) GeomFill_Sweep::Surface() const
1108{
1109 return mySurface;
1110}
1111
1112//===============================================================
1113// Function ::Restriction
1114// Purpose :
1115//===============================================================
1116 Handle(Geom2d_Curve) GeomFill_Sweep::Restriction(const Standard_Boolean IsFirst) const
1117{
1118 if (IsFirst)
1119 return myCurve2d->Value(1);
1120 return myCurve2d->Value(myCurve2d->Length());
1121
1122}
1123
1124//===============================================================
1125// Function :
1126// Purpose :
1127//===============================================================
1128 Standard_Integer GeomFill_Sweep::NumberOfTrace() const
1129{
1130 return myLoc->TraceNumber();
1131}
1132
1133//===============================================================
1134// Function :
1135// Purpose :
1136//===============================================================
1137 Handle(Geom2d_Curve)
1138 GeomFill_Sweep::Trace(const Standard_Integer IndexOfTrace) const
1139{
1140 Standard_Integer ind = IndexOfTrace+1;
1141 if (IndexOfTrace > myLoc->TraceNumber())
1142 Standard_OutOfRange::Raise(" GeomFill_Sweep::Trace");
1143 return myCurve2d->Value(ind);
1144}
Open CASCADE Technology repository