1 // Created on: 1996-04-01
2 // Created by: Philippe MANGIN
3 // Copyright (c) 1996-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.
18 #include <FairCurve_BattenLaw.hxx>
19 #include <FairCurve_EnergyOfMVC.hxx>
20 #include <math_GaussSetIntegration.hxx>
21 #include <math_IntegerVector.hxx>
22 #include <Standard_DomainError.hxx>
23 #include <TColgp_HArray1OfPnt2d.hxx>
25 //=====================================================================================
26 FairCurve_EnergyOfMVC::FairCurve_EnergyOfMVC(const Standard_Integer BSplOrder,
27 const Handle(TColStd_HArray1OfReal)& FlatKnots,
28 const Handle(TColgp_HArray1OfPnt2d)& Poles,
29 const Standard_Integer ContrOrder1,
30 const Standard_Integer ContrOrder2,
31 const FairCurve_BattenLaw& Law,
32 const Standard_Real PhysicalRatio,
33 const Standard_Real LengthSliding,
34 const Standard_Boolean FreeSliding,
35 const Standard_Real Angle1,
36 const Standard_Real Angle2,
37 const Standard_Real Curvature1,
38 const Standard_Real Curvature2 )
39 //=====================================================================================
40 : FairCurve_Energy( Poles, ContrOrder1, ContrOrder2,
41 FreeSliding, Angle1, Angle2,
42 BSplOrder-1, Curvature1, Curvature2),
43 MyLengthSliding(LengthSliding),
44 OriginalSliding(LengthSliding),
46 MyPhysicalRatio(PhysicalRatio),
47 MyTension(BSplOrder, FlatKnots, Poles, 1, LengthSliding, Law, FreeSliding, Standard_True),
48 MySagging(BSplOrder, FlatKnots, Poles, 1, Law, FreeSliding),
49 MyJerk( BSplOrder, FlatKnots, Poles, 1, Law, FreeSliding)
51 Standard_DomainError_Raise_if(PhysicalRatio < 0 || PhysicalRatio > 1,
52 "FairCurve_EnergyOfMVC: PhysicalRatio error" );
56 //=====================================================================================
57 void FairCurve_EnergyOfMVC::ComputePoles(const math_Vector& X)
58 //=====================================================================================
60 FairCurve_Energy::ComputePoles(X);
61 if (MyWithAuxValue) { MyLengthSliding = X(X.Upper()); }
65 //=====================================================================================
66 Standard_Boolean FairCurve_EnergyOfMVC::Variable(math_Vector& X) const
67 //=====================================================================================
70 Ok = FairCurve_Energy::Variable(X);
71 if (MyWithAuxValue) { X(X.Upper()) = MyLengthSliding; }
76 //=====================================================================================
77 Standard_Boolean FairCurve_EnergyOfMVC::Compute(const Standard_Integer DerivativeOrder,
79 //=====================================================================================
81 math_Vector Debut(1, 1, 0.), Fin(1, 1, 1.);
82 math_IntegerVector MyOrder(1, 1, 24);
83 Standard_Boolean Ok=Standard_False;
85 // Blindage contre les longueur de glissement trop exotique
86 MyStatus = FairCurve_OK;
87 if ( MyLengthSliding > 10*OriginalSliding ) {
88 MyStatus = FairCurve_InfiniteSliding;
89 return Standard_False;
91 if ( MyLengthSliding < OriginalSliding/100 ) {
92 MyLengthSliding = OriginalSliding/100;
95 // Mise a jour des objets sous-fonction
96 MyTension.SetDerivativeOrder(DerivativeOrder);
97 MyTension.SetLengthSliding(MyLengthSliding);
98 MySagging.SetDerivativeOrder(DerivativeOrder);
99 MyJerk.SetDerivativeOrder(DerivativeOrder);
100 MyBattenLaw.SetSliding(MyLengthSliding);
104 // on decoupe afin d'avoir au moins 2 points d'integration par poles
105 // 24 points de Gauss => 12 poles maximum.
107 Standard_Integer NbInterv = (MyPoles->Length()-1) / 12 + 1, ii;
108 Standard_Real Delta = 1./ NbInterv;
111 if (MyPhysicalRatio <= 1.e-12) {
113 // Cas purement non physique --------------------------
115 for (ii=1; ii<=NbInterv; ii++) {
116 Debut(1) = (ii-1)*Delta;
119 math_GaussSetIntegration SumTension(MyTension, Debut, Fin, MyOrder);
120 Ok = SumTension.IsDone();
123 math_GaussSetIntegration SumJerk(MyJerk, Debut, Fin, MyOrder);
124 Ok = SumJerk.IsDone();
127 Result += SumJerk.Value() + SumTension.Value(); // Cas purement non physique
131 // Cas mixte --------------------------
132 for (ii=1; ii<=NbInterv; ii++) {
133 Debut(1) = (ii-1)*Delta;
136 math_GaussSetIntegration SumTension(MyTension, Debut, Fin, MyOrder);
137 Ok = SumTension.IsDone();
140 math_GaussSetIntegration SumSagging(MySagging, Debut, Fin, MyOrder);
141 Ok = SumSagging.IsDone();
144 math_GaussSetIntegration SumJerk(MyJerk, Debut, Fin, MyOrder);
145 Ok = SumJerk.IsDone();
148 Result += SumJerk.Value() * (1-MyPhysicalRatio)
149 + SumSagging.Value() * MyPhysicalRatio
150 + SumTension.Value();