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
|
#include <IntAna2d_AnaIntersection.jxx>
#include <ElCLib.hxx>
//=======================================================================
//function : Perform
//purpose :
//=======================================================================
void IntAna2d_AnaIntersection::Perform(const gp_Lin2d& L,
const gp_Circ2d& C)
{
done=Standard_False;
iden=Standard_False;
para=Standard_False;
//
Standard_Real A,B,C0, d;
gp_Pnt2d aP2D, aP2D1, aP2D2;
//
L.Coefficients(A,B,C0);
d=A*C.Location().X() + B*C.Location().Y() + C0;
if (Abs(d)-C.Radius()>Epsilon(C.Radius())) {
empt=Standard_True;
nbp=0;
}
else { // Au moins 1 solution
empt=Standard_False;
//
//modified by NIZNHY-PKV Fri Jun 15 09:55:00 2007f
//Standard_Real ang;
//ang = C.XAxis().Direction().Angle(L.Direction());
//ang = ang + PI / 2.0;
//modified by NIZNHY-PKV Fri Jun 15 09:55:29 2007t
if (Abs(Abs(d)-C.Radius())<=Epsilon(C.Radius())) { // Cas de tangence
Standard_Real u, XS, YS, ang;
//
nbp=1;
XS=C.Location().X() - d*A;
YS=C.Location().Y() - d*B;
//
//modified by NIZNHY-PKV Fri Jun 15 09:55:35 2007f
aP2D.SetCoord(XS, YS);
u=ElCLib::Parameter(L, aP2D);
ang=ElCLib::Parameter(C, aP2D);
/*
u=B*(L.Location().X()-C.Location().X()) -
A*(L.Location().Y()-C.Location().Y());
if (d<0.0) {ang=ang+PI;}
if (ang>=2.0*PI) {
ang=ang-2.0*PI;
}
else if (ang<0.0) {
ang=ang+2.0*PI;
}
*/
//modified by NIZNHY-PKV Fri Jun 15 09:55:41 2007t
lpnt[0].SetValue(XS,YS,u,ang);
}
else { // 2 points d intersection
Standard_Real h, XS1,YS1, XS2,YS2, ang1,ang2, u1,u2;//,cost,sint angt;
nbp=2;
h=Sqrt(C.Radius()*C.Radius()-d*d);
//modified by NIZNHY-PKV Fri Jun 15 09:55:47 2007f
//cost=d/C.Radius();
//sint=h/C.Radius();
//modified by NIZNHY-PKV Fri Jun 15 09:55:52 2007t
XS1=C.Location().X() - d*A - h*B;
YS1=C.Location().Y() - d*B + h*A;
XS2=C.Location().X() - d*A + h*B;
YS2=C.Location().Y() - d*B - h*A;
//
//modified by NIZNHY-PKV Fri Jun 15 09:55:57 2007f
aP2D1.SetCoord(XS1, YS1);
aP2D2.SetCoord(XS2, YS2);
u1=ElCLib::Parameter(L, aP2D1);
u2=ElCLib::Parameter(L, aP2D2);
ang1=ElCLib::Parameter(C, aP2D1);
ang2=ElCLib::Parameter(C, aP2D2);
//
/*
if (Abs(cost)<=0.707) {
angt=ACos(cost);
}
else {
angt=ASin(sint);
if (cost<0) {angt=PI-angt;}
}
ang1=ang-angt;
ang2=ang+angt;
if (ang1<0.0) {
ang1=ang1+2.0*PI;
}
else if (ang1>=2.0*PI) {
ang1=ang1-2.0*PI;
}
if (ang2<0.0) {
ang2=ang2+2.0*PI;
}
else if (ang2>=2.0*PI) {
ang2=ang2-2.0*PI;
}
u1=B*(L.Location().X()-C.Location().X()) -
A*(L.Location().Y()-C.Location().Y()) +h;
u2=u1-2.0*h;
*/
//modified by NIZNHY-PKV Fri Jun 15 09:56:19 2007t
lpnt[0].SetValue(XS1,YS1,u1,ang1);
lpnt[1].SetValue(XS2,YS2,u2,ang2);
}
}
done=Standard_True;
}
|
