1 | // |
---|
2 | // ******************************************************************** |
---|
3 | // * License and Disclaimer * |
---|
4 | // * * |
---|
5 | // * The Geant4 software is copyright of the Copyright Holders of * |
---|
6 | // * the Geant4 Collaboration. It is provided under the terms and * |
---|
7 | // * conditions of the Geant4 Software License, included in the file * |
---|
8 | // * LICENSE and available at http://cern.ch/geant4/license . These * |
---|
9 | // * include a list of copyright holders. * |
---|
10 | // * * |
---|
11 | // * Neither the authors of this software system, nor their employing * |
---|
12 | // * institutes,nor the agencies providing financial support for this * |
---|
13 | // * work make any representation or warranty, express or implied, * |
---|
14 | // * regarding this software system or assume any liability for its * |
---|
15 | // * use. Please see the license in the file LICENSE and URL above * |
---|
16 | // * for the full disclaimer and the limitation of liability. * |
---|
17 | // * * |
---|
18 | // * This code implementation is the result of the scientific and * |
---|
19 | // * technical work of the GEANT4 collaboration. * |
---|
20 | // * By using, copying, modifying or distributing the software (or * |
---|
21 | // * any work based on the software) you agree to acknowledge its * |
---|
22 | // * use in resulting scientific publications, and indicate your * |
---|
23 | // * acceptance of all terms of the Geant4 Software license. * |
---|
24 | // ******************************************************************** |
---|
25 | // |
---|
26 | // |
---|
27 | // $Id: testG4AffineTransform.cc,v 1.9 2006/06/29 18:58:27 gunter Exp $ |
---|
28 | // GEANT4 tag $Name: geant4-09-04-beta-cand-01 $ |
---|
29 | // |
---|
30 | |
---|
31 | #include <assert.h> |
---|
32 | #include "G4AffineTransform.hh" |
---|
33 | #include "G4ThreeVector.hh" |
---|
34 | #include "G4RotationMatrix.hh" |
---|
35 | |
---|
36 | #include "ApproxEqual.hh" |
---|
37 | |
---|
38 | |
---|
39 | G4bool testG4AffineTransform() |
---|
40 | { |
---|
41 | G4ThreeVector zeroVec,xVec(1,0,0),xyzVec(1,1,1),xyzrotVec(-1,1,1); |
---|
42 | G4RotationMatrix identity,xRot; |
---|
43 | // NOTE: xRot = rotation such that x axis->y axis & y axis->-x axis |
---|
44 | xRot.rotateZ(-pi*0.5); |
---|
45 | |
---|
46 | G4AffineTransform origin; |
---|
47 | assert(origin.NetRotation()==identity); |
---|
48 | assert(origin.NetTranslation()==zeroVec); |
---|
49 | assert(!origin.IsRotated()); |
---|
50 | assert(!origin.IsTranslated()); |
---|
51 | |
---|
52 | G4AffineTransform rotTf(xRot); |
---|
53 | assert(rotTf.NetRotation()==xRot); |
---|
54 | assert(rotTf.NetTranslation()==zeroVec); |
---|
55 | assert(rotTf.IsRotated()); |
---|
56 | assert(!rotTf.IsTranslated()); |
---|
57 | |
---|
58 | G4AffineTransform txTf(xyzVec); |
---|
59 | assert(txTf.NetRotation()==identity); |
---|
60 | assert(txTf.NetTranslation()==xyzVec); |
---|
61 | assert(!txTf.IsRotated()); |
---|
62 | assert(txTf.IsTranslated()); |
---|
63 | |
---|
64 | G4AffineTransform rtTf(xRot,xyzVec); |
---|
65 | assert(rtTf.NetRotation()==xRot); |
---|
66 | assert(rtTf.NetTranslation()==xyzVec); |
---|
67 | assert(rtTf.IsRotated()); |
---|
68 | assert(rtTf.IsTranslated()); |
---|
69 | |
---|
70 | G4AffineTransform copyTf(rtTf); |
---|
71 | assert(copyTf==rtTf); |
---|
72 | |
---|
73 | G4AffineTransform compoundTf1=rotTf*txTf; |
---|
74 | assert(compoundTf1==rtTf); |
---|
75 | |
---|
76 | G4AffineTransform compoundTf2(rotTf); |
---|
77 | compoundTf2*=txTf; |
---|
78 | assert(compoundTf2==rtTf); |
---|
79 | |
---|
80 | G4AffineTransform compoundTf3; |
---|
81 | compoundTf3.Product(rotTf,txTf); |
---|
82 | assert(compoundTf3==rtTf); |
---|
83 | |
---|
84 | G4AffineTransform compoundTf4; |
---|
85 | compoundTf4.InverseProduct(rtTf,txTf); |
---|
86 | assert(ApproxEqual(compoundTf4,rotTf)); |
---|
87 | compoundTf4.InverseProduct(rtTf,rtTf); |
---|
88 | assert(ApproxEqual(compoundTf4,identity)); |
---|
89 | |
---|
90 | G4AffineTransform compoundTf5; |
---|
91 | compoundTf5.Product(rotTf,rtTf); |
---|
92 | G4AffineTransform compoundTf6; |
---|
93 | compoundTf6.InverseProduct(compoundTf5,rtTf); |
---|
94 | assert(ApproxEqual(compoundTf6,rotTf)); |
---|
95 | |
---|
96 | assert(ApproxEqual(rotTf.TransformPoint(xyzVec),xyzrotVec)); |
---|
97 | assert(ApproxEqual(rotTf.TransformAxis(xyzVec),xyzrotVec)); |
---|
98 | assert(ApproxEqual(txTf.TransformPoint(xyzVec),G4ThreeVector(2,2,2))); |
---|
99 | assert(txTf.TransformAxis(xyzVec)==xyzVec); |
---|
100 | assert(ApproxEqual(rtTf.TransformPoint(xVec),G4ThreeVector(1,2,1))); |
---|
101 | assert(ApproxEqual(rtTf.TransformAxis(xVec),G4ThreeVector(0,1,0))); |
---|
102 | |
---|
103 | G4ThreeVector vec(0,0,1); |
---|
104 | rtTf.ApplyPointTransform(vec); |
---|
105 | assert(ApproxEqual(vec,G4ThreeVector(1,1,2))); |
---|
106 | vec=G4ThreeVector(-1,2,-3); |
---|
107 | rtTf.ApplyAxisTransform(vec); |
---|
108 | assert(ApproxEqual(vec,G4ThreeVector(-2,-1,-3))); |
---|
109 | rtTf.ApplyPointTransform(vec); |
---|
110 | assert(ApproxEqual(vec,G4ThreeVector(2,-1,-2))); |
---|
111 | |
---|
112 | G4AffineTransform invTf=rtTf.Inverse(); |
---|
113 | |
---|
114 | #if 0 |
---|
115 | G4ThreeVector forwV= rtTf.TransformPoint(xyzVec); |
---|
116 | G4ThreeVector backV= invTf.TransformPoint(forwV); |
---|
117 | |
---|
118 | G4ThreeVector diffV= xyzVec - backV; |
---|
119 | G4cout << " Diff of xyzVec and backV is " << diffV << G4endl; |
---|
120 | #endif |
---|
121 | assert(ApproxEqual(invTf.TransformPoint(rtTf.TransformPoint(xyzVec)), |
---|
122 | xyzVec)); |
---|
123 | |
---|
124 | invTf*=rtTf; |
---|
125 | // Might need tolerant checking: |
---|
126 | assert(ApproxEqual(invTf,origin)); |
---|
127 | |
---|
128 | invTf=rtTf; |
---|
129 | invTf.Invert(); |
---|
130 | |
---|
131 | G4double MaxAbsDiff(const G4AffineTransform &tf1, |
---|
132 | const G4AffineTransform &tf2); |
---|
133 | G4double maxabsdiff= MaxAbsDiff( invTf, rtTf.Inverse() ); |
---|
134 | G4cout << "Max difference is " << maxabsdiff << G4endl; |
---|
135 | assert( maxabsdiff <= 1.e-12 ); |
---|
136 | |
---|
137 | G4AffineTransform rtTf_inv=rtTf.Inverse(); |
---|
138 | assert(MaxAbsDiff( invTf, rtTf_inv) <= 1.e-12 ); |
---|
139 | #if 0 |
---|
140 | assert(invTf==rtTf_inv); |
---|
141 | |
---|
142 | assert(invTf==rtTf_inv); |
---|
143 | #endif |
---|
144 | |
---|
145 | G4AffineTransform txTf2(xyzVec); |
---|
146 | txTf2+=xyzVec; |
---|
147 | assert(txTf2.NetRotation()==identity); |
---|
148 | assert(ApproxEqual(txTf2.NetTranslation(),xyzVec*2)); |
---|
149 | assert(txTf2!=txTf); |
---|
150 | txTf2-=xyzVec; |
---|
151 | assert(txTf2.NetRotation()==identity); |
---|
152 | assert(ApproxEqual(txTf2.NetTranslation(),xyzVec)); |
---|
153 | assert(ApproxEqual(txTf2,txTf)); |
---|
154 | txTf2.SetNetRotation(xRot); |
---|
155 | assert(txTf2.NetRotation()==xRot); |
---|
156 | txTf2.SetNetTranslation(xyzVec*3); |
---|
157 | assert(txTf2.NetTranslation()==xyzVec*3); |
---|
158 | |
---|
159 | return true; |
---|
160 | } |
---|
161 | |
---|
162 | int main() |
---|
163 | { |
---|
164 | |
---|
165 | #ifdef NDEBUG |
---|
166 | G4Exception("FAIL: *** Assertions must be compiled in! ***"); |
---|
167 | #endif |
---|
168 | assert(testG4AffineTransform()); |
---|
169 | return 0; |
---|
170 | } |
---|
171 | |
---|
172 | G4double MaxAbsDiff(const G4AffineTransform &tf1, |
---|
173 | const G4AffineTransform &tf2) |
---|
174 | { |
---|
175 | G4double maxabs= 0.0; |
---|
176 | for (G4int i=0;i<15;i++) |
---|
177 | { |
---|
178 | G4double absdiff; |
---|
179 | |
---|
180 | absdiff= std::fabs(tf1[i]-tf2[i]); |
---|
181 | maxabs= std::max(absdiff, maxabs); |
---|
182 | } |
---|
183 | return maxabs; |
---|
184 | } |
---|