0031035: Coding - uninitialized class fields reported by Visual Studio Code Analysis
[occt.git] / src / BlendFunc / BlendFunc_Corde.cxx
1 // Created on: 1996-06-04
2 // Created by: Stagiaire Xuan Trang PHAMPHU
3 // Copyright (c) 1996-1999 Matra Datavision
4 // Copyright (c) 1999-2014 OPEN CASCADE SAS
5 //
6 // This file is part of Open CASCADE Technology software library.
7 //
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.
13 //
14 // Alternatively, this file may be used under the terms of Open CASCADE
15 // commercial license or contractual agreement.
16
17
18 #include <Adaptor3d_HCurve.hxx>
19 #include <Adaptor3d_HSurface.hxx>
20 #include <BlendFunc.hxx>
21 #include <BlendFunc_Corde.hxx>
22 #include <ElCLib.hxx>
23 #include <gp.hxx>
24 #include <gp_Pnt.hxx>
25 #include <gp_Vec.hxx>
26 #include <gp_Vec2d.hxx>
27 #include <math_Gauss.hxx>
28 #include <math_Matrix.hxx>
29 #include <Standard_DomainError.hxx>
30 #include <Standard_NotImplemented.hxx>
31
32 //=======================================================================
33 //function : BlendFunc_Corde
34 //purpose  : 
35 //=======================================================================
36 BlendFunc_Corde::BlendFunc_Corde(const Handle(Adaptor3d_HSurface)&   S,
37                                  const Handle(Adaptor3d_HCurve)&     CG)
38 : surf(S),
39   guide(CG),
40   dis(0.0),
41   normtg(0.0),
42   theD(0.0),
43   istangent(Standard_False)
44 {
45 }
46
47 //=======================================================================
48 //function : SetDist
49 //purpose  : 
50 //=======================================================================
51
52 void BlendFunc_Corde::SetDist(const Standard_Real Dist)
53 {
54   dis = Dist;
55 }
56
57 //=======================================================================
58 //function : SetParam
59 //purpose  : 
60 //=======================================================================
61
62 void BlendFunc_Corde::SetParam(const Standard_Real Param)
63 {
64   guide->D2(Param,ptgui,d1gui,d2gui);
65   normtg = d1gui.Magnitude();
66   nplan  = d1gui.Normalized();
67   theD = - (nplan.XYZ().Dot(ptgui.XYZ()));
68 }
69
70 //=======================================================================
71 //function : Value
72 //purpose  : returns F(U,V)
73 //=======================================================================
74
75 Standard_Boolean BlendFunc_Corde::Value(const math_Vector& X, math_Vector& F)
76 {
77   gp_Vec d1u,d1v;
78   surf->D1(X(1),X(2),pts,d1u,d1v);
79
80   F(1) = nplan.XYZ().Dot(pts.XYZ()) + theD;
81   const gp_Vec vref(ptgui,pts);
82   F(2) = vref.SquareMagnitude() - dis*dis; 
83
84   return Standard_True;
85 }
86
87 //=======================================================================
88 //function : Derivatives
89 //purpose  : D = grad F(U,V)
90 //=======================================================================
91
92 Standard_Boolean BlendFunc_Corde::Derivatives(const math_Vector& X, math_Matrix& D)
93 {
94   gp_Vec d1u,d1v;
95   surf->D1(X(1),X(2),pts,d1u,d1v);  
96
97   D(1,1) = nplan.Dot(d1u);
98   D(1,2) = nplan.Dot(d1v); 
99   D(2,1) = 2.*gp_Vec(ptgui,pts).Dot(d1u);
100   D(2,2) = 2.*gp_Vec(ptgui,pts).Dot(d1v);
101
102   return Standard_True;
103 }
104
105 //=======================================================================
106 //function : PointOnS
107 //purpose  : 
108 //=======================================================================
109
110 const gp_Pnt& BlendFunc_Corde::PointOnS () const
111 {
112   return pts;
113 }
114
115
116 //=======================================================================
117 //function : PointOnGuide
118 //purpose  : 
119 //=======================================================================
120
121 const gp_Pnt& BlendFunc_Corde::PointOnGuide () const
122 {
123   return ptgui;
124 }
125
126
127 //=======================================================================
128 //function : Nplan
129 //purpose  : 
130 //=======================================================================
131
132 const gp_Vec& BlendFunc_Corde::NPlan () const
133 {
134   return nplan;
135 }
136
137
138 //=======================================================================
139 //function : IsTangencyPoint
140 //purpose  : 
141 //=======================================================================
142
143 Standard_Boolean BlendFunc_Corde::IsTangencyPoint () const
144 {
145   return istangent;
146 }
147
148
149 //=======================================================================
150 //function : TangentOnS
151 //purpose  : 
152 //=======================================================================
153
154 const gp_Vec& BlendFunc_Corde::TangentOnS () const
155 {
156   if (istangent)
157     throw Standard_DomainError("BlendFunc_Corde::TangentOnS");
158   return tgs;
159 }
160
161
162 //=======================================================================
163 //function : Tangent2dOnS
164 //purpose  : 
165 //=======================================================================
166
167 const gp_Vec2d& BlendFunc_Corde::Tangent2dOnS () const
168 {
169   if (istangent) 
170     throw Standard_DomainError("BlendFunc_Corde::Tangent2dOnS");
171   return tg2d;
172 }
173
174
175 //=======================================================================
176 //function : DerFguide
177 //purpose  : dF/dw
178 //=======================================================================
179
180 void BlendFunc_Corde::DerFguide (const math_Vector& Sol, gp_Vec2d& DerF)
181 {
182   gp_Vec d1u,d1v;
183   surf->D1(Sol(1),Sol(2),pts,d1u,d1v);
184
185   gp_Vec dnplan;
186   dnplan.SetLinearForm(1./normtg,d2gui,-1./normtg*(nplan.Dot(d2gui)),nplan);
187
188   const gp_Vec temp(pts.XYZ()-ptgui.XYZ());
189
190   DerF.SetX( dnplan.Dot(temp)-nplan.Dot(d1gui) );
191   DerF.SetY( -2.*d1gui.Dot(temp) );
192 }
193
194 //=======================================================================
195 //function : IsSolution
196 //purpose  :
197 //=======================================================================
198
199 Standard_Boolean BlendFunc_Corde::IsSolution(const math_Vector& Sol, const Standard_Real Tol)
200 {
201   math_Vector secmember(1,2),valsol(1,2);
202   math_Matrix gradsol(1,2,1,2);
203
204   gp_Vec dnplan,temp,d1u,d1v;
205
206   Value(Sol,valsol);
207   Derivatives(Sol,gradsol);
208   if (Abs(valsol(1)) <= Tol &&
209       Abs(valsol(2)) <= Tol*Tol) {
210
211     surf->D1(Sol(1),Sol(2),pts,d1u,d1v);
212     dnplan.SetLinearForm(1./normtg,d2gui,
213                          -1./normtg*(nplan.Dot(d2gui)),nplan); 
214
215     temp.SetXYZ(pts.XYZ()-ptgui.XYZ());
216
217     secmember(1) = nplan.Dot(d1gui) - dnplan.Dot(temp);
218     secmember(2) = 2.*d1gui.Dot(temp);
219
220 //  gradsol*der = secmember
221 //  with  der(1) = dU/dW, der(2) = dU/dW, W is the guide parameter
222
223     math_Gauss Resol(gradsol);
224     if (Resol.IsDone()) {
225       Resol.Solve(secmember);
226       tgs.SetLinearForm(secmember(1),d1u,secmember(2),d1v);
227       tg2d.SetCoord(secmember(1),secmember(2));
228       istangent = Standard_False;
229     }
230     else {
231       istangent = Standard_True;
232     }
233     return Standard_True;
234   }
235
236   return Standard_False;
237 }