1 // Copyright (c) 1999-2014 OPEN CASCADE SAS
3 // This file is part of Open CASCADE Technology software library.
5 // This library is free software; you can redistribute it and/or modify it under
6 // the terms of the GNU Lesser General Public License version 2.1 as published
7 // by the Free Software Foundation, with special exception defined in the file
8 // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
9 // distribution for complete text of the license and disclaimer of any warranty.
11 // Alternatively, this file may be used under the terms of Open CASCADE
12 // commercial license or contractual agreement.
14 // 30-01-1996 : PMN Version originale
17 #define No_Standard_RangeError
18 #define No_Standard_OutOfRange
22 #include <BSplCLib.hxx>
23 #include <FairCurve_BattenLaw.hxx>
24 #include <FairCurve_DistributionOfTension.hxx>
25 #include <gp_Pnt2d.hxx>
27 #include <math_Matrix.hxx>
28 #include <math_Vector.hxx>
30 FairCurve_DistributionOfTension::FairCurve_DistributionOfTension(const Standard_Integer BSplOrder,
31 const Handle(TColStd_HArray1OfReal)& FlatKnots,
32 const Handle(TColgp_HArray1OfPnt2d)& Poles,
33 const Standard_Integer DerivativeOrder,
34 const Standard_Real LengthSliding,
35 const FairCurve_BattenLaw& Law,
36 const Standard_Integer NbValAux,
37 const Standard_Boolean Uniform ) :
38 FairCurve_DistributionOfEnergy(BSplOrder,
43 MyLengthSliding (LengthSliding),
46 if (Uniform) {MyLaw.Value(0.5, MyHeight);} // it used in MVC to avoid Parametrization Problemes
52 Standard_Boolean FairCurve_DistributionOfTension::Value(const math_Vector& TParam, math_Vector& FTension)
54 Standard_Boolean Ok = Standard_True;
55 Standard_Integer ier, ii, jj, kk;
57 Standard_Integer LastGradientIndex, FirstNonZero, LastZero;
59 // (0.0) initialisations generales
61 math_Matrix Base(1, 3, 1, MyBSplOrder ); // On shouhaite utiliser la derive premieres
62 // Dans EvalBsplineBasis C' <=> DerivOrder = 2
63 // et il faut ajouter 1 rang dans la matrice Base => 3 rang
65 ier = BSplCLib::EvalBsplineBasis(1, MyBSplOrder,
66 MyFlatKnots->Array1(), TParam(TParam.Lower()),
68 if (ier != 0) return Standard_False;
69 LastZero = FirstNonZero - 1;
70 FirstNonZero = 2*LastZero+1;
72 // (0.1) evaluation de CPrim
73 for (ii= 1; ii<= MyBSplOrder; ii++) {
74 CPrim += Base(2, ii) * MyPoles->Value(ii+LastZero).Coord();
77 // (1) Evaluation de la tension locale --------------------------------
78 Standard_Real NormeCPrim = CPrim.Modulus();
79 Standard_Real Hauteur, Difference;
81 if (MyHeight > 0) {Hauteur = MyHeight;} // it used in MVC to avoid Parametrization Problemes
83 Ok = MyLaw.Value (TParam(TParam.Lower()), Hauteur);
86 Difference = NormeCPrim - MyLengthSliding;
88 FTension(FTension.Lower()) = Hauteur * pow(Difference, 2) / MyLengthSliding ;
90 if (MyDerivativeOrder >= 1) {
91 // (2) Evaluation du gradient de la tension locale ----------------------
92 math_Vector GradDifference (1, 2*MyBSplOrder+MyNbValAux);
93 Standard_Real Xaux, Yaux, Facteur;
95 Xaux = CPrim.X() / NormeCPrim;
96 Yaux = CPrim.Y() / NormeCPrim;
97 Facteur = 2 * Hauteur * Difference / MyLengthSliding;
99 kk = FTension.Lower() + FirstNonZero;
101 for (ii=1; ii<= MyBSplOrder; ii++) {
102 GradDifference(jj) = Base(2, ii) * Xaux;
103 FTension(kk) = Facteur * GradDifference(jj);
105 GradDifference(jj) = Base(2, ii) * Yaux;
106 FTension(kk+1) = Facteur * GradDifference(jj);
110 if (MyNbValAux == 1) {
111 LastGradientIndex = FTension.Lower() + 2*MyPoles->Length() + 1;
112 GradDifference( GradDifference.Upper()) = (1 - pow( NormeCPrim/MyLengthSliding, 2));
113 FTension(LastGradientIndex) = Hauteur * GradDifference(GradDifference.Upper());
116 else { LastGradientIndex = FTension.Lower() + 2*MyPoles->Length(); }
119 if (MyDerivativeOrder >= 2) {
121 // (3) Evaluation du Hessien de la tension locale ----------------------
123 Standard_Real FacteurX = Difference * (1-pow(Xaux,2)) / NormeCPrim;
124 Standard_Real FacteurY = Difference * (1-pow(Yaux,2)) / NormeCPrim;
125 Standard_Real FacteurXY = - Difference * Xaux*Yaux / NormeCPrim;
126 Standard_Real Produit;
127 Standard_Integer k1, k2;
129 Facteur = 2 * Hauteur / MyLengthSliding;
132 k2 = LastGradientIndex + (kk-1)*kk/2;
134 for (ii=2; ii<= 2*MyBSplOrder; ii+=2) {
135 k1 = k2+FirstNonZero;
138 for (jj=2; jj< ii; jj+=2) {
139 Produit = Base(2, ii/2) * Base(2, jj/2);
141 FTension(k1) = Facteur * ( GradDifference(ii-1)*GradDifference(jj-1)
142 + FacteurX * Produit) ; // derivation en XiXj
144 FTension(k1) = Facteur * ( GradDifference(ii)*GradDifference(jj-1)
145 + FacteurXY * Produit); // derivation en YiXj
147 FTension(k2) = Facteur * ( GradDifference(ii-1)*GradDifference(jj)
148 + FacteurXY * Produit); // derivation en XiYj
150 FTension(k2) = Facteur * ( GradDifference(ii)*GradDifference(jj)
151 + FacteurY * Produit); // derivation en YiYj
154 // cas ou jj = ii : remplisage en triangle
155 Produit = pow (Base(2, ii/2), 2);
157 FTension(k1) = Facteur * ( GradDifference(ii-1)*GradDifference(ii-1)
158 + FacteurX * Produit) ; // derivation en XiXi
159 FTension(k2) = Facteur * ( GradDifference(ii)*GradDifference(ii-1)
160 + FacteurXY * Produit); // derivation en XiYi
162 FTension(k2) = Facteur * ( GradDifference(ii)*GradDifference(ii)
163 + FacteurY * Produit); // derivation en YiYi
165 if (MyNbValAux == 1) {
166 FacteurX = -2*CPrim.X()*Hauteur / pow (MyLengthSliding, 2);
167 FacteurY = -2*CPrim.Y()*Hauteur / pow (MyLengthSliding, 2);
169 ii = LastGradientIndex-FTension.Lower();
170 kk = LastGradientIndex + (ii-1)*ii/2 + FirstNonZero;
171 for (ii=1; ii<= MyBSplOrder; ii++) {
172 FTension(kk) = FacteurX * Base(2, ii);
174 FTension(kk) = FacteurY * Base(2, ii);
177 FTension(FTension.Upper()) = 2 * Hauteur * pow (NormeCPrim/MyLengthSliding, 2)