0032137: Coding Rules - merge redundant .lxx files into header files within Package gp
[occt.git] / src / gp / gp_GTrsf2d.cxx
1 // Copyright (c) 1995-1999 Matra Datavision
2 // Copyright (c) 1999-2014 OPEN CASCADE SAS
3 //
4 // This file is part of Open CASCADE Technology software library.
5 //
6 // This library is free software; you can redistribute it and/or modify it under
7 // the terms of the GNU Lesser General Public License version 2.1 as published
8 // by the Free Software Foundation, with special exception defined in the file
9 // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
10 // distribution for complete text of the license and disclaimer of any warranty.
11 //
12 // Alternatively, this file may be used under the terms of Open CASCADE
13 // commercial license or contractual agreement.
14
15 #include <gp_GTrsf2d.hxx>
16
17 #include <gp_Ax2d.hxx>
18 #include <gp_Mat2d.hxx>
19 #include <gp_Trsf2d.hxx>
20 #include <gp_XY.hxx>
21 #include <Precision.hxx>
22 #include <Standard_ConstructionError.hxx>
23 #include <Standard_OutOfRange.hxx>
24
25 void gp_GTrsf2d::SetAffinity (const gp_Ax2d& A,
26                               const Standard_Real Ratio)
27 {
28   shape = gp_Other;
29   scale = 0.0;
30   Standard_Real a = A.Direction().X();
31   Standard_Real b = A.Direction().Y();
32   matrix.SetValue (1, 1, (1.0 - Ratio)*a*a + Ratio);
33   matrix.SetValue (2, 2, (1.0 - Ratio)*b*b + Ratio);
34   matrix.SetValue (1, 2, (1.0 - Ratio)*a*b);
35   matrix.SetValue (2, 1, matrix.Value (1, 2));
36   loc = A.Location().XY();
37   loc.Reverse();
38   loc.Multiply (matrix);
39   loc.Add (A.Location().XY());
40 }
41
42 void gp_GTrsf2d::SetTranslationPart (const gp_XY& Coord)
43 {
44   loc = Coord;
45   if (Form() == gp_CompoundTrsf || Form() == gp_Other || 
46       Form() == gp_Translation) { }
47   else if (Form() == gp_Identity) { shape = gp_Translation; }
48   else { shape = gp_CompoundTrsf; }
49 }
50
51 void gp_GTrsf2d::Invert ()
52 {
53   if (shape == gp_Other) {
54     matrix.Invert();
55     loc.Multiply (matrix);
56     loc.Reverse();
57   }
58   else {
59     gp_Trsf2d T = Trsf2d ();
60     T.Invert ();
61     SetTrsf2d (T);
62   }
63 }
64
65 void gp_GTrsf2d::Multiply (const gp_GTrsf2d& T)
66 {
67   if (Form() == gp_Other || T.Form() == gp_Other) {
68     shape = gp_Other;
69     loc.Add (T.loc.Multiplied (matrix));
70     matrix.Multiply(T.matrix);
71   }
72   else {
73     gp_Trsf2d T1 = Trsf2d();
74     gp_Trsf2d T2 = T.Trsf2d();
75     T1.Multiply(T2);
76     matrix = T1.matrix;
77     loc = T1.loc;
78     scale = T1.scale;
79     shape = T1.shape;
80   }
81 }
82
83 void gp_GTrsf2d::Power (const Standard_Integer N)
84 {
85   if (N == 0)  {
86     scale = 1.0;
87     shape = gp_Identity;
88     matrix.SetIdentity();
89     loc = gp_XY (0., 0.);
90   }
91   else if (N == 1) { }
92   else if (N == -1) { Invert(); }
93   else {
94     if (N < 0) { Invert(); }
95     if (shape == gp_Other) {
96       Standard_Integer Npower = N;
97       if (Npower < 0) Npower = - Npower;
98       Npower--;
99       gp_XY Temploc = loc;
100 //      Standard_Real Tempscale = scale;
101       gp_Mat2d Tempmatrix (matrix);
102       for(;;) {
103         if (IsOdd(Npower)) {
104           loc.Add (Temploc.Multiplied (matrix));
105           matrix.Multiply (Tempmatrix);
106         }
107         if (Npower == 1) { break; }
108         Temploc.Add (Temploc.Multiplied (Tempmatrix));
109         Tempmatrix.Multiply (Tempmatrix);
110         Npower = Npower/2;
111       }
112     }
113     else {
114       gp_Trsf2d T = Trsf2d ();
115       T.Power (N);
116       SetTrsf2d (T);
117     }
118   }
119 }
120
121 void gp_GTrsf2d::PreMultiply (const gp_GTrsf2d& T)
122 {
123   if (Form() == gp_Other || T.Form() == gp_Other) {
124     shape = gp_Other;
125     loc.Multiply (T.matrix);
126     loc.Add (T.loc);
127     matrix.PreMultiply(T.matrix);
128   }
129   else {
130     gp_Trsf2d T1 = Trsf2d();
131     gp_Trsf2d T2 = T.Trsf2d();
132     T1.PreMultiply(T2);
133     matrix = T1.matrix;
134     loc = T1.loc;
135     scale = T1.scale;
136     shape = T1.shape;
137   }
138 }
139
140 gp_Trsf2d gp_GTrsf2d::Trsf2d () const
141 {
142   // Test of orthogonality
143   const Standard_Real aTolerance  = Precision::Angular();
144   const Standard_Real aTolerance2 = 2.0 * aTolerance;
145
146   if ( Form() == gp_Other )
147     throw Standard_ConstructionError("gp_GTrsf2d::Trsf2d() - non-orthogonal GTrsf2d(0)");
148
149   Standard_Real value = (matrix.Value(1, 1) * matrix.Value(1, 1)
150                       +  matrix.Value(2, 1) * matrix.Value(2, 1));
151   if ( Abs(value - 1.) > aTolerance2 )
152     throw Standard_ConstructionError("gp_GTrsf2d::Trsf2d() - non-orthogonal GTrsf2d(1)");
153
154   value = (matrix.Value(1, 2) * matrix.Value(1, 2)
155         +  matrix.Value(2, 2) * matrix.Value(2, 2));
156   if ( Abs(value - 1.) > aTolerance2 )
157     throw Standard_ConstructionError("gp_GTrsf2d::Trsf2d() - non-orthogonal GTrsf2d(2)");
158
159   value = (matrix.Value(1, 1) * matrix.Value(1, 2)
160         +  matrix.Value(2, 1) * matrix.Value(2, 2));
161   if ( Abs(value) > aTolerance )
162     throw Standard_ConstructionError("gp_GTrsf2d::Trsf2d() - non-orthogonal GTrsf2d(3)");
163
164
165   gp_Trsf2d aTransformation;
166   aTransformation.matrix = matrix;
167   aTransformation.shape  = shape;
168   aTransformation.scale  = scale;
169   aTransformation.loc    = loc;
170
171   return aTransformation;
172 }
173