b311480e |
1 | // Created on: 1995-10-19 |
2 | // Created by: Laurent BOURESCHE |
3 | // Copyright (c) 1995-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 | // |
d5f74e42 |
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 |
973c2be1 |
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 | |
42cf5bc1 |
17 | |
7fd59977 |
18 | #include <Adaptor2d_HCurve2d.hxx> |
42cf5bc1 |
19 | #include <Adaptor3d_CurveOnSurface.hxx> |
20 | #include <Adaptor3d_HSurface.hxx> |
21 | #include <GeomFill_BoundWithSurf.hxx> |
22 | #include <gp_Pnt.hxx> |
7fd59977 |
23 | #include <gp_Pnt2d.hxx> |
42cf5bc1 |
24 | #include <gp_Vec.hxx> |
7fd59977 |
25 | #include <gp_Vec2d.hxx> |
42cf5bc1 |
26 | #include <Law.hxx> |
27 | #include <Law_BSpFunc.hxx> |
28 | #include <Law_Function.hxx> |
29 | #include <Standard_Type.hxx> |
30 | |
92efcf78 |
31 | IMPLEMENT_STANDARD_RTTIEXT(GeomFill_BoundWithSurf,GeomFill_Boundary) |
32 | |
7fd59977 |
33 | //======================================================================= |
34 | //function : GeomFill_BoundWithSurf |
35 | //purpose : |
36 | //======================================================================= |
7fd59977 |
37 | GeomFill_BoundWithSurf::GeomFill_BoundWithSurf |
38 | (const Adaptor3d_CurveOnSurface& CurveOnSurf, |
39 | const Standard_Real Tol3d, |
40 | const Standard_Real Tolang) : |
41 | GeomFill_Boundary(Tol3d,Tolang), myConS(CurveOnSurf) |
42 | { |
43 | } |
44 | |
45 | |
46 | //======================================================================= |
47 | //function : Value |
48 | //purpose : |
49 | //======================================================================= |
50 | |
51 | gp_Pnt GeomFill_BoundWithSurf::Value(const Standard_Real U) const |
52 | { |
53 | Standard_Real x = U; |
54 | if(!myPar.IsNull()) x = myPar->Value(U); |
55 | return myConS.Value(x); |
56 | } |
57 | |
58 | |
59 | //======================================================================= |
60 | //function : D1 |
61 | //purpose : |
62 | //======================================================================= |
63 | |
64 | void GeomFill_BoundWithSurf::D1(const Standard_Real U, |
65 | gp_Pnt& P, |
66 | gp_Vec& V) const |
67 | { |
68 | Standard_Real x = U, dx = 1.; |
69 | if(!myPar.IsNull()) myPar->D1(U,x,dx); |
70 | myConS.D1(x, P, V); |
71 | V.Multiply(dx); |
72 | } |
73 | |
74 | |
75 | //======================================================================= |
76 | //function : HasNormals |
77 | //purpose : |
78 | //======================================================================= |
79 | |
80 | Standard_Boolean GeomFill_BoundWithSurf::HasNormals() const |
81 | { |
82 | return Standard_True; |
83 | } |
84 | |
85 | |
86 | //======================================================================= |
87 | //function : Norm |
88 | //purpose : |
89 | //======================================================================= |
90 | |
91 | gp_Vec GeomFill_BoundWithSurf::Norm(const Standard_Real U) const |
92 | { |
93 | // voir s il ne faudrait pas utiliser LProp ou autre. |
94 | if (!HasNormals()) |
9775fa61 |
95 | throw Standard_Failure("BoundWithSurf Norm : pas de contrainte"); |
7fd59977 |
96 | |
97 | // Handle(Adaptor3d_HSurface)& S = myConS.GetSurface(); |
98 | // Handle(Adaptor2d_HCurve2d)& C2d = myConS.GetCurve(); |
99 | Standard_Real x,y; |
100 | Standard_Real w = U; |
101 | if(!myPar.IsNull()) w = myPar->Value(U); |
102 | myConS.GetCurve()->Value(w).Coord(x,y); |
103 | gp_Pnt P; |
104 | gp_Vec Su, Sv; |
105 | myConS.GetSurface()->D1(x,y,P,Su,Sv); |
106 | Su.Cross(Sv); |
107 | Su.Normalize(); |
108 | return Su; |
109 | } |
110 | |
111 | |
112 | //======================================================================= |
113 | //function : D1Norm |
114 | //purpose : |
115 | //======================================================================= |
116 | |
117 | void GeomFill_BoundWithSurf::D1Norm(const Standard_Real U, |
118 | gp_Vec& N, |
119 | gp_Vec& DN) const |
120 | { |
121 | if (!HasNormals()) |
9775fa61 |
122 | throw Standard_Failure("BoundWithSurf Norm : pas de contrainte"); |
7fd59977 |
123 | // Handle(Adaptor3d_HSurface)& S = myConS.GetSurface(); |
124 | // Handle(Adaptor2d_HCurve2d)& C2d = myConS.GetCurve(); |
125 | gp_Pnt2d P2d; |
126 | gp_Vec2d V2d; |
127 | Standard_Real x,y,dx,dy; |
128 | Standard_Real w = U, dw = 1.; |
129 | if(!myPar.IsNull()) myPar->D1(U,w,dw); |
130 | myConS.GetCurve()->D1(w,P2d,V2d); |
131 | P2d.Coord(x,y); |
132 | V2d.Multiply(dw); |
133 | V2d.Coord(dx,dy); |
134 | gp_Pnt P; |
135 | gp_Vec Su, Sv, Suu, Suv, Svv; |
136 | myConS.GetSurface()->D2(x,y,P,Su,Sv, Suu, Svv, Suv); |
137 | N = Su.Crossed(Sv); |
138 | N.Normalize(); |
139 | Standard_Real nsuu = N.Dot(Suu), nsuv = N.Dot(Suv), nsvv = N.Dot(Svv); |
140 | Standard_Real susu = Su.Dot(Su), susv = Su.Dot(Sv), svsv = Sv.Dot(Sv); |
141 | Standard_Real deno = (susu*svsv) - (susv*susv); |
82ac7cbb |
142 | if(Abs(deno) < 1.e-16) { |
7fd59977 |
143 | // on embraye sur un calcul approche, c est mieux que rien!?! |
144 | gp_Vec temp = Norm(U + 1.e-12); |
145 | DN = N.Multiplied(-1.); |
146 | DN.Add(temp); |
147 | DN.Multiply(1.e-12); |
148 | } |
149 | else{ |
150 | Standard_Real a = (-nsuu*svsv + nsuv*susv)/deno; |
151 | Standard_Real b = ( nsuu*susv - nsuv*susu)/deno; |
152 | Standard_Real c = (-nsuv*svsv + nsvv*susv)/deno; |
153 | Standard_Real d = ( nsuv*susv - nsvv*susu)/deno; |
154 | |
155 | gp_Vec temp1 = Su.Multiplied(a); |
156 | gp_Vec temp2 = Sv.Multiplied(b); |
157 | temp1.Add(temp2); |
158 | temp2 = Su.Multiplied(c); |
159 | gp_Vec temp3 = Sv.Multiplied(d); |
160 | temp2.Add(temp3); |
161 | temp1.Multiply(dx); |
162 | temp2.Multiply(dy); |
163 | DN = temp1.Added(temp2); |
164 | } |
165 | } |
166 | |
167 | |
168 | //======================================================================= |
169 | //function : Reparametrize |
170 | //purpose : |
171 | //======================================================================= |
172 | |
173 | void GeomFill_BoundWithSurf::Reparametrize(const Standard_Real First, |
174 | const Standard_Real Last, |
175 | const Standard_Boolean HasDF, |
176 | const Standard_Boolean HasDL, |
177 | const Standard_Real DF, |
178 | const Standard_Real DL, |
179 | const Standard_Boolean Rev) |
180 | { |
181 | Handle(Law_BSpline) curve = Law::Reparametrize(myConS, |
182 | First,Last, |
183 | HasDF,HasDL,DF,DL, |
184 | Rev,30); |
185 | myPar = new Law_BSpFunc(); |
c5f3a425 |
186 | Handle(Law_BSpFunc)::DownCast (myPar)->SetCurve(curve); |
7fd59977 |
187 | } |
188 | |
189 | //======================================================================= |
190 | //function : Bounds |
191 | //purpose : |
192 | //======================================================================= |
193 | |
194 | void GeomFill_BoundWithSurf::Bounds(Standard_Real& First, |
195 | Standard_Real& Last) const |
196 | { |
197 | if(!myPar.IsNull()) myPar->Bounds(First,Last); |
198 | else{ |
199 | First = myConS.FirstParameter(); |
200 | Last = myConS.LastParameter(); |
201 | } |
202 | } |
203 | |
204 | |
205 | //======================================================================= |
206 | //function : IsDegenerated |
207 | //purpose : |
208 | //======================================================================= |
209 | |
210 | Standard_Boolean GeomFill_BoundWithSurf::IsDegenerated() const |
211 | { |
212 | return Standard_False; |
213 | } |