[1316] | 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 $ |
---|
[1347] | 28 | // GEANT4 tag $Name: geant4-09-04-ref-00 $ |
---|
[1316] | 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 | } |
---|