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
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
|
// File: IntPatch_PolyLine.cxx
// Created: Fri Jan 29 17:14:59 1993
// Author: Isabelle GRIGNON
// Copyright: Matra Datavision 1993
//-- lbr le 12 juin : Ajout des fleches sur les Lines
//-- msv 13.03.2002 : compute deflection for WLine; Error() returns deflection
#include <IntPatch_PolyLine.ixx>
#include <Precision.hxx>
#define INITDEFLE Precision::PConfusion()*100.
//=======================================================================
//function : IntPatch_PolyLine
//purpose :
//=======================================================================
IntPatch_PolyLine::IntPatch_PolyLine ()
: defle(INITDEFLE)
{}
//=======================================================================
//function : IntPatch_PolyLine
//purpose :
//=======================================================================
IntPatch_PolyLine::IntPatch_PolyLine (const Standard_Real InitDefle)
: defle(InitDefle)
{}
//=======================================================================
//function : SetWLine
//purpose :
//=======================================================================
void IntPatch_PolyLine::SetWLine(const Standard_Boolean OnFirst, const Handle(IntPatch_WLine)& Line)
{
typ = IntPatch_Walking;
wpoly = Line;
onfirst = OnFirst;
Prepare();
}
//=======================================================================
//function : SetRLine
//purpose :
//=======================================================================
void IntPatch_PolyLine::SetRLine(const Standard_Boolean OnFirst, const Handle(IntPatch_RLine)& Line)
{
typ = IntPatch_Restriction;
rpoly = Line;
onfirst = OnFirst;
Prepare();
}
//=======================================================================
//function : Prepare
//purpose :
//=======================================================================
void IntPatch_PolyLine::Prepare()
{
Standard_Integer i;
box.SetVoid();
Standard_Integer n=NbPoints();
Standard_Real eps = defle;
gp_Pnt2d P1, P2;
if (n >= 3) {
P1 = Point(1); P2 = Point(2);
}
for (i=1; i<=n ;i++) {
const gp_Pnt2d& P3 = Point(i);
if (i >= 3) {
gp_XY V13 = P3.XY() - P1.XY();
gp_XY V12 = P2.XY() - P1.XY();
Standard_Real d13 = V13.Modulus(), d;
if (d13 > eps)
d = V13.CrossMagnitude(V12) / d13;
else
d = eps;
if (d > defle) {
// try to compute deflection more precisely using parabola interpolation
gp_XY V23 = P3.XY() - P2.XY();
Standard_Real d12 = V12.Modulus(), d23 = V23.Modulus();
// compute parameter of P2 (assume parameters of P1,P3 are 0,1)
Standard_Real tm = d12 / (d12+d23);
if (tm > 0.1 && tm < 0.9) {
tm -= (tm-0.5) * 0.6;
Standard_Real tm1mtm = tm*(1-tm);
// coefficients of parabola
Standard_Real Ax = (tm*V13.X() - V12.X()) / tm1mtm;
Standard_Real Bx = (V12.X() - tm*tm*V13.X()) / tm1mtm;
Standard_Real Cx = P1.X();
Standard_Real Ay = (tm*V13.Y() - V12.Y()) / tm1mtm;
Standard_Real By = (V12.Y() - tm*tm*V13.Y()) / tm1mtm;
Standard_Real Cy = P1.Y();
// equations of lines P1-P2 and P2-P3
Standard_Real A1 = V12.Y() / d12;
Standard_Real B1 = -V12.X() / d12;
Standard_Real C1 = (P2.X()*P1.Y() - P1.X()*P2.Y()) / d12;
Standard_Real A2 = V23.Y() / d23;
Standard_Real B2 = -V23.X() / d23;
Standard_Real C2 = (P3.X()*P2.Y() - P2.X()*P3.Y()) / d23;
// points on parabola with max deflection
Standard_Real t1 = -0.5 * (A1*Bx + B1*By) / (A1*Ax + B1*Ay);
Standard_Real t2 = -0.5 * (A2*Bx + B2*By) / (A2*Ax + B2*Ay);
Standard_Real xt1 = Ax*t1*t1 + Bx*t1 + Cx;
Standard_Real yt1 = Ay*t1*t1 + By*t1 + Cy;
Standard_Real xt2 = Ax*t2*t2 + Bx*t2 + Cx;
Standard_Real yt2 = Ay*t2*t2 + By*t2 + Cy;
// max deflection on segments P1-P2 and P2-P3
Standard_Real d1 = Abs (A1*xt1 + B1*yt1 + C1);
Standard_Real d2 = Abs (A2*xt2 + B2*yt2 + C2);
if (d2 > d1) d1 = d2;
// select min deflection from linear and parabolic ones
if (d1 < d) d = d1;
}
if (d > defle) defle=d;
}
P1 = P2; P2 = P3;
}
box.Add(P3);
}
box.Enlarge(defle);
}
//=======================================================================
//function : ResetError
//purpose :
//=======================================================================
void IntPatch_PolyLine::ResetError()
{
defle = INITDEFLE;
}
//=======================================================================
//function : Bounding
//purpose :
//=======================================================================
const Bnd_Box2d& IntPatch_PolyLine::Bounding() const
{
return box;
}
//=======================================================================
//function : Error
//purpose :
//=======================================================================
Standard_Real IntPatch_PolyLine::Error() const
{
// return 0.0000001;
return defle;
}
//=======================================================================
//function : Closed
//purpose :
//=======================================================================
Standard_Boolean IntPatch_PolyLine::Closed() const
{
return Standard_False;
}
//=======================================================================
//function : NbPoints
//purpose :
//=======================================================================
Standard_Integer IntPatch_PolyLine::NbPoints() const
{
return (typ == IntPatch_Walking ? wpoly->NbPnts() : rpoly->NbPnts());
}
//=======================================================================
//function : Point
//purpose :
//=======================================================================
gp_Pnt2d IntPatch_PolyLine::Point(const Standard_Integer Index ) const
{
Standard_Real X,Y,X1,Y1,DX,DY;
DX=DY=0;
if (onfirst) {
if (typ == IntPatch_Walking) {
wpoly->Point(Index).ParametersOnS1(X,Y);
if(Index==1) {
wpoly->Point(2).ParametersOnS1(X1,Y1);
DX=0.0000001*(X-X1);
DY=0.0000001*(Y-Y1);
}
else if(Index==wpoly->NbPnts()) {
wpoly->Point(Index-1).ParametersOnS1(X1,Y1);
DX=0.0000001*(X-X1);
DY=0.0000001*(Y-Y1);
}
}
else {
rpoly->Point(Index).ParametersOnS1(X,Y);
}
}
else {
if (typ == IntPatch_Walking) {
wpoly->Point(Index).ParametersOnS2(X,Y);
if(Index==1) {
wpoly->Point(2).ParametersOnS2(X1,Y1);
DX=0.0000001*(X-X1);
DY=0.0000001*(Y-Y1);
}
else if(Index==wpoly->NbPnts()) {
wpoly->Point(Index-1).ParametersOnS2(X1,Y1);
DX=0.0000001*(X-X1);
DY=0.0000001*(Y-Y1);
}
}
else {
rpoly->Point(Index).ParametersOnS2(X,Y);
}
}
return(gp_Pnt2d(X+DX,Y+DY));
}
|
