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
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
|
// File: ChFiKPart_CompData_PlnCon.cxx
// Created: Thu Feb 3 15:04:25 1994
// Author: Isabelle GRIGNON
// <isg@zerox>
#include <ChFiKPart_ComputeData.jxx>
#include <Precision.hxx>
#include <gp.hxx>
#include <gp_Pnt2d.hxx>
#include <gp_Dir2d.hxx>
#include <gp_Lin2d.hxx>
#include <gp_Pnt.hxx>
#include <gp_Dir.hxx>
#include <gp_Vec.hxx>
#include <gp_Lin.hxx>
#include <gp_Ax2.hxx>
#include <gp_Ax3.hxx>
#include <gp_Circ.hxx>
#include <gp_Pln.hxx>
#include <gp_Cone.hxx>
#include <ElCLib.hxx>
#include <ElSLib.hxx>
#include <Geom2d_Line.hxx>
#include <Geom2d_Circle.hxx>
#include <Geom_Line.hxx>
#include <Geom_Circle.hxx>
#include <Geom_ToroidalSurface.hxx>
#include <Geom_SphericalSurface.hxx>
#include <IntAna_QuadQuadGeo.hxx>
#include <ChFiKPart_ComputeData_Fcts.hxx>
//=======================================================================
//function : MakeFillet
//purpose : case cone/plane or plane/cone.
//=======================================================================
Standard_Boolean ChFiKPart_MakeFillet(TopOpeBRepDS_DataStructure& DStr,
const Handle(ChFiDS_SurfData)& Data,
const gp_Pln& Pln,
const gp_Cone& Con,
const Standard_Real fu,
const Standard_Real lu,
const TopAbs_Orientation Or1,
const TopAbs_Orientation Or2,
const Standard_Real Radius,
const gp_Circ& Spine,
const Standard_Real First,
const TopAbs_Orientation Ofpl,
const Standard_Boolean plandab)
{
//calculate the fillet (torus or sphere).
Standard_Boolean c1sphere = Standard_False;
gp_Ax3 PosPl = Pln.Position();
gp_Dir Dpnat = PosPl.XDirection().Crossed(PosPl.YDirection());
gp_Dir Dp = Dpnat;
gp_Dir Df = Dp;
if (Or1 == TopAbs_REVERSED) { Dp.Reverse(); }
if (Ofpl == TopAbs_REVERSED) { Df.Reverse(); }
gp_Pnt Or = Con.Location();
Standard_Real u,v;
ElSLib::PlaneParameters(PosPl,Or,u,v);
gp_Pnt2d c2dPln(u,v);
ElSLib::PlaneD0(u,v,PosPl,Or);
gp_Pnt cPln = Or;
Or.SetCoord(Or.X()+Radius*Dp.X(),
Or.Y()+Radius*Dp.Y(),
Or.Z()+Radius*Dp.Z());
gp_Pnt PtSp;
gp_Vec DSp;
ElCLib::D1(First,Spine,PtSp,DSp);
IntAna_QuadQuadGeo CInt (Pln,Con,Precision::Angular(),
Precision::Confusion());
gp_Pnt Pv;
if (CInt.IsDone()) {
//The origin of the fillet is set at the start point on the
//guideline.
Pv = ElCLib::Value(ElCLib::Parameter(CInt.Circle(1),PtSp),
CInt.Circle(1));
}
else { return Standard_False; }
gp_Dir Dx(gp_Vec(cPln,Pv));
gp_Dir Dy(DSp);
ElSLib::Parameters(Con,Pv,u,v);
gp_Pnt PtCon;
gp_Vec Vu,Vv;
ElSLib::D1(u,v,Con,PtCon,Vu,Vv);
gp_Dir Dc(Vu.Crossed(Vv));
if (Or2 == TopAbs_REVERSED) { Dc.Reverse(); }
gp_Dir Dz = Dp;
gp_Pnt pp(Pv.X()+Dc.X(),Pv.Y()+Dc.Y(),Pv.Z()+Dc.Z());
ElSLib::PlaneParameters(PosPl,pp,u,v);
ElSLib::PlaneD0(u,v,PosPl,pp);
gp_Dir ddp(gp_Vec(Pv,pp));
ElSLib::Parameters(Con,Pv,u,v);
gp_Vec dcu,dcv;
ElSLib::D1(u,v,Con,pp,dcu,dcv);
gp_Dir ddc(dcv);
if(ddc.Dot(Dp) < 0.) ddc.Reverse();
Standard_Real Ang = ddp.Angle(ddc);
Standard_Real Rabio = Radius/Tan(Ang/2);
Standard_Real Maxrad = cPln.Distance(Pv);
Standard_Real Rad;
Standard_Boolean dedans = Dx.Dot(Dc) <= 0. ;
if( dedans ){
if (!plandab){ Dz.Reverse(); }
Rad = Maxrad - Rabio;
if(Abs(Rad) <= Precision::Confusion()){ c1sphere = Standard_True; }
else if(Rad < 0){
cout<<"the fillet does not pass"<<endl;
return Standard_False;
}
}
else {
if (plandab){ Dz.Reverse(); }
Rad = Maxrad + Rabio;
}
gp_Ax3 FilAx3(Or,Dz,Dx);
if (FilAx3.YDirection().Dot(Dy) <= 0.){ FilAx3.YReverse(); }
if(c1sphere) {
Handle(Geom_SphericalSurface)
gsph = new Geom_SphericalSurface(FilAx3,Radius);
Data->ChangeSurf(ChFiKPart_IndexSurfaceInDS(gsph,DStr));
}
else{
Handle(Geom_ToroidalSurface)
gtor = new Geom_ToroidalSurface(FilAx3,Rad,Radius);
Data->ChangeSurf(ChFiKPart_IndexSurfaceInDS(gtor,DStr));
}
// It is checked if the orientation of the fillet is the same
// as of the faces.
gp_Pnt P,PP;
gp_Vec deru,derv;
P.SetCoord(cPln.X()+Rad*Dx.X(),
cPln.Y()+Rad*Dx.Y(),
cPln.Z()+Rad*Dx.Z());
if(c1sphere){
ElSLib::SphereParameters(FilAx3,Rad,P,u,v);
ElSLib::SphereD1(u,v,FilAx3,Rad,PP,deru,derv);
}
else{
ElSLib::TorusParameters(FilAx3,Rad,Radius,P,u,v);
ElSLib::TorusD1(u,v,FilAx3,Rad,Radius,PP,deru,derv);
if(!plandab && Ang < PI/2 && dedans) v = v + 2*PI;
}
gp_Pnt2d p2dFil(0.,v);
gp_Dir norFil(deru.Crossed(derv));
Standard_Boolean toreverse = ( norFil.Dot(Df) <= 0. );
if (toreverse) { Data->ChangeOrientation() = TopAbs_REVERSED; }
else { Data->ChangeOrientation() = TopAbs_FORWARD; }
// FaceInterferences are loaded with pcurves and curves 3d.
// ---------------------------------------------------------------
// The plane face.
// --------------
Handle(Geom2d_Circle) GCirc2dPln;
Handle(Geom_Circle) GCircPln;
gp_Ax2 circAx2 = FilAx3.Ax2();
if(!c1sphere){
ElSLib::PlaneParameters(PosPl,P,u,v);
gp_Pnt2d p2dPln(u,v);
gp_Dir2d d2d(DSp.Dot(PosPl.XDirection()),DSp.Dot(PosPl.YDirection()));
gp_Ax22d ax2dPln(c2dPln,gp_Dir2d(gp_Vec2d(c2dPln,p2dPln)),d2d);
gp_Circ2d circ2dPln(ax2dPln,Rad);
GCirc2dPln = new Geom2d_Circle(circ2dPln);
circAx2.SetLocation(cPln);
gp_Circ circPln(circAx2,Rad);
GCircPln = new Geom_Circle(circPln);
}
gp_Lin2d lin2dFil(p2dFil,gp::DX2d());
Handle(Geom2d_Line) GLin2dFil1 = new Geom2d_Line(lin2dFil);
toreverse = ( norFil.Dot(Dpnat) <= 0. );
TopAbs_Orientation trans;
if ((toreverse && plandab) || (!toreverse && !plandab) ){
trans = TopAbs_FORWARD;
}
else {
trans = TopAbs_REVERSED;
}
if(plandab){
Data->ChangeInterferenceOnS1().
SetInterference(ChFiKPart_IndexCurveInDS(GCircPln,DStr),
trans,GCirc2dPln,GLin2dFil1);
}
else{
Data->ChangeInterferenceOnS2().
SetInterference(ChFiKPart_IndexCurveInDS(GCircPln,DStr),
trans,GCirc2dPln,GLin2dFil1);
}
// The conic face.
// ----------------
P.SetCoord(Pv.X()+Rabio*ddc.X(),
Pv.Y()+Rabio*ddc.Y(),
Pv.Z()+Rabio*ddc.Z());
if(c1sphere){
ElSLib::SphereParameters(FilAx3,Radius,P,u,v);
ElSLib::SphereD1(u,v,FilAx3,Radius,PP,deru,derv);
}
else{
ElSLib::TorusParameters(FilAx3,Rad,Radius,P,u,v);
ElSLib::TorusD1(u,v,FilAx3,Rad,Radius,PP,deru,derv);
if(plandab && Ang < PI/2 && dedans) v = v + 2*PI;
}
norFil = deru.Crossed(derv);
p2dFil.SetCoord(0.,v);
lin2dFil.SetLocation(p2dFil);
Handle(Geom2d_Line) GLin2dFil2 = new Geom2d_Line(lin2dFil);
ElSLib::Parameters(Con,P,u,v);
Standard_Real tol = Precision::PConfusion();
Standard_Boolean careaboutsens = 0;
if(Abs(lu - fu - 2*PI) < tol) careaboutsens = 1;
if(u >= fu - tol && u < fu) u = fu;
if(u <= lu + tol && u > lu) u = lu;
if(u < fu || u > lu) u = ElCLib::InPeriod(u,fu,fu + 2*PI);
ElSLib::D1(u,v,Con,PP,deru,derv);
gp_Dir norCon = deru.Crossed(derv);
gp_Dir2d d2dCon = gp::DX2d();
if( deru.Dot(Dy) < 0. ){
d2dCon.Reverse();
if(careaboutsens && Abs(fu-u)<tol) u = lu;
}
else if(careaboutsens && Abs(lu-u)<tol) u = fu;
gp_Pnt2d p2dCon(u,v);
gp_Lin2d lin2dCon(p2dCon,d2dCon);
Handle(Geom2d_Line) GLin2dCon = new Geom2d_Line(lin2dCon);
Standard_Real scal = gp_Vec(Dp).Dot(gp_Vec(Pv,P));
PP.SetCoord(cPln.X()+scal*Dp.X(),
cPln.Y()+scal*Dp.Y(),
cPln.Z()+scal*Dp.Z());
circAx2.SetLocation(PP);
gp_Circ circCon(circAx2,P.Distance(PP));
Handle(Geom_Circle) GCircCon = new Geom_Circle(circCon);
toreverse = ( norFil.Dot(norCon) <= 0. );
if ((toreverse && plandab) || (!toreverse && !plandab) ){
trans = TopAbs_REVERSED;
}
else {
trans = TopAbs_FORWARD;
}
if(plandab){
Data->ChangeInterferenceOnS2().
SetInterference(ChFiKPart_IndexCurveInDS(GCircCon,DStr),
trans,GLin2dCon,GLin2dFil2);
}
else{
Data->ChangeInterferenceOnS1().
SetInterference(ChFiKPart_IndexCurveInDS(GCircCon,DStr),
trans,GLin2dCon,GLin2dFil2);
}
return Standard_True;
}
|
