b311480e |
1 | // Created on: 1997-02-21 |
2 | // Created by: Laurent BOURESCHE |
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 | // |
973c2be1 |
8 | // This library is free software; you can redistribute it and / or modify it |
9 | // under the terms of the GNU Lesser General Public 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. |
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 | #include <BRepBlend_SurfCurvConstRadInv.ixx> |
18 | |
19 | //======================================================================= |
20 | //function : BRepBlend_SurfCurvConstRadInv |
21 | //purpose : |
22 | //======================================================================= |
23 | |
24 | BRepBlend_SurfCurvConstRadInv::BRepBlend_SurfCurvConstRadInv |
25 | (const Handle(Adaptor3d_HSurface)& S, |
26 | const Handle(Adaptor3d_HCurve)& C, |
27 | const Handle(Adaptor3d_HCurve)& Cg) : surf(S),curv(C),guide(Cg) |
28 | { |
29 | } |
30 | |
31 | //======================================================================= |
32 | //function : Set |
33 | //purpose : |
34 | //======================================================================= |
35 | |
36 | void BRepBlend_SurfCurvConstRadInv::Set(const Standard_Real R, |
37 | const Standard_Integer Choix) |
38 | { |
39 | choix = Choix; |
40 | switch (choix) { |
41 | case 1: |
42 | case 2: |
43 | { |
44 | ray = -Abs(R); |
45 | } |
46 | break; |
47 | case 3: |
48 | case 4: |
49 | { |
50 | ray = Abs(R); |
51 | } |
52 | break; |
53 | default: |
54 | { |
55 | ray = -Abs(R); |
56 | } |
57 | } |
58 | } |
59 | |
60 | //======================================================================= |
61 | //function : NbEquations |
62 | //purpose : |
63 | //======================================================================= |
64 | |
65 | Standard_Integer BRepBlend_SurfCurvConstRadInv::NbEquations() const |
66 | { |
67 | return 3; |
68 | } |
69 | |
70 | //======================================================================= |
71 | //function : Value |
72 | //purpose : |
73 | //======================================================================= |
74 | |
75 | Standard_Boolean BRepBlend_SurfCurvConstRadInv::Value(const math_Vector& X, |
76 | math_Vector& F) |
77 | { |
78 | gp_Pnt ptgui; |
79 | gp_Vec d1gui; |
80 | guide->D1(X(1),ptgui,d1gui); |
81 | gp_Vec nplan = d1gui.Normalized(); |
82 | Standard_Real theD = -(nplan.XYZ().Dot(ptgui.XYZ())); |
83 | gp_Pnt ptcur = curv->Value(X(2)); |
84 | F(1) = nplan.XYZ().Dot(ptcur.XYZ()) + theD; |
85 | gp_Pnt2d p2drst = rst->Value(X(3)); |
86 | gp_Pnt pts; |
87 | gp_Vec du,dv; |
88 | surf->D1(p2drst.X(),p2drst.Y(),pts,du,dv); |
89 | F(2) = nplan.XYZ().Dot(pts.XYZ()) + theD; |
90 | gp_Vec ns = du.Crossed(dv); |
91 | Standard_Real norm = nplan.Crossed(ns).Magnitude(); |
92 | Standard_Real unsurnorm = 1./norm; |
93 | ns.SetLinearForm(nplan.Dot(ns),nplan, -1.,ns); |
94 | ns.Multiply(unsurnorm); |
95 | gp_Vec ref(ptcur,pts); |
96 | ref.SetLinearForm(ray,ns,ref); |
97 | F(3) = ref.SquareMagnitude() - ray*ray; |
98 | return Standard_True; |
99 | } |
100 | |
101 | //======================================================================= |
102 | //function : Derivatives |
103 | //purpose : |
104 | //======================================================================= |
105 | |
106 | Standard_Boolean BRepBlend_SurfCurvConstRadInv::Derivatives(const math_Vector& X, |
107 | math_Matrix& D) |
108 | { |
109 | gp_Pnt ptgui; |
110 | gp_Vec d1gui,d2gui; |
111 | guide->D2(X(1),ptgui,d1gui,d2gui); |
112 | Standard_Real normd1gui = d1gui.Magnitude(); |
113 | Standard_Real unsurnormd1gui = 1./normd1gui; |
114 | gp_Vec nplan = d1gui.Multiplied(unsurnormd1gui); |
7fd59977 |
115 | gp_Vec dnplan; |
116 | dnplan.SetLinearForm(-nplan.Dot(d2gui),nplan,d2gui); |
117 | dnplan.Multiply(unsurnormd1gui); |
118 | Standard_Real dtheD = - nplan.XYZ().Dot(d1gui.XYZ()) - dnplan.XYZ().Dot(ptgui.XYZ()); |
119 | gp_Pnt ptcur; |
120 | gp_Vec d1cur; |
121 | curv->D1(X(2),ptcur,d1cur); |
122 | D(1,1) = dnplan.XYZ().Dot(ptcur.XYZ()) + dtheD; |
123 | D(1,2) = nplan.XYZ().Dot(d1cur.XYZ()); |
124 | D(1,3) = 0.; |
125 | |
126 | gp_Pnt2d p2drst; |
127 | gp_Vec2d d1rst; |
128 | rst->D1(X(3),p2drst,d1rst); |
129 | gp_Pnt pts; |
130 | gp_Vec d1u,d1v,d2u,d2v,duv; |
131 | surf->D2(p2drst.X(),p2drst.Y(),pts,d1u,d1v,d2u,d2v,duv); |
132 | D(2,1) = dnplan.XYZ().Dot(pts.XYZ()) + dtheD; |
133 | D(2,2) = 0.; |
134 | gp_Vec dwrstpts; |
135 | dwrstpts.SetLinearForm(d1rst.X(),d1u,d1rst.Y(),d1v); |
136 | D(2,3) = nplan.XYZ().Dot(dwrstpts.XYZ()); |
137 | |
138 | gp_Vec nsurf = d1u.Crossed(d1v); |
139 | gp_Vec dunsurf = d2u.Crossed(d1v).Added(d1u.Crossed(duv)); |
140 | gp_Vec dvnsurf = d1u.Crossed(d2v).Added(duv.Crossed(d1v)); |
141 | gp_Vec dwrstnsurf; |
142 | dwrstnsurf.SetLinearForm(d1rst.X(),dunsurf,d1rst.Y(),dvnsurf); |
143 | |
144 | gp_Vec nplancrosnsurf = nplan.Crossed(nsurf); |
145 | gp_Vec dwguinplancrosnsurf = dnplan.Crossed(nsurf); |
146 | gp_Vec dwrstnplancrosnsurf = nplan.Crossed(dwrstnsurf); |
147 | |
148 | Standard_Real norm2 = nplancrosnsurf.SquareMagnitude(); |
149 | Standard_Real norm = sqrt(norm2); |
150 | Standard_Real unsurnorm = 1./norm; |
151 | Standard_Real raysurnorm = ray*unsurnorm; |
152 | Standard_Real unsurnorm2 = unsurnorm * unsurnorm; |
153 | Standard_Real raysurnorm2 = ray*unsurnorm2; |
154 | Standard_Real dwguinorm = unsurnorm*nplancrosnsurf.Dot(dwguinplancrosnsurf); |
155 | Standard_Real dwrstnorm = unsurnorm*nplancrosnsurf.Dot(dwrstnplancrosnsurf); |
156 | |
157 | Standard_Real nplandotnsurf = nplan.Dot(nsurf); |
158 | Standard_Real dwguinplandotnsurf = dnplan.Dot(nsurf); |
159 | Standard_Real dwrstnplandotnsurf = nplan.Dot(dwrstnsurf); |
160 | |
161 | gp_Vec temp,dwguitemp,dwrsttemp; |
162 | temp.SetLinearForm(nplandotnsurf,nplan,-1.,nsurf); |
163 | dwguitemp.SetLinearForm(nplandotnsurf,dnplan,dwguinplandotnsurf,nplan); |
164 | dwrsttemp.SetLinearForm(dwrstnplandotnsurf,nplan,-1.,dwrstnsurf); |
165 | |
166 | gp_Vec corde(ptcur,pts); |
167 | gp_Vec ref,dwguiref,dwrstref; |
168 | ref.SetLinearForm(raysurnorm,temp,corde); |
169 | dwguiref.SetLinearForm(raysurnorm,dwguitemp,-raysurnorm2*dwguinorm,temp); |
170 | dwrstref.SetLinearForm(raysurnorm,dwrsttemp,-raysurnorm2*dwrstnorm,temp,dwrstpts); |
171 | |
172 | ref.Add(ref); |
173 | D(3,1) = ref.Dot(dwguiref); |
174 | D(3,2) = -ref.Dot(d1cur); |
175 | D(3,3) = ref.Dot(dwrstref); |
176 | |
177 | return Standard_True; |
178 | } |
179 | |
180 | //======================================================================= |
181 | //function : Values |
182 | //purpose : |
183 | //======================================================================= |
184 | |
185 | Standard_Boolean BRepBlend_SurfCurvConstRadInv::Values(const math_Vector& X, |
186 | math_Vector& F, |
187 | math_Matrix& D) |
188 | { |
189 | gp_Pnt ptgui; |
190 | gp_Vec d1gui(0.,0.,0.),d2gui(0.,0.,0.); |
191 | guide->D2(X(1),ptgui,d1gui,d2gui); |
192 | Standard_Real normd1gui = d1gui.Magnitude(); |
193 | Standard_Real unsurnormd1gui = 1./normd1gui; |
194 | gp_Vec nplan = d1gui.Multiplied(unsurnormd1gui); |
195 | Standard_Real theD = -(nplan.XYZ().Dot(ptgui.XYZ())); |
196 | gp_Vec dnplan; |
197 | dnplan.SetLinearForm(-nplan.Dot(d2gui),nplan,d2gui); |
198 | dnplan.Multiply(unsurnormd1gui); |
199 | Standard_Real dtheD = - nplan.XYZ().Dot(d1gui.XYZ()) - dnplan.XYZ().Dot(ptgui.XYZ()); |
200 | gp_Pnt ptcur; |
201 | gp_Vec d1cur; |
202 | curv->D1(X(2),ptcur,d1cur); |
203 | F(1) = nplan.XYZ().Dot(ptcur.XYZ()) + theD; |
204 | D(1,1) = dnplan.XYZ().Dot(ptcur.XYZ()) + dtheD; |
205 | D(1,2) = nplan.XYZ().Dot(d1cur.XYZ()); |
206 | D(1,3) = 0.; |
207 | |
208 | gp_Pnt2d p2drst; |
209 | gp_Vec2d d1rst; |
210 | rst->D1(X(3),p2drst,d1rst); |
211 | gp_Pnt pts; |
212 | gp_Vec d1u,d1v,d2u,d2v,duv; |
213 | surf->D2(p2drst.X(),p2drst.Y(),pts,d1u,d1v,d2u,d2v,duv); |
214 | F(2) = nplan.XYZ().Dot(pts.XYZ()) + theD; |
215 | D(2,1) = dnplan.XYZ().Dot(pts.XYZ()) + dtheD; |
216 | D(2,2) = 0.; |
217 | gp_Vec dwrstpts; |
218 | dwrstpts.SetLinearForm(d1rst.X(),d1u,d1rst.Y(),d1v); |
219 | D(2,3) = nplan.XYZ().Dot(dwrstpts.XYZ()); |
220 | |
221 | gp_Vec nsurf = d1u.Crossed(d1v); |
222 | gp_Vec dunsurf = d2u.Crossed(d1v).Added(d1u.Crossed(duv)); |
223 | gp_Vec dvnsurf = d1u.Crossed(d2v).Added(duv.Crossed(d1v)); |
224 | gp_Vec dwrstnsurf; |
225 | dwrstnsurf.SetLinearForm(d1rst.X(),dunsurf,d1rst.Y(),dvnsurf); |
226 | |
227 | gp_Vec nplancrosnsurf = nplan.Crossed(nsurf); |
228 | gp_Vec dwguinplancrosnsurf = dnplan.Crossed(nsurf); |
229 | gp_Vec dwrstnplancrosnsurf = nplan.Crossed(dwrstnsurf); |
230 | |
231 | Standard_Real norm2 = nplancrosnsurf.SquareMagnitude(); |
232 | Standard_Real norm = sqrt(norm2); |
233 | Standard_Real unsurnorm = 1./norm; |
234 | Standard_Real raysurnorm = ray*unsurnorm; |
235 | Standard_Real unsurnorm2 = unsurnorm * unsurnorm; |
236 | Standard_Real raysurnorm2 = ray*unsurnorm2; |
237 | Standard_Real dwguinorm = unsurnorm*nplancrosnsurf.Dot(dwguinplancrosnsurf); |
238 | Standard_Real dwrstnorm = unsurnorm*nplancrosnsurf.Dot(dwrstnplancrosnsurf); |
239 | |
240 | Standard_Real nplandotnsurf = nplan.Dot(nsurf); |
241 | Standard_Real dwguinplandotnsurf = dnplan.Dot(nsurf); |
242 | Standard_Real dwrstnplandotnsurf = nplan.Dot(dwrstnsurf); |
243 | |
244 | gp_Vec temp,dwguitemp,dwrsttemp; |
245 | temp.SetLinearForm(nplandotnsurf,nplan,-1.,nsurf); |
246 | dwguitemp.SetLinearForm(nplandotnsurf,dnplan,dwguinplandotnsurf,nplan); |
247 | dwrsttemp.SetLinearForm(dwrstnplandotnsurf,nplan,-1.,dwrstnsurf); |
248 | |
249 | gp_Vec corde(ptcur,pts); |
250 | gp_Vec ref,dwguiref,dwrstref; |
251 | ref.SetLinearForm(raysurnorm,temp,corde); |
252 | F(3) = ref.SquareMagnitude() - ray*ray; |
253 | dwguiref.SetLinearForm(raysurnorm,dwguitemp,-raysurnorm2*dwguinorm,temp); |
254 | dwrstref.SetLinearForm(raysurnorm,dwrsttemp,-raysurnorm2*dwrstnorm,temp,dwrstpts); |
255 | |
256 | ref.Add(ref); |
257 | D(3,1) = ref.Dot(dwguiref); |
258 | D(3,2) = -ref.Dot(d1cur); |
259 | D(3,3) = ref.Dot(dwrstref); |
260 | return Standard_True; |
261 | } |
262 | |
263 | //======================================================================= |
264 | //function : Set |
265 | //purpose : |
266 | //======================================================================= |
267 | |
268 | void BRepBlend_SurfCurvConstRadInv::Set(const Handle(Adaptor2d_HCurve2d)& Rst) |
269 | { |
270 | rst = Rst; |
271 | } |
272 | |
273 | //======================================================================= |
274 | //function : GetTolerance |
275 | //purpose : |
276 | //======================================================================= |
277 | |
278 | void BRepBlend_SurfCurvConstRadInv::GetTolerance(math_Vector& Tolerance, |
279 | const Standard_Real Tol) const |
280 | { |
281 | Tolerance(1) = guide->Resolution(Tol); |
282 | Tolerance(2) = curv->Resolution(Tol); |
283 | Standard_Real ru,rv; |
284 | ru = surf->UResolution(Tol); |
285 | rv = surf->VResolution(Tol); |
286 | Tolerance(3) = rst->Resolution(Min(ru,rv)); |
287 | } |
288 | |
289 | //======================================================================= |
290 | //function : GetBounds |
291 | //purpose : |
292 | //======================================================================= |
293 | |
294 | void BRepBlend_SurfCurvConstRadInv::GetBounds(math_Vector& InfBound, |
295 | math_Vector& SupBound) const |
296 | { |
297 | InfBound(1) = guide->FirstParameter(); |
298 | SupBound(1) = guide->LastParameter(); |
299 | InfBound(2) = curv->FirstParameter(); |
300 | SupBound(2) = curv->LastParameter(); |
301 | InfBound(3) = rst->FirstParameter(); |
302 | SupBound(3) = rst->LastParameter(); |
303 | } |
304 | |
305 | //======================================================================= |
306 | //function : IsSolution |
307 | //purpose : |
308 | //======================================================================= |
309 | |
310 | Standard_Boolean BRepBlend_SurfCurvConstRadInv::IsSolution(const math_Vector& Sol, |
311 | const Standard_Real Tol) |
312 | { |
313 | math_Vector valsol(1,3); |
314 | Value(Sol,valsol); |
315 | if (Abs(valsol(1)) <= Tol && |
316 | Abs(valsol(2)) <= Tol && |
317 | Abs(valsol(3)) <= 2*Tol*Abs(ray) ) { |
318 | return Standard_True; |
319 | } |
320 | return Standard_False; |
321 | } |
322 | |
323 | |