1 // Created on: 1997-11-21
2 // Created by: Philippe MANGIN
3 // Copyright (c) 1997-1999 Matra Datavision
4 // Copyright (c) 1999-2014 OPEN CASCADE SAS
6 // This file is part of Open CASCADE Technology software library.
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.
14 // Alternatively, this file may be used under the terms of Open CASCADE
15 // commercial license or contractual agreement.
17 // Modified by skv - Fri Feb 6 11:44:48 2004 OCC5073
19 #include <AdvApprox_ApproxAFunction.hxx>
20 #include <AdvApprox_PrefAndRec.hxx>
21 #include <Approx_SweepApproximation.hxx>
24 #include <Geom2d_BSplineCurve.hxx>
25 #include <Geom2d_Curve.hxx>
26 #include <Geom2d_Line.hxx>
27 #include <Geom2d_TrimmedCurve.hxx>
28 #include <Geom_BSplineSurface.hxx>
29 #include <Geom_Circle.hxx>
30 #include <Geom_ConicalSurface.hxx>
31 #include <Geom_CylindricalSurface.hxx>
32 #include <Geom_Line.hxx>
33 #include <Geom_Plane.hxx>
34 #include <Geom_RectangularTrimmedSurface.hxx>
35 #include <Geom_SphericalSurface.hxx>
36 #include <Geom_Surface.hxx>
37 #include <Geom_SurfaceOfLinearExtrusion.hxx>
38 #include <Geom_SurfaceOfRevolution.hxx>
39 #include <Geom_ToroidalSurface.hxx>
40 #include <Geom_TrimmedCurve.hxx>
41 #include <GeomAbs_CurveType.hxx>
42 #include <GeomAdaptor_Curve.hxx>
43 #include <GeomConvert_ApproxSurface.hxx>
44 #include <GeomFill_LocationLaw.hxx>
45 #include <GeomFill_LocFunction.hxx>
46 #include <GeomFill_SectionLaw.hxx>
47 #include <GeomFill_Sweep.hxx>
48 #include <GeomFill_SweepFunction.hxx>
49 #include <GeomLib.hxx>
51 #include <gp_Circ.hxx>
53 #include <gp_Dir2d.hxx>
54 #include <gp_GTrsf.hxx>
58 #include <gp_Pnt2d.hxx>
59 #include <gp_Sphere.hxx>
60 #include <Precision.hxx>
61 #include <Standard_ConstructionError.hxx>
62 #include <Standard_ErrorHandler.hxx>
63 #include <Standard_OutOfRange.hxx>
64 #include <StdFail_NotDone.hxx>
65 #include <TColgp_Array1OfPnt.hxx>
66 #include <TColgp_Array2OfPnt.hxx>
67 #include <TColgp_HArray2OfPnt.hxx>
68 #include <TColStd_Array1OfInteger.hxx>
69 #include <TColStd_Array1OfReal.hxx>
70 #include <TColStd_Array2OfReal.hxx>
72 //#include <GeomLib_Array1OfMat.hxx>
73 //=======================================================================
74 //class : GeomFill_Sweep_Eval
75 //purpose: The evaluator for curve approximation
76 //=======================================================================
77 class GeomFill_Sweep_Eval : public AdvApprox_EvaluatorFunction
80 GeomFill_Sweep_Eval (GeomFill_LocFunction& theTool)
81 : theAncore(theTool) {}
83 virtual void Evaluate (Standard_Integer *Dimension,
84 Standard_Real StartEnd[2],
85 Standard_Real *Parameter,
86 Standard_Integer *DerivativeRequest,
87 Standard_Real *Result, // [Dimension]
88 Standard_Integer *ErrorCode);
91 GeomFill_LocFunction& theAncore;
94 void GeomFill_Sweep_Eval::Evaluate (Standard_Integer *,/*Dimension*/
95 Standard_Real StartEnd[2],
96 Standard_Real *Parameter,
97 Standard_Integer *DerivativeRequest,
98 Standard_Real *Result,// [Dimension]
99 Standard_Integer *ErrorCode)
101 theAncore.DN (*Parameter,
109 //===============================================================
112 //===============================================================
113 GeomFill_Sweep::GeomFill_Sweep(const Handle(GeomFill_LocationLaw)& Location,
114 const Standard_Boolean WithKpart)
116 done = Standard_False;
121 myForceApproxC1 = Standard_False;
123 myLoc->GetDomain(First, Last);
124 SFirst = SLast = 30.081996;
128 //===============================================================
129 // Function : SetDomain
131 //===============================================================
132 void GeomFill_Sweep::SetDomain(const Standard_Real LocFirst,
133 const Standard_Real LocLast,
134 const Standard_Real SectionFirst,
135 const Standard_Real SectionLast)
139 SFirst = SectionFirst;
143 //===============================================================
144 // Function : SetTolerance
146 //===============================================================
147 void GeomFill_Sweep::SetTolerance(const Standard_Real Tolerance3d,
148 const Standard_Real BoundTolerance,
149 const Standard_Real Tolerance2d,
150 const Standard_Real ToleranceAngular)
153 BoundTol = BoundTolerance;
155 TolAngular = ToleranceAngular;
158 //=======================================================================
159 //Function : SetForceApproxC1
160 //Purpose : Set the flag that indicates attempt to approximate
161 // a C1-continuous surface if a swept surface proved
163 //=======================================================================
164 void GeomFill_Sweep::SetForceApproxC1(const Standard_Boolean ForceApproxC1)
166 myForceApproxC1 = ForceApproxC1;
170 //===============================================================
171 // Function : ExchangeUV
173 //===============================================================
174 Standard_Boolean GeomFill_Sweep::ExchangeUV() const
179 //===============================================================
180 // Function : UReversed
182 //===============================================================
183 Standard_Boolean GeomFill_Sweep::UReversed() const
188 //===============================================================
189 // Function : VReversed
191 //===============================================================
192 Standard_Boolean GeomFill_Sweep::VReversed() const
197 //===============================================================
200 //===============================================================
201 void GeomFill_Sweep::Build(const Handle(GeomFill_SectionLaw)& Section,
202 const GeomFill_ApproxStyle Methode,
203 const GeomAbs_Shape Continuity,
204 const Standard_Integer Degmax,
205 const Standard_Integer Segmax)
208 done = Standard_False;
209 myExchUV = Standard_False;
210 isUReversed = isVReversed = Standard_False;
213 if ((SFirst == SLast) && (SLast == 30.081996)) {
214 mySec->GetDomain(SFirst, SLast);
217 Standard_Boolean isKPart = Standard_False,
218 isProduct = Standard_False;
220 // Traitement des KPart
221 if (myKPart) isKPart = BuildKPart();
223 // Traitement des produits Formelles
224 if ((!isKPart) && (Methode == GeomFill_Location)) {
225 Handle(Geom_BSplineSurface) BS;
226 BS = mySec->BSplineSurface();
229 // isProduct = BuildProduct(Continuity, Degmax, Segmax);
233 if (isKPart || isProduct) {
235 done = Build2d(Continuity, Degmax, Segmax);
239 done = BuildAll(Continuity, Degmax, Segmax);
243 //===============================================================
244 // Function ::Build2d
245 // Purpose :A venir...
246 //===============================================================
247 // Standard_Boolean GeomFill_Sweep::Build2d(const GeomAbs_Shape Continuity,
248 Standard_Boolean GeomFill_Sweep::Build2d(const GeomAbs_Shape ,
249 // const Standard_Integer Degmax,
250 const Standard_Integer ,
251 // const Standard_Integer Segmax)
252 const Standard_Integer )
254 Standard_Boolean Ok = Standard_False;
255 if (myLoc->Nb2dCurves() == 0) {
261 //===============================================================
262 // Function : BuildAll
264 //===============================================================
265 Standard_Boolean GeomFill_Sweep::BuildAll(const GeomAbs_Shape Continuity,
266 const Standard_Integer Degmax,
267 const Standard_Integer Segmax)
269 Standard_Boolean Ok = Standard_False;
271 Handle(GeomFill_SweepFunction) Func
272 = new (GeomFill_SweepFunction) (mySec, myLoc, First, SFirst,
273 (SLast-SFirst)/(Last-First) );
274 Approx_SweepApproximation Approx( Func );
276 Approx.Perform(First, Last,
277 Tol3d, BoundTol, Tol2d, TolAngular,
278 Continuity, Degmax, Segmax);
280 if (Approx.IsDone()) {
288 Standard_Integer UDegree,VDegree,NbUPoles,
289 NbVPoles,NbUKnots,NbVKnots;
290 Approx.SurfShape(UDegree,VDegree,NbUPoles,
291 NbVPoles,NbUKnots,NbVKnots);
293 TColgp_Array2OfPnt Poles(1,NbUPoles, 1,NbVPoles);
294 TColStd_Array2OfReal Weights(1,NbUPoles, 1,NbVPoles);
295 TColStd_Array1OfReal UKnots(1, NbUKnots),VKnots(1, NbVKnots);
296 TColStd_Array1OfInteger UMults(1, NbUKnots), VMults(1, NbVKnots);
298 Approx.Surface(Poles, Weights,
302 mySurface = new (Geom_BSplineSurface)
306 Approx.UDegree(), Approx.VDegree(),
307 mySec->IsUPeriodic());
308 SError = Approx. MaxErrorOnSurf();
310 if (myForceApproxC1 && !mySurface->IsCNv(1))
312 Standard_Real theTol = 1.e-4;
313 GeomAbs_Shape theUCont = GeomAbs_C1, theVCont = GeomAbs_C1;
314 Standard_Integer degU = 14, degV = 14;
315 Standard_Integer nmax = 16;
316 Standard_Integer thePrec = 1;
318 GeomConvert_ApproxSurface ConvertApprox(mySurface,theTol,theUCont,theVCont,
319 degU,degV,nmax,thePrec);
320 if (ConvertApprox.HasResult())
322 mySurface = ConvertApprox.Surface();
323 myCurve2d = new (TColGeom2d_HArray1OfCurve) (1, 2);
324 CError = new (TColStd_HArray2OfReal) (1,2, 1,2);
326 Handle(Geom_BSplineSurface) BSplSurf (Handle(Geom_BSplineSurface)::DownCast(mySurface));
329 gp_Pnt2d P(BSplSurf->UKnot(1), 0);
330 Handle(Geom2d_Line) LC1 = new (Geom2d_Line) (P, D);
331 Handle(Geom2d_TrimmedCurve) TC1 =
332 new (Geom2d_TrimmedCurve) (LC1, 0, BSplSurf->VKnot(BSplSurf->NbVKnots()));
334 myCurve2d->SetValue(1, TC1);
335 CError->SetValue(1, 1, 0.);
336 CError->SetValue(2, 1, 0.);
338 P.SetCoord(BSplSurf->UKnot(BSplSurf->NbUKnots()), 0);
339 Handle(Geom2d_Line) LC2 = new (Geom2d_Line) (P, D);
340 Handle(Geom2d_TrimmedCurve) TC2 =
341 new (Geom2d_TrimmedCurve) (LC2, 0, BSplSurf->VKnot(BSplSurf->NbVKnots()));
343 myCurve2d->SetValue(myCurve2d->Length(), TC2);
344 CError->SetValue(1, myCurve2d->Length(), 0.);
345 CError->SetValue(2, myCurve2d->Length(), 0.);
349 } //if (!mySurface->IsCNv(1))
352 if (myCurve2d.IsNull())
354 myCurve2d = new (TColGeom2d_HArray1OfCurve) (1, 2+myLoc->TraceNumber());
355 CError = new (TColStd_HArray2OfReal) (1,2, 1, 2+myLoc->TraceNumber());
356 Standard_Integer kk,ii, ifin = 1, ideb;
358 if (myLoc->HasFirstRestriction()) {
364 ifin += myLoc->TraceNumber();
365 if (myLoc->HasLastRestriction()) ifin++;
367 for (ii=ideb, kk=1; ii<=ifin; ii++, kk++) {
368 Handle(Geom2d_BSplineCurve) C
369 = new (Geom2d_BSplineCurve) (Approx.Curve2dPoles(kk),
370 Approx.Curves2dKnots(),
371 Approx.Curves2dMults(),
372 Approx.Curves2dDegree());
373 myCurve2d->SetValue(ii, C);
374 CError->SetValue(1, ii, Approx.Max2dError(kk));
375 CError->SetValue(2, ii, Approx.Max2dError(kk));
378 // Si les courbes de restriction, ne sont pas calcules, on prend
380 if (! myLoc->HasFirstRestriction()) {
382 gp_Pnt2d P(UKnots(UKnots.Lower()), 0);
383 Handle(Geom2d_Line) LC = new (Geom2d_Line) (P, D);
384 Handle(Geom2d_TrimmedCurve) TC = new (Geom2d_TrimmedCurve)
387 myCurve2d->SetValue(1, TC);
388 CError->SetValue(1, 1, 0.);
389 CError->SetValue(2, 1, 0.);
392 if (! myLoc->HasLastRestriction()) {
394 gp_Pnt2d P(UKnots(UKnots.Upper()), 0);
395 Handle(Geom2d_Line) LC = new (Geom2d_Line) (P, D);
396 Handle(Geom2d_TrimmedCurve) TC =
397 new (Geom2d_TrimmedCurve) (LC, First, Last);
398 myCurve2d->SetValue(myCurve2d->Length(), TC);
399 CError->SetValue(1, myCurve2d->Length(), 0.);
400 CError->SetValue(2, myCurve2d->Length(), 0.);
402 } //if (myCurve2d.IsNull())
407 //===============================================================
408 // Function : BuildProduct
409 // Purpose : A venir...
410 //===============================================================
411 Standard_Boolean GeomFill_Sweep::BuildProduct(const GeomAbs_Shape Continuity,
412 const Standard_Integer Degmax,
413 const Standard_Integer Segmax)
415 Standard_Boolean Ok = Standard_False;
417 Handle(Geom_BSplineSurface) BSurf;
418 BSurf = Handle(Geom_BSplineSurface)::DownCast(
419 mySec->BSplineSurface()->Copy());
420 if (BSurf.IsNull()) return Ok; // Ce mode de construction est impossible
423 Standard_Integer NbIntervalC2, NbIntervalC3;
424 GeomFill_LocFunction Func(myLoc);
426 NbIntervalC2 = myLoc->NbIntervals(GeomAbs_C2);
427 NbIntervalC3 = myLoc->NbIntervals(GeomAbs_C3);
428 TColStd_Array1OfReal Param_de_decoupeC2 (1, NbIntervalC2+1);
429 myLoc->Intervals(Param_de_decoupeC2, GeomAbs_C2);
430 TColStd_Array1OfReal Param_de_decoupeC3 (1, NbIntervalC3+1);
431 myLoc->Intervals(Param_de_decoupeC3, GeomAbs_C3);
434 AdvApprox_PrefAndRec Preferentiel(Param_de_decoupeC2,
437 Handle(TColStd_HArray1OfReal) ThreeDTol = new (TColStd_HArray1OfReal) (1,4);
438 ThreeDTol->Init(Tol3d); // A Affiner...
440 GeomFill_Sweep_Eval eval (Func);
441 AdvApprox_ApproxAFunction Approx(0, 0, 4,
456 Ok = Approx.HasResult();
458 /* TColgp_Array1OfMat TM(1, nbpoles);
459 Handle(TColgp_HArray2OfPnt) ResPoles;
460 ResPoles = Approx.Poles();
463 for (ii=1; ii<=nbpoles; ii++) {
464 TM(ii).SetCols(ResPoles->Value(ii,2).XYZ(),
465 ResPoles->Value(ii,3).XYZ(),
466 ResPoles->Value(ii,4).XYZ());
467 TR(ii) = ResPoles->Value(ii,1);
469 GeomLib::TensorialProduct(BSurf, TM, TR,
470 Approx.Knots()->Array1(),
471 Approx.Multiplicities()->Array1());
474 TColgp_Array1OfPnt TPoles(1, nbpoles);
475 for (ii=1; ii<=nbpoles; ii++) {
476 TPoles(ii) = ResPoles->Value(ii,1);
478 Handle(Geom_BsplineCurve) BS =
479 new (Geom_BsplineCurve) (Poles,
480 Approx.Knots()->Array1(),
481 Approx.Multiplicities()->Array1(),
483 for (ii=1; ii<=BSurf->NbVKnots(); ii++)
484 BS->InsertKnot( BSurf->VKnot(ii),
485 BSurf->VMultiplicity(ii),
486 Precision::Confusion());
487 TColgp_Array2OfPnt SurfPoles (1, BSurf->NbUPoles());
496 // Modified by skv - Thu Feb 5 18:05:03 2004 OCC5073 Begin
498 // * theSec should be constant
499 // * the type of section should be a line
500 // * theLoc should represent a translation.
502 static Standard_Boolean IsSweepParallelSpine (const Handle(GeomFill_LocationLaw) &theLoc,
503 const Handle(GeomFill_SectionLaw) &theSec,
504 const Standard_Real theTol)
506 // Get the first and last transformations of the location
507 Standard_Real aFirst;
517 theLoc->GetDomain(aFirst, aLast);
519 // Get the first transformation
520 theLoc->D0(aFirst, M, VBegin);
522 GTfBegin.SetVectorialPart(M);
523 GTfBegin.SetTranslationPart(VBegin.XYZ());
525 TfBegin.SetValues(GTfBegin(1,1), GTfBegin(1,2), GTfBegin(1,3), GTfBegin(1,4),
526 GTfBegin(2,1), GTfBegin(2,2), GTfBegin(2,3), GTfBegin(2,4),
527 GTfBegin(3,1), GTfBegin(3,2), GTfBegin(3,3), GTfBegin(3,4));
529 // Get the last transformation
530 theLoc->D0(aLast, M, VEnd);
532 GTfEnd.SetVectorialPart(M);
533 GTfEnd.SetTranslationPart(VEnd.XYZ());
535 TfEnd.SetValues(GTfEnd(1,1), GTfEnd(1,2), GTfEnd(1,3), GTfEnd(1,4),
536 GTfEnd(2,1), GTfEnd(2,2), GTfEnd(2,3), GTfEnd(2,4),
537 GTfEnd(3,1), GTfEnd(3,2), GTfEnd(3,3), GTfEnd(3,4));
539 Handle(Geom_Surface) aSurf = theSec->BSplineSurface();
545 aSurf->Bounds(Umin, Umax, Vmin, Vmax);
547 // Get and transform the first section
548 Handle(Geom_Curve) FirstSection = theSec->ConstantSection();
549 GeomAdaptor_Curve ACFirst(FirstSection);
551 Standard_Real UFirst = ACFirst.FirstParameter();
552 gp_Lin L = ACFirst.Line();
554 L.Transform(TfBegin);
556 // Get and transform the last section
557 Handle(Geom_Curve) aLastSection = aSurf->VIso(Vmax);
558 Standard_Real aFirstParameter = aLastSection->FirstParameter();
559 gp_Pnt aPntLastSec = aLastSection->Value(aFirstParameter);
561 aPntLastSec.Transform(TfEnd);
563 gp_Pnt aPntFirstSec = ElCLib::Value( UFirst, L );
564 gp_Vec aVecSec( aPntFirstSec, aPntLastSec );
565 gp_Vec aVecSpine = VEnd - VBegin;
567 Standard_Boolean isParallel = aVecSec.IsParallel(aVecSpine, theTol);
571 // Modified by skv - Thu Feb 5 18:05:01 2004 OCC5073 End
573 //===============================================================
574 // Function : BuildKPart
576 //===============================================================
577 Standard_Boolean GeomFill_Sweep::BuildKPart()
579 Standard_Boolean Ok = Standard_False;
580 Standard_Boolean isUPeriodic = Standard_False;
581 Standard_Boolean isVPeriodic = Standard_False;
582 Standard_Boolean IsTrsf = Standard_True;
584 isUPeriodic = mySec->IsUPeriodic();
585 Handle(Geom_Surface) S;
586 GeomAbs_CurveType SectionType;
589 Standard_Real levier, error = 0 ;
590 Standard_Real UFirst=0, VFirst=First, ULast=0, VLast=Last;
591 Standard_Real Tol = Min (Tol3d, BoundTol);
593 // (1) Trajectoire Rectilignes -------------------------
594 if (myLoc->IsTranslation(error)) {
595 // Donne de la translation
603 Tf.SetVectorialPart(M);
604 Tf.SetTranslationPart(V.XYZ());
605 try { // Pas joli mais il n'y as pas d'autre moyens de tester SetValues
607 Tf2.SetValues(Tf(1,1), Tf(1,2), Tf(1,3), Tf(1,4),
608 Tf(2,1), Tf(2,2), Tf(2,3), Tf(2,4),
609 Tf(3,1), Tf(3,2), Tf(3,3), Tf(3,4));
611 catch (Standard_ConstructionError) {
612 IsTrsf = Standard_False;
615 return Standard_False;
618 // (1.1) Cas Extrusion
619 if (mySec->IsConstant(error)) {
620 Handle(Geom_Curve) Section;
621 Section = mySec->ConstantSection();
622 GeomAdaptor_Curve AC(Section);
623 SectionType = AC.GetType();
624 UFirst = AC.FirstParameter();
625 ULast = AC.LastParameter();
627 if ( (SectionType == GeomAbs_Line) && IsTrsf) {
628 // Modified by skv - Thu Feb 5 11:39:06 2004 OCC5073 Begin
629 if (!IsSweepParallelSpine(myLoc, mySec, Tol))
630 return Standard_False;
631 // Modified by skv - Thu Feb 5 11:39:08 2004 OCC5073 End
632 gp_Lin L = AC.Line();
634 DS.SetXYZ(L.Position().Direction().XYZ());
636 levier = Abs(DS.Dot(DP));
637 SError = error + levier * Abs(Last-First);
640 gp_Ax2 AxisOfPlane (L.Location(), DS^DP, DS);
641 S = new (Geom_Plane) (AxisOfPlane);
646 // (1.1.b) Cas Cylindrique
647 if ( (SectionType == GeomAbs_Circle) && IsTrsf) {
648 const Standard_Real TolProd = 1.e-6;
650 gp_Circ C = AC.Circle();
653 DS.SetXYZ (C.Position().Direction().XYZ());
655 levier = Abs(DS.CrossMagnitude(DP)) * C.Radius();
656 SError = levier * Abs(Last - First);
657 if (SError <= TolProd) {
659 gp_Ax3 axe (C.Location(), DP, C.Position().XDirection());
660 S = new (Geom_CylindricalSurface)
662 if (C.Position().Direction().
663 IsOpposite(axe.Direction(), 0.1) ) {
665 // L'orientation parametrique est inversee
670 isUReversed = Standard_True;
676 // (1.1.c) C'est bien une extrusion
679 Section->Transform(Tf2);
680 S = new (Geom_SurfaceOfLinearExtrusion)
685 else { // extrusion sur BSpline
692 else if (mySec->IsConicalLaw(error)) {
694 gp_Pnt P1, P2, Centre0, Centre1, Centre2;
696 Handle(Geom_Curve) Section;
697 GeomAdaptor_Curve AC;
699 Standard_Real R1, R2;
702 Section = mySec->CirclSection(SLast);
703 Section->Transform(Tf2);
704 Section->Translate(Last*DP);
707 Centre2 = C.Location();
708 AC.D1(0, P2, dsection);
711 Section = mySec->CirclSection(SFirst);
712 Section->Transform(Tf2);
713 Section->Translate(First*DP);
716 Centre1 = C.Location();
720 Section = mySec->CirclSection(SFirst - First*(SLast-SFirst)/(Last-First));
721 Section->Transform(Tf2);
724 Centre0 = C.Location();
727 gp_Vec N(Centre1, P1);
728 if (N.Magnitude() < 1.e-9) {
729 gp_Vec Bis(Centre2, P2);
732 gp_Vec L(P1, P2), Dir(Centre1,Centre2);
734 Angle = L.Angle(Dir);
735 if ((Angle > 0.01) && (Angle < M_PI/2-0.01)) {
736 if (R2<R1) Angle = -Angle;
738 gp_Ax3 Axis(Centre0, Dir, N);
739 S = new (Geom_ConicalSurface)
740 (Axis, Angle, C.Radius());
741 // Calcul du glissement parametrique
742 VFirst = First / Cos(Angle);
743 VLast = Last / Cos(Angle);
746 UFirst = AC.FirstParameter();
747 ULast = AC.LastParameter();
750 S->VIso(VLast)->D1(0, pbis, diso);
751 if (diso.Magnitude()>1.e-9 && dsection.Magnitude()>1.e-9)
752 isUReversed = diso.IsOpposite(dsection, 0.1);
755 // L'orientation parametrique est inversee
768 // (2) Trajectoire Circulaire
769 if (myLoc->IsRotation(error)) {
770 if (mySec->IsConstant(error)) {
773 isVPeriodic = (Abs(Last-First -2*M_PI) < 1.e-15);
774 Standard_Real RotRadius;
776 myLoc->D0(0.1, M, DS);
778 myLoc->Rotation(Centre);
781 DS.SetXYZ(V.XYZ() - Centre.XYZ());
782 RotRadius = DS.Magnitude();
783 if (RotRadius > 1.e-15) DS.Normalize();
784 else return Standard_False; // Pas de KPart, rotation degeneree
792 Tf.SetVectorialPart(M);
793 Tf.SetTranslationPart(V.XYZ());
794 // try { // Pas joli mais il n'y as pas d'autre moyens de tester SetValues
796 Tf2.SetValues(Tf(1,1), Tf(1,2), Tf(1,3), Tf(1,4),
797 Tf(2,1), Tf(2,2), Tf(2,3), Tf(2,4),
798 Tf(3,1), Tf(3,2), Tf(3,3), Tf(3,4));
800 // catch (Standard_ConstructionError) {
801 // IsTrsf = Standard_False;
804 Handle(Geom_Curve) Section;
805 Section = mySec->ConstantSection();
806 GeomAdaptor_Curve AC(Section);
807 SectionType = AC.GetType();
808 UFirst = AC.FirstParameter();
809 ULast = AC.LastParameter();
811 // (2.1) Tore/Sphere ?
812 if ((SectionType == GeomAbs_Circle) && IsTrsf) {
813 gp_Circ C = AC.Circle();
814 Standard_Real Radius;
815 Standard_Boolean IsGoodSide = Standard_True;;
818 // On calcul le centre eventuel
819 DC.SetXYZ(C.Location().XYZ() - Centre.XYZ());
820 Centre.ChangeCoord() += (DC.Dot(DN))*DN.XYZ();
821 DC.SetXYZ(C.Location().XYZ() - Centre.XYZ());
822 Radius = DC.Magnitude(); //grand Rayon du tore
823 if ((Radius > Tol) && (DC.Dot(DS) < 0)) IsGoodSide = Standard_False;
824 if (Radius < Tol/100) DC = DS; // Pour definir le tore
826 // On verifie d'abord que le plan de la section est // a
829 NC.SetXYZ (C.Position().Direction().XYZ());
831 error = Abs(NC.Dot(DN));
832 // Puis on evalue l'erreur commise sur la section,
833 // en pivotant son plan ( pour contenir l'axe de rotation)
834 error += Abs(NC.Dot(DS));
838 error += Radius + Abs(RotRadius - C.Radius())/2;
839 if (error <= Tol || Radius <= Tol) {
841 Standard_Real f = UFirst , l = ULast, aRadius = 0.0;
843 Centre.BaryCenter(1.0, C.Location(), 1.0);
844 gp_Ax3 AxisOfSphere(Centre, DN, DS);
847 aRadius = C.Radius();
851 aRadius = (RotRadius + C.Radius()) / 2;
853 gp_Sphere theSphere( AxisOfSphere, aRadius );
854 S = new Geom_SphericalSurface(theSphere);
855 // Pour les spheres on ne peut pas controler le parametre
856 // V (donc U car myExchUV = Standard_True)
857 // Il faut donc modifier UFirst, ULast...
858 Standard_Real fpar = AC.FirstParameter();
859 Standard_Real lpar = AC.LastParameter();
860 Handle(Geom_Curve) theSection = new Geom_TrimmedCurve(Section, fpar, lpar);
861 theSection->Transform(Tf2);
862 gp_Pnt FirstPoint = theSection->Value(theSection->FirstParameter());
863 gp_Pnt LastPoint = theSection->Value(theSection->LastParameter());
864 Standard_Real UfirstOnSec, VfirstOnSec, UlastOnSec, VlastOnSec;
865 ElSLib::Parameters(theSphere, FirstPoint, UfirstOnSec, VfirstOnSec);
866 ElSLib::Parameters(theSphere, LastPoint, UlastOnSec, VlastOnSec);
867 if (VfirstOnSec < VlastOnSec)
874 // L'orientation parametrique est inversee
877 isUReversed = Standard_True;
880 if ( (f >= -M_PI/2) && (l <= M_PI/2)) {
882 myExchUV = Standard_True;
886 else { // On restaure ce qu'il faut
887 isUReversed = Standard_False;
890 else if (IsGoodSide) {
892 gp_Ax3 AxisOfTore(Centre, DN, DC);
893 S = new (Geom_ToroidalSurface) (AxisOfTore,
894 Radius , C.Radius());
896 // Pour les tores on ne peut pas controler le parametre
897 // V (donc U car myExchUV = Standard_True)
898 // Il faut donc modifier UFirst, ULast...
899 Handle(Geom_Circle) Iso;
900 Iso = Handle(Geom_Circle)::DownCast(S->UIso(0.));
902 axeiso = Iso->Circ().Position();
904 if (C.Position().Direction().
905 IsOpposite(axeiso.Direction(), 0.1) ) {
907 // L'orientation parametrique est inversee
912 isUReversed = Standard_True;
914 // On calcul le "glissement" parametrique.
916 rot = C.Position().XDirection().AngleWithRef
917 (axeiso.XDirection(), axeiso.Direction());
921 myExchUV = Standard_True;
922 // Attention l'arete de couture dans le cas periodique
923 // n'est peut etre pas a la bonne place...
924 if (isUPeriodic && Abs(UFirst)>Precision::PConfusion())
925 isUPeriodic = Standard_False; //Pour trimmer la surface...
933 // (2.2) Cone / Cylindre
934 if ((SectionType == GeomAbs_Line) && IsTrsf) {
935 gp_Lin L = AC.Line();
938 DL.SetXYZ(L.Direction().XYZ());
939 levier = Max(Abs(AC.FirstParameter()), AC.LastParameter());
940 // si la line est ortogonale au cercle de rotation
941 SError = error + levier * Abs(DL.Dot(DP));
943 Standard_Boolean reverse;
944 gp_Lin Dir(Centre, DN);
947 reverse = (aux < 0); // On choisit ici le sens de parametrisation
949 // Calcul du centre du vecteur supportant la "XDirection"
951 gp_Vec O1O2(Centre, L.Location()), trans;
953 trans *= DN.Dot(O1O2);
954 CentreOfSurf = Centre.Translated(trans);
955 DS.SetXYZ(L.Location().XYZ() - CentreOfSurf.XYZ());
958 error += (DL.XYZ()).CrossMagnitude(DN.XYZ())*levier;
961 // si la line est orthogonale au plan de rotation
963 gp_Ax3 Axis(CentreOfSurf, Dir.Direction(), DS);
964 S = new (Geom_CylindricalSurface)
965 (Axis, L.Distance(CentreOfSurf));
967 myExchUV = Standard_True;
970 // On evalue l'angle du cone
971 Standard_Real Angle = Abs(Dir.Angle(L));
972 if (Angle > M_PI/2) Angle = M_PI -Angle;
973 if (reverse) Angle = -Angle;
978 if (Abs(Abs(Angle) - M_PI/2) > 0.01) {
980 // si les 2 droites ne sont pas orthogonales
981 Standard_Real Radius = CentreOfSurf.Distance(L.Location());
982 gp_Ax3 Axis(CentreOfSurf, Dir.Direction(), DS);
983 S = new (Geom_ConicalSurface)
984 (Axis, Angle, Radius);
985 myExchUV = Standard_True;
989 // On n'as pas conclue, on remet l'erreur a 0.
994 // On reverse le parametre
995 Standard_Real uf, ul;
996 Handle(Geom_Line) CL = new (Geom_Line)(L);
997 uf = CL->ReversedParameter(ULast);
998 ul = CL->ReversedParameter(UFirst);
1001 isUReversed = Standard_True;
1010 Section->Transform(Tf2);
1011 gp_Ax1 Axis (Centre, DN);
1012 S = new (Geom_SurfaceOfRevolution)
1014 myExchUV = Standard_True;
1023 if (Ok) { // On trimme la surface
1026 b = isUPeriodic; isUPeriodic = isVPeriodic; isVPeriodic = b;
1028 r = UFirst; UFirst = VFirst; VFirst = r;
1029 r = ULast; ULast = VLast; VLast = r;
1032 if (!isUPeriodic && !isVPeriodic)
1033 mySurface = new (Geom_RectangularTrimmedSurface)
1034 (S, UFirst, ULast, VFirst, VLast);
1035 else if (isUPeriodic) {
1036 if (isVPeriodic) mySurface = S;
1037 else mySurface = new (Geom_RectangularTrimmedSurface)
1038 (S, VFirst, VLast, Standard_False);
1041 mySurface = new (Geom_RectangularTrimmedSurface)
1042 (S,UFirst, ULast, Standard_True);
1045 if (isUPeriodic && !mySurface->IsUPeriodic())
1046 cout<<"Pb de periodicite en U" << endl;
1047 if (isUPeriodic && !mySurface->IsUClosed())
1048 cout<<"Pb de fermeture en U" << endl;
1049 if (isVPeriodic && !mySurface->IsVPeriodic())
1050 cout << "Pb de periodicite en V" << endl;
1051 if (isVPeriodic && !mySurface->IsVClosed())
1052 cout<<"Pb de fermeture en V" << endl;
1060 //===============================================================
1061 // Function : IsDone
1063 //===============================================================
1064 Standard_Boolean GeomFill_Sweep::IsDone() const
1069 //===============================================================
1070 // Function :ErrorOnSurface
1072 //===============================================================
1073 Standard_Real GeomFill_Sweep::ErrorOnSurface() const
1078 //===============================================================
1079 // Function ::ErrorOnRestriction
1081 //===============================================================
1082 void GeomFill_Sweep::ErrorOnRestriction(const Standard_Boolean IsFirst,
1083 Standard_Real& UError,
1084 Standard_Real& VError) const
1086 Standard_Integer ind;
1088 else ind = myCurve2d->Length();
1090 UError = CError->Value(1, ind);
1091 VError = CError->Value(2, ind);
1094 //===============================================================
1095 // Function :ErrorOnTrace
1097 //===============================================================
1098 void GeomFill_Sweep::ErrorOnTrace(const Standard_Integer IndexOfTrace,
1099 Standard_Real& UError,
1100 Standard_Real& VError) const
1102 Standard_Integer ind = IndexOfTrace+1;
1103 if (IndexOfTrace > myLoc->TraceNumber())
1104 throw Standard_OutOfRange(" GeomFill_Sweep::ErrorOnTrace");
1106 UError = CError->Value(1, ind);
1107 VError = CError->Value(2, ind);
1110 //===============================================================
1111 // Function :Surface
1113 //===============================================================
1114 Handle(Geom_Surface) GeomFill_Sweep::Surface() const
1119 //===============================================================
1120 // Function ::Restriction
1122 //===============================================================
1123 Handle(Geom2d_Curve) GeomFill_Sweep::Restriction(const Standard_Boolean IsFirst) const
1126 return myCurve2d->Value(1);
1127 return myCurve2d->Value(myCurve2d->Length());
1131 //===============================================================
1134 //===============================================================
1135 Standard_Integer GeomFill_Sweep::NumberOfTrace() const
1137 return myLoc->TraceNumber();
1140 //===============================================================
1143 //===============================================================
1144 Handle(Geom2d_Curve)
1145 GeomFill_Sweep::Trace(const Standard_Integer IndexOfTrace) const
1147 Standard_Integer ind = IndexOfTrace+1;
1148 if (IndexOfTrace > myLoc->TraceNumber())
1149 throw Standard_OutOfRange(" GeomFill_Sweep::Trace");
1150 return myCurve2d->Value(ind);