1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
|
// File: ProjLib_NbIntFunc.cxx
// Created: Thu Nov 6 12:18:13 1997
// Author: Roman BORISOV
// <rbv@redfox.nnov.matra-dtv.fr>
#include <ProjLib_PrjFunc.ixx>
#include <gp_Pnt.hxx>
#include <gp_Vec.hxx>
#include <Adaptor3d_Surface.hxx>
#include <Adaptor3d_Curve.hxx>
ProjLib_PrjFunc::ProjLib_PrjFunc(const Adaptor3d_CurvePtr & C,const Standard_Real FixVal,const Adaptor3d_SurfacePtr & S, const Standard_Integer Fix) : myCurve(C), mySurface(S), myt(0), myU(0), myV(0), myFix(Fix)
{
myNorm=Min(1.,Min(mySurface->UResolution(1.),mySurface->VResolution(1.)));
// myNorm=1.;
switch(myFix) {
case 1: myt = FixVal; break;
case 2: myU = FixVal; break;
case 3: myV = FixVal; break;
default: Standard_ConstructionError::Raise();
}
}
Standard_Integer ProjLib_PrjFunc::NbVariables() const
{
return 2;
}
Standard_Integer ProjLib_PrjFunc::NbEquations() const
{
return 2;
}
Standard_Boolean ProjLib_PrjFunc::Value(const math_Vector& X,math_Vector& F)
{
math_Matrix D (1,2,1,2);
return Values(X,F,D);
}
Standard_Boolean ProjLib_PrjFunc::Derivatives(const math_Vector& X,math_Matrix& D)
{
math_Vector F(1,2);
return Values(X,F,D);
}
Standard_Boolean ProjLib_PrjFunc::Values(const math_Vector& X,math_Vector& F,math_Matrix& D)
{
Standard_Real u = 0., v = 0., t = 0.;
switch(myFix) {
case 1:
t = myt;
u = X(1);
v = X(2);
break;
case 2:
t = X(1);
u = myU;
v = X(2);
break;
case 3:
t = X(1);
u = X(2);
v = myV;
}
/* if(X(1) > mySup.X() || X(1) < myInf.X()) return Standard_False;
if(X(2) > mySup.Y() || X(2) < myInf.Y()) return Standard_False;
*/
gp_Pnt S, C;
gp_Vec DS1_u, DS1_v, DS2_u, DS2_uv, DS2_v, DC1_t;
myCurve->D1(t, C, DC1_t);
mySurface->D2(u, v, S, DS1_u, DS1_v, DS2_u, DS2_v, DS2_uv);
gp_Vec V(C, S);
F(1) = V*DS1_u*myNorm;
F(2) = V*DS1_v*myNorm;
switch(myFix) {
case 1:
D(1, 1) = (DS1_u.SquareMagnitude() + V*DS2_u)*myNorm; // dE1/du
D(1, 2) = (DS1_v*DS1_u + V*DS2_uv)*myNorm; // dE1/dv
D(2, 1) = D(1, 2); // dE2/du
D(2, 2) = (DS1_v.SquareMagnitude() + V*DS2_v)*myNorm; // dE2/dv
break;
case 2:
D(1, 1) = (-DC1_t*DS1_u)*myNorm; // dE1/dt
D(1, 2) = (DS1_v*DS1_u + V*DS2_uv)*myNorm; // dE1/dv
D(2, 1) = (-DC1_t*DS1_v)*myNorm; // dE2/dt
D(2, 2) = (DS1_v.SquareMagnitude() + V*DS2_v)*myNorm; // dE2/dv
break;
case 3:
D(1, 1) = -DC1_t*DS1_u*myNorm; // dE1/dt
D(1, 2) = (DS1_u.SquareMagnitude() + V*DS2_u)*myNorm; // dE1/du
D(2, 1) = -DC1_t*DS1_v*myNorm; // dE2/dt
D(2, 2) = (DS1_v*DS1_u + V*DS2_uv)*myNorm;// dE2/du
}
/* cout<<"F = ("<<F(1)<<", "<<F(2)<<")"<<endl;
cout<<"dE1/dt = "<<D(1,1)<<endl;
cout<<"dE1/dv = "<<D(1,2)<<endl;
cout<<"dE2/dt = "<<D(2,1)<<endl;
cout<<"dE2/dv = "<<D(2,2)<<endl;
*/
myU = u;
myV = v;
myt = t;
return Standard_True;
}
gp_Pnt2d ProjLib_PrjFunc::Solution() const
{
switch(myFix) {
case 1: return gp_Pnt2d(myU, myV);
case 2: return gp_Pnt2d(myt, myV);
case 3: return gp_Pnt2d(myt, myU);
}
// pout NT, meme si on n'y passe pas.
return gp_Pnt2d(0.,0.);
}
|
