Geant4 Cross Reference |
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 // 28 #include "G3toG4.hh" 29 #include "G3RotTable.hh" 30 #include "G3toG4RotationMatrix.hh" 31 #include "G4PhysicalConstants.hh" 32 #include "G4ThreeVector.hh" 33 34 void PG4gsrotm(G4String *tokens) 35 { 36 // fill the parameter containers 37 G3fillParams(tokens,PTgsrotm); 38 39 // interpret the parameters 40 G4int irot = Ipar[0]; 41 42 // the angles in Geant are in degrees 43 G4double theta1 = Rpar[0]; 44 G4double phi1 = Rpar[1]; 45 G4double theta2 = Rpar[2]; 46 G4double phi2 = Rpar[3]; 47 G4double theta3 = Rpar[4]; 48 G4double phi3 = Rpar[5]; 49 50 G4gsrotm(irot, theta1,phi1, theta2,phi2, theta3,phi3); 51 } 52 53 void G4gsrotm(G4int irot, G4double theta1, G4double phi1, 54 G4double theta2, G4double phi2, G4double theta3, G4double phi3) 55 { 56 G4double degrad = pi/180; 57 58 G4double th1r = theta1*degrad; 59 G4double th2r = theta2*degrad; 60 G4double th3r = theta3*degrad; 61 62 G4double phi1r = phi1*degrad; 63 G4double phi2r = phi2*degrad; 64 G4double phi3r = phi3*degrad; 65 66 // Construct unit vectors 67 68 G4ThreeVector x(std::sin(th1r)*std::cos(phi1r), std::sin(th1r)*std::sin(phi1r), std::cos(th1r)); 69 G4ThreeVector y(std::sin(th2r)*std::cos(phi2r), std::sin(th2r)*std::sin(phi2r), std::cos(th2r)); 70 G4ThreeVector z(std::sin(th3r)*std::cos(phi3r), std::sin(th3r)*std::sin(phi3r), std::cos(th3r)); 71 72 // check for orthonormality and left-handedness 73 74 G4double check = (x.cross(y))*z; 75 G4double tol = 1.0e-3; 76 77 if (1-std::abs(check)>tol) { 78 G4cerr << "Coordinate axes forming rotation matrix " 79 << irot << " are not orthonormal.(" << 1-std::abs(check) << ")" 80 << G4endl; 81 G4cerr << " theta1=" << theta1; 82 G4cerr << " phi1=" << phi1; 83 G4cerr << " theta2=" << theta2; 84 G4cerr << " phi2=" << phi2; 85 G4cerr << " theta3=" << theta3; 86 G4cerr << " phi3=" << phi3; 87 G4cerr << G4endl; 88 G4Exception("G4gsrotm()", "G3toG40023", FatalException, 89 "Non orthogonal axes!"); 90 return; 91 } 92 //else if (1+check<=tol) { 93 // G4cerr << "G4gsrotm warning: coordinate axes forming rotation " 94 // << "matrix " << irot << " are left-handed" << G4endl; 95 //} 96 97 G3toG4RotationMatrix* rotp = new G3toG4RotationMatrix; 98 99 rotp->SetRotationMatrixByRow(x, y, z); 100 101 // add it to the List 102 103 G3Rot.Put(irot, rotp); 104 } 105