0027960: Configuration - fix compilation of OSD_Directory with MinGW-w64
[occt.git] / src / ChFiKPart / ChFiKPart_ComputeData_ChPlnCon.cxx
1 // Created on: 1995-05-30
2 // Created by: Stagiaire Flore Lantheaume
3 // Copyright (c) 1995-1999 Matra Datavision
4 // Copyright (c) 1999-2014 OPEN CASCADE SAS
5 //
6 // This file is part of Open CASCADE Technology software library.
7 //
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
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.
13 //
14 // Alternatively, this file may be used under the terms of Open CASCADE
15 // commercial license or contractual agreement.
16
17
18 #include <Adaptor3d_HSurface.hxx>
19 #include <ChFiDS_Spine.hxx>
20 #include <ChFiDS_SurfData.hxx>
21 #include <ChFiKPart_ComputeData.hxx>
22 #include <ChFiKPart_ComputeData_ChAsymPlnCon.hxx>
23 #include <ChFiKPart_ComputeData_Fcts.hxx>
24 #include <ElCLib.hxx>
25 #include <ElSLib.hxx>
26 #include <Geom2d_Circle.hxx>
27 #include <Geom2d_Line.hxx>
28 #include <Geom_Circle.hxx>
29 #include <Geom_ConicalSurface.hxx>
30 #include <gp.hxx>
31 #include <gp_Ax2.hxx>
32 #include <gp_Ax3.hxx>
33 #include <gp_Circ.hxx>
34 #include <gp_Dir.hxx>
35 #include <gp_Dir2d.hxx>
36 #include <gp_Lin2d.hxx>
37 #include <gp_Pnt.hxx>
38 #include <gp_Pnt2d.hxx>
39 #include <gp_Vec.hxx>
40 #include <Precision.hxx>
41 #include <TopOpeBRepDS_DataStructure.hxx>
42
43 //=======================================================================
44 //function : MakeChamfer
45 //purpose  : Compute the chamfer in the particular case Plane/Cone or 
46 //           Cylinder/Plane
47 //           Compute the SurfData <Data> of the chamfer build on the <Spine>
48 //           between the plane <Pln> and the cone <Con>, with the 
49 //           distances <Dis1> on <Pln> and <Dis2> on <Con>.
50 //           <Or1> and <Or2> are the orientations of <Pln> and <Con>
51 //           and <Ofpl> this of the face carried by <Pln>.
52 //           <First> is the start point on the <Spine>
53 //           <Plandab> is equal to True if the plane is the surface S1
54 //           <fu> and <lu> are the first and last u parameters of the
55 //           cone
56 //out      : True if the chanfer has been computed
57 //           False else
58 //=======================================================================
59 Standard_Boolean ChFiKPart_MakeChamfer(TopOpeBRepDS_DataStructure& DStr,
60                                        const Handle(ChFiDS_SurfData)& Data, 
61                                        const gp_Pln& Pln, 
62                                        const gp_Cone& Con, 
63                                        const Standard_Real fu,
64                                        const Standard_Real lu,
65                                        const TopAbs_Orientation Or1,
66                                        const TopAbs_Orientation Or2,
67                                        const Standard_Real Dis1, 
68                                        const Standard_Real Dis2,
69                                        const gp_Circ& Spine, 
70                                        const Standard_Real First, 
71                                        const TopAbs_Orientation Ofpl,
72                                        const Standard_Boolean plandab)
73 {
74
75   Standard_Real angcon = Con.SemiAngle();
76   Standard_Real sincon =Abs(Sin(angcon));
77   Standard_Real angle;
78   Standard_Boolean IsResol;
79
80   gp_Ax3 PosPl = Pln.Position();
81   gp_Dir Dpl = PosPl.XDirection().Crossed(PosPl.YDirection());
82   if ( Or1 == TopAbs_REVERSED ) Dpl.Reverse();
83
84   // compute the origin of the conical chamfer PtPl
85   gp_Pnt Or = Con.Location();
86   Standard_Real u,v;
87   ElSLib::PlaneParameters(PosPl,Or,u,v);
88 #ifdef OCCT_DEBUG
89   gp_Pnt2d pt2dPln(u,v);
90 #endif
91   ElSLib::PlaneD0(u,v,PosPl,Or);
92
93   gp_Pnt PtSp;
94   gp_Vec DSp;
95   ElCLib::D1(First,Spine,PtSp,DSp);
96 #ifdef OCCT_DEBUG
97   gp_Dir Dx(gp_Vec(Or,PtSp));
98 #endif
99   //compute the normal to the cone in PtSp
100   gp_Vec deru,derv;
101   gp_Pnt PtCon;
102   ElSLib::Parameters(Con,PtSp,u,v);
103   ElSLib::D1(u,v,Con,PtCon ,deru,derv);
104   gp_Dir Dcon( deru.Crossed(derv) );
105   if ( Or2 == TopAbs_REVERSED ) Dcon.Reverse();
106   
107   Standard_Boolean ouvert = ( Dpl.Dot(Dcon) >= 0.);
108
109   if (!ouvert) {
110     if (Abs(Dis1 - Dis2 * sincon) > Precision::Confusion()) {
111       Standard_Real abscos = Abs(Dis2 - Dis1 * sincon);
112       angle = ATan((Dis1 * Cos(angcon)) / abscos);
113     }
114     else {
115       angle = angcon;
116     }
117   }
118   else {
119     angle = ATan((Dis1 * Cos(angcon)) / (Dis2 + Dis1 * sincon));
120   }
121
122   Standard_Boolean DisOnP = Standard_False;
123
124   IsResol = ChFiKPart_MakeChAsym(DStr,  Data, Pln, Con, fu, lu, Or1, Or2,
125                                  Dis2, angle, Spine,  First,  Ofpl, plandab, DisOnP);
126
127   return IsResol;
128
129 }
130  
131 /*
132  // Compute the chamfer surface(cone)
133   gp_Ax3 PosPl = Pln.Position();
134   gp_Dir Dpl = PosPl.XDirection().Crossed(PosPl.YDirection());
135   gp_Dir norf = Dpl;
136   if (Ofpl == TopAbs_REVERSED ) norf.Reverse();
137   if ( Or1 == TopAbs_REVERSED ) Dpl.Reverse();
138
139     // compute the origin of the conical chamfer PtPl
140   gp_Pnt Or = Con.Location();
141   Standard_Real u,v;
142   ElSLib::PlaneParameters(PosPl,Or,u,v);
143   gp_Pnt2d pt2dPln(u,v);
144   ElSLib::PlaneD0(u,v,PosPl,Or);
145   gp_Pnt PtPl = Or;
146
147   gp_Pnt PtSp;
148   gp_Vec DSp;
149   ElCLib::D1(First,Spine,PtSp,DSp);
150   gp_Dir Dx(gp_Vec(PtPl,PtSp));
151
152     //compute the normal to the cone in PtSp
153   gp_Vec deru,derv;
154   gp_Pnt PtCon;
155   ElSLib::Parameters(Con,PtSp,u,v);
156   ElSLib::D1(u,v,Con,PtCon ,deru,derv);
157   gp_Dir Dcon( deru.Crossed(derv) );
158   if ( Or2 == TopAbs_REVERSED ) Dcon.Reverse();
159   
160   Standard_Boolean dedans = ( Dx.Dot(Dcon) <= 0.);
161   Standard_Boolean ouvert = ( Dpl.Dot(Dcon) >= 0.);
162
163     // variables used to compute the semiangle of the chamfer
164   Standard_Real angle = Con.SemiAngle();
165   Standard_Real move = Dis2 * Cos(angle);
166   Or.SetCoord( Or.X()+ move*Dpl.X(),
167                Or.Y()+ move*Dpl.Y(),
168                Or.Z()+ move*Dpl.Z());
169
170   gp_Dir Vec1(Or.X()-PtPl.X(), Or.Y()-PtPl.Y(), Or.Z()-PtPl.Z());
171   Standard_Real Dis;
172   if (ouvert)
173     Dis = Dis1 + Dis2*Abs(Sin(angle));
174   else
175     Dis = Dis1 - Dis2*Abs(Sin(angle));
176
177   gp_Pnt Pt(Or.X()+Dis*PosPl.XDirection().X(),
178             Or.Y()+Dis*PosPl.XDirection().Y(),
179             Or.Z()+Dis*PosPl.XDirection().Z());
180   gp_Dir Vec2( Pt.X()-PtPl.X(), Pt.Y()-PtPl.Y(), Pt.Z()-PtPl.Z());
181
182     // compute the parameters of the conical chamfer
183   Standard_Real ChamfRad,SemiAngl;
184   Standard_Boolean pointu = Standard_False;
185
186   if (dedans) {
187     ChamfRad = Spine.Radius() - Dis1;
188     if ( Abs(ChamfRad)<=Precision::Confusion() ) pointu = Standard_True;
189     if( ChamfRad < 0 ) {
190 #ifdef OCCT_DEBUG
191       cout<<"le chanfrein ne passe pas"<<endl;
192 #endif
193       return Standard_False;
194     }
195   }
196   else {
197     ChamfRad = Spine.Radius() + Dis1;
198     gp_Dir Dplr = Dpl.Reversed();
199     Dpl = Dplr;
200   }
201
202   gp_Ax3 ChamfAx3(PtPl,Dpl,Dx);
203   SemiAngl = Vec1.Angle(Vec2);
204
205   Handle (Geom_ConicalSurface)
206     gcon = new Geom_ConicalSurface( ChamfAx3, SemiAngl, ChamfRad );
207
208     // changes due to the fact the parameters of the chamfer must go increasing
209     // from surface S1 to surface S2
210   if ( (dedans && !plandab) || (!dedans && plandab) ) {
211     gcon->VReverse();// be carefull : the SemiAngle was changed
212     ChamfAx3 = gcon->Position();
213     SemiAngl = gcon->SemiAngle();
214   }
215
216     // changes due to the fact we have reversed the V direction of 
217     // parametrization
218   if (ChamfAx3.YDirection().Dot(DSp) <= 0.) {
219     ChamfAx3.YReverse();
220     gcon->SetPosition(ChamfAx3);
221   }
222
223   Data->ChangeSurf(ChFiKPart_IndexSurfaceInDS(gcon,DStr));
224
225
226   //compute the chamfer's orientation according to the orientation
227   // of the faces
228
229     //search the normal to the conical chamfer
230   gp_Pnt P;
231   u=0.;
232   if (plandab)
233     v = sqrt(Dis*Dis + move*move);
234   else
235     v = - sqrt(Dis*Dis + move*move);
236   ElSLib::ConeD1(u,v,ChamfAx3,ChamfRad,SemiAngl,P,deru,derv);
237   gp_Dir norchamf(deru.Crossed(derv));
238
239   Standard_Boolean toreverse = (norf.Dot(norchamf)<= 0.);
240
241   if (toreverse)
242     Data->ChangeOrientation() = TopAbs_REVERSED;
243   else
244     Data->ChangeOrientation() = TopAbs_FORWARD; 
245
246
247   //we load the faceInterference with the pcurves and
248   // the 3d curves
249
250     // Case of the plane face
251     // NB: in the case 'pointu', no pcurve on the plane surface
252     // and no intersection plane-chamfer are needed
253
254     // intersection plane-chamfer
255   Handle(Geom_Circle) GCirPln;
256   Handle(Geom2d_Circle) GCir2dPln;
257   gp_Ax2 CirAx2 = ChamfAx3.Ax2();
258   CirAx2.SetLocation(PtPl);
259
260   if (!pointu) {
261     Pt.SetCoord(PtPl.X()+ChamfRad*Dx.X(),
262                 PtPl.Y()+ChamfRad*Dx.Y(),
263                 PtPl.Z()+ChamfRad*Dx.Z());
264     gp_Circ CirPln(CirAx2,ChamfRad);
265     GCirPln = new Geom_Circle(CirPln);
266   
267       //pcurve on the plane
268     ElSLib::PlaneParameters(PosPl,Pt ,u,v);
269     gp_Pnt2d p2dPln(u,v);
270     gp_Dir2d d2d(DSp.Dot(PosPl.XDirection()),DSp.Dot(PosPl.YDirection()));
271     gp_Ax22d ax2dPln(pt2dPln, gp_Dir2d(gp_Vec2d(pt2dPln,p2dPln)),d2d);
272     gp_Circ2d cir2dPln(ax2dPln,ChamfRad);
273     GCir2dPln = new Geom2d_Circle(cir2dPln);
274   }
275
276       //pcurve on chamfer
277   gp_Pnt2d p2dch;
278   p2dch.SetCoord(0.,0.);
279   ElSLib::ConeD1(0.,0.,ChamfAx3,ChamfRad,SemiAngl,Pt,deru,derv);
280   gp_Lin2d lin2dch(p2dch,gp::DX2d());
281   Handle(Geom2d_Line) GLin2dCh1 = new Geom2d_Line(lin2dch);
282
283       //orientation
284   TopAbs_Orientation trans; 
285   gp_Dir norpl = PosPl.XDirection().Crossed(PosPl.YDirection());
286   if (!pointu)
287     norchamf.SetXYZ (deru.Crossed(derv).XYZ());
288   toreverse = ( norchamf.Dot(norpl) <= 0. );
289   if ((toreverse && plandab) || (!toreverse && !plandab)){ 
290     trans = TopAbs_FORWARD;
291   }
292   else { 
293     trans = TopAbs_REVERSED; 
294   }
295
296   if(plandab){
297     Data->ChangeInterferenceOnS1().
298       SetInterference(ChFiKPart_IndexCurveInDS(GCirPln,DStr),
299                       trans,GCir2dPln,GLin2dCh1);
300   }
301   else{
302     Data->ChangeInterferenceOnS2().
303       SetInterference(ChFiKPart_IndexCurveInDS(GCirPln,DStr),
304                       trans,GCir2dPln,GLin2dCh1);
305   }
306
307
308     // Case of the conical face
309
310       //intersection cone-chamfer
311   Standard_Real Rad;
312   if (dedans)
313     Rad = ChamfRad + Dis;
314   else
315     Rad = ChamfRad - Dis;
316
317   CirAx2.SetLocation(Or);
318   gp_Circ CirCon(CirAx2, Rad);
319   Handle(Geom_Circle) GCirCon = new Geom_Circle(CirCon);  
320
321       //pcurve on chamfer
322   if (plandab)
323     v = sqrt(Dis*Dis + move*move);
324   else
325     v = - sqrt(Dis*Dis + move*move);
326   p2dch.SetCoord(0.,v);
327   ElSLib::ConeD1(0.,v,ChamfAx3,ChamfRad,SemiAngl,Pt,deru,derv);
328   lin2dch.SetLocation(p2dch);
329   Handle(Geom2d_Line) GLin2dCh2 = new Geom2d_Line(lin2dch);
330   
331       //pcurve on cone
332   norchamf.SetXYZ (deru.Crossed(derv).XYZ());
333
334   Pt.SetCoord(Or.X()+Rad*Dx.X(),
335               Or.Y()+Rad*Dx.Y(),
336               Or.Z()+Rad*Dx.Z());
337   ElSLib::Parameters(Con,Pt ,u,v);
338   Standard_Real tol = Precision::PConfusion();
339   if(u >= 2*M_PI - tol && u <= 2*M_PI) u = 0.;
340   if(u >= fu - tol && u < fu) u = fu;
341   if(u <= lu + tol && u > lu) u = lu;
342   if(u < fu || u > lu) u = ElCLib::InPeriod(u,fu,fu + 2*M_PI);
343   ElSLib::D1(u,v,Con,Pt,deru,derv);
344   gp_Pnt2d p2dCon(u,v);
345   gp_Dir2d d2dCon;
346   if ( deru.Dot(DSp)<=0. )
347     d2dCon = - gp::DX2d();
348   else
349     d2dCon = gp::DX2d();
350   gp_Lin2d lin2dCon(p2dCon,d2dCon);
351   Handle(Geom2d_Line) GLin2dCon = new Geom2d_Line(lin2dCon);
352
353       //orientation
354   gp_Dir norcon = deru.Crossed(derv);
355   toreverse = ( norchamf.Dot(norcon) <= 0. );
356   if ((toreverse && plandab) || (!toreverse && !plandab) ) {
357     trans = TopAbs_REVERSED;
358   }
359   else {
360     trans = TopAbs_FORWARD;
361   }
362
363   if(plandab){
364     Data->ChangeInterferenceOnS2().
365       SetInterference(ChFiKPart_IndexCurveInDS(GCirCon,DStr),
366                       trans,GLin2dCon,GLin2dCh2);
367   }
368   else{
369     Data->ChangeInterferenceOnS1().
370       SetInterference(ChFiKPart_IndexCurveInDS(GCirCon,DStr),
371                       trans,GLin2dCon,GLin2dCh2);
372   }
373   
374
375   return Standard_True;
376 }
377
378 */
379
380
381
382
383
384