blob: d37063533a1a93659b8a5f4f548f8936fc440a7b (
plain)
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
|
// File gp_Dir2d.cxx , REG 27/10/90 nouvelle version
// JCV 08/01/90 Modifs suite a l'introduction des classes XY et Mat2d dans gp
#include <gp_Dir2d.ixx>
Standard_Real gp_Dir2d::Angle (const gp_Dir2d& Other) const
{
// Commentaires :
// Au dessus de 45 degres l'arccos donne la meilleur precision pour le
// calcul de l'angle. Sinon il vaut mieux utiliser l'arcsin.
// Les erreurs commises sont loin d'etre negligeables lorsque l'on est
// proche de zero ou de 90 degres.
// En 2D les valeurs angulaires sont comprises entre -PI et PI
Standard_Real Cosinus = coord.Dot (Other.coord);
Standard_Real Sinus = coord.Crossed (Other.coord);
if (Cosinus > -0.70710678118655 && Cosinus < 0.70710678118655) {
if (Sinus > 0.0) return acos (Cosinus);
else return - acos (Cosinus);
}
else {
if (Cosinus > 0.0) return asin (Sinus);
else {
if (Sinus > 0.0) return Standard_PI - asin (Sinus);
else return -Standard_PI - asin (Sinus);
}
}
}
void gp_Dir2d::Mirror (const gp_Ax2d& A2)
{
const gp_XY& XY = A2.Direction().XY();
Standard_Real A = XY.X();
Standard_Real B = XY.Y();
Standard_Real X = coord.X();
Standard_Real Y = coord.Y();
Standard_Real M1 = 2.0 * A * B;
Standard_Real XX = ((2.0 * A * A) - 1.0) * X + M1 * Y;
Standard_Real YY = M1 * X + ((2.0 * B * B) - 1.0) * Y;
coord.SetCoord(XX,YY);
}
void gp_Dir2d::Transform (const gp_Trsf2d& T)
{
if (T.Form() == gp_Identity || T.Form() == gp_Translation) { }
else if (T.Form() == gp_PntMirror) { coord.Reverse(); }
else if (T.Form() == gp_Scale) {
if (T.ScaleFactor() < 0.0) { coord.Reverse(); }
}
else {
coord.Multiply (T.HVectorialPart());
Standard_Real D = coord.Modulus();
coord.Divide(D);
if (T.ScaleFactor() < 0.0) { coord.Reverse(); }
}
}
void gp_Dir2d::Mirror (const gp_Dir2d& V)
{
const gp_XY& XY = V.coord;
Standard_Real A = XY.X();
Standard_Real B = XY.Y();
Standard_Real X = coord.X();
Standard_Real Y = coord.Y();
Standard_Real M1 = 2.0 * A * B;
Standard_Real XX = ((2.0 * A * A) - 1.0) * X + M1 * Y;
Standard_Real YY = M1 * X + ((2.0 * B * B) - 1.0) * Y;
coord.SetCoord(XX,YY);
}
gp_Dir2d gp_Dir2d::Mirrored (const gp_Dir2d& V) const
{
gp_Dir2d Vres = *this;
Vres.Mirror (V);
return Vres;
}
gp_Dir2d gp_Dir2d::Mirrored (const gp_Ax2d& A) const
{
gp_Dir2d V = *this;
V.Mirror (A);
return V;
}
|
