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
|
// File gp_GTrsf2d.cxx JCV 08/01/91
#include <gp_GTrsf2d.ixx>
#include <Standard_ConstructionError.hxx>
#include <Precision.hxx>
void gp_GTrsf2d::SetAffinity (const gp_Ax2d& A,
const Standard_Real Ratio)
{
shape = gp_Other;
scale = 0.0;
Standard_Real a = A.Direction().X();
Standard_Real b = A.Direction().Y();
matrix.SetValue (1, 1, (1.0 - Ratio)*a*a + Ratio);
matrix.SetValue (2, 2, (1.0 - Ratio)*b*b + Ratio);
matrix.SetValue (1, 2, (1.0 - Ratio)*a*b);
matrix.SetValue (2, 1, matrix.Value (1, 2));
loc = A.Location().XY();
loc.Reverse();
loc.Multiply (matrix);
loc.Add (A.Location().XY());
}
void gp_GTrsf2d::SetTranslationPart (const gp_XY& Coord)
{
loc = Coord;
if (Form() == gp_CompoundTrsf || Form() == gp_Other ||
Form() == gp_Translation) { }
else if (Form() == gp_Identity) { shape = gp_Translation; }
else { shape = gp_CompoundTrsf; }
}
void gp_GTrsf2d::Invert ()
{
if (shape == gp_Other) {
matrix.Invert();
loc.Multiply (matrix);
loc.Reverse();
}
else {
gp_Trsf2d T = Trsf2d ();
T.Invert ();
SetTrsf2d (T);
}
}
void gp_GTrsf2d::Multiply (const gp_GTrsf2d& T)
{
if (Form() == gp_Other || T.Form() == gp_Other) {
shape = gp_Other;
loc.Add (T.loc.Multiplied (matrix));
matrix.Multiply(T.matrix);
}
else {
gp_Trsf2d T1 = Trsf2d();
gp_Trsf2d T2 = T.Trsf2d();
T1.Multiply(T2);
matrix = T1.matrix;
loc = T1.loc;
scale = T1.scale;
shape = T1.shape;
}
}
void gp_GTrsf2d::Power (const Standard_Integer N)
{
if (N == 0) {
scale = 1.0;
shape = gp_Identity;
matrix.SetIdentity();
loc = gp_XY (0., 0.);
}
else if (N == 1) { }
else if (N == -1) { Invert(); }
else {
if (N < 0) { Invert(); }
if (shape == gp_Other) {
Standard_Integer Npower = N;
if (Npower < 0) Npower = - Npower;
Npower--;
gp_XY Temploc = loc;
// Standard_Real Tempscale = scale;
gp_Mat2d Tempmatrix (matrix);
while (1) {
if (IsOdd(Npower)) {
loc.Add (Temploc.Multiplied (matrix));
matrix.Multiply (Tempmatrix);
}
if (Npower == 1) { break; }
Temploc.Add (Temploc.Multiplied (Tempmatrix));
Tempmatrix.Multiply (Tempmatrix);
Npower = Npower/2;
}
}
else {
gp_Trsf2d T = Trsf2d ();
T.Power (N);
SetTrsf2d (T);
}
}
}
void gp_GTrsf2d::PreMultiply (const gp_GTrsf2d& T)
{
if (Form() == gp_Other || T.Form() == gp_Other) {
shape = gp_Other;
loc.Multiply (T.matrix);
loc.Add (T.loc);
matrix.PreMultiply(T.matrix);
}
else {
gp_Trsf2d T1 = Trsf2d();
gp_Trsf2d T2 = T.Trsf2d();
T1.PreMultiply(T2);
matrix = T1.matrix;
loc = T1.loc;
scale = T1.scale;
shape = T1.shape;
}
}
gp_Trsf2d gp_GTrsf2d::Trsf2d () const
{
gp_Trsf2d T;
Standard_Real value;
#ifndef No_Exception
Standard_Real tolerance = Precision::Angular() ;
Standard_Real tol2 = 2. * tolerance;
#endif
Standard_ConstructionError_Raise_if
(Form() == gp_Other," gp_GTrsf2d::Trsf2d() - non-orthogonal GTrsf2d (0)");
//Test of orthogonality
value = (matrix.Value(1,1) * matrix.Value(1,1) +
matrix.Value(2,1) * matrix.Value(2,1)) ;
Standard_ConstructionError_Raise_if
(Abs(value - 1.) > tol2," gp_GTrsf2d::Trsf2d() - non-orthogonal GTrsf2d (1)");
value = (matrix.Value(1,2) * matrix.Value(1,2) +
matrix.Value(2,2) * matrix.Value(2,2));
Standard_ConstructionError_Raise_if
(Abs(value - 1.) > tol2," gp_GTrsf2d::Trsf2d() - non-orthogonal GTrsf2d (2)");
value = (matrix.Value(1,1) * matrix.Value(1,2) +
matrix.Value(2,1) * matrix.Value(2,2));
Standard_ConstructionError_Raise_if
(Abs(value) > tolerance," gp_GTrsf2d::Trsf2d() - non-orthogonal GTrsf2d (3)");
//
T.matrix = matrix ;
T.shape = shape;
T.scale = scale ;
T.loc = loc;
return T;
}
|
