Geant4 Cross Reference |
1 // 1 // 2 // ******************************************* 2 // ******************************************************************** 3 // * License and Disclaimer 3 // * License and Disclaimer * 4 // * 4 // * * 5 // * The Geant4 software is copyright of th 5 // * The Geant4 software is copyright of the Copyright Holders of * 6 // * the Geant4 Collaboration. It is provided 6 // * the Geant4 Collaboration. It is provided under the terms and * 7 // * conditions of the Geant4 Software License 7 // * conditions of the Geant4 Software License, included in the file * 8 // * LICENSE and available at http://cern.ch/ 8 // * LICENSE and available at http://cern.ch/geant4/license . These * 9 // * include a list of copyright holders. 9 // * include a list of copyright holders. * 10 // * 10 // * * 11 // * Neither the authors of this software syst 11 // * Neither the authors of this software system, nor their employing * 12 // * institutes,nor the agencies providing fin 12 // * institutes,nor the agencies providing financial support for this * 13 // * work make any representation or warran 13 // * work make any representation or warranty, express or implied, * 14 // * regarding this software system or assum 14 // * regarding this software system or assume any liability for its * 15 // * use. Please see the license in the file 15 // * use. Please see the license in the file LICENSE and URL above * 16 // * for the full disclaimer and the limitatio 16 // * for the full disclaimer and the limitation of liability. * 17 // * 17 // * * 18 // * This code implementation is the result 18 // * This code implementation is the result of the scientific and * 19 // * technical work of the GEANT4 collaboratio 19 // * technical work of the GEANT4 collaboration. * 20 // * By using, copying, modifying or distri 20 // * By using, copying, modifying or distributing the software (or * 21 // * any work based on the software) you ag 21 // * any work based on the software) you agree to acknowledge its * 22 // * use in resulting scientific publicati 22 // * use in resulting scientific publications, and indicate your * 23 // * acceptance of all terms of the Geant4 Sof 23 // * acceptance of all terms of the Geant4 Software license. * 24 // ******************************************* 24 // ******************************************************************** 25 // 25 // >> 26 // $Id: G4ErrorSurfaceTrajParam.cc 69766 2013-05-14 14:33:55Z gcosmo $ 26 // 27 // 27 // ------------------------------------------- 28 // ------------------------------------------------------------ 28 // GEANT 4 class implementation file << 29 // GEANT 4 class implementation file 29 // ------------------------------------------- 30 // ------------------------------------------------------------ 30 // 31 // 31 32 32 #include "G4ErrorSurfaceTrajParam.hh" 33 #include "G4ErrorSurfaceTrajParam.hh" 33 #include <iomanip> 34 #include <iomanip> 34 35 35 #include "G4ThreeVector.hh" 36 #include "G4ThreeVector.hh" 36 #include "G4GeometryTolerance.hh" 37 #include "G4GeometryTolerance.hh" 37 38 38 //-------------------------------------------- 39 //------------------------------------------------------------------------ 39 G4ErrorSurfaceTrajParam::G4ErrorSurfaceTrajPar << 40 G4ErrorSurfaceTrajParam:: 40 << 41 G4ErrorSurfaceTrajParam( const G4Point3D& pos, const G4Vector3D& mom, 41 << 42 const G4Vector3D& vecV, const G4Vector3D& vecW ) 42 << 43 { 43 { 44 SetParameters(pos, mom, vecV, vecW); << 44 SetParameters( pos, mom, vecV, vecW ); 45 } 45 } 46 46 >> 47 47 //-------------------------------------------- 48 //------------------------------------------------------------------------ 48 G4ErrorSurfaceTrajParam::G4ErrorSurfaceTrajPar << 49 G4ErrorSurfaceTrajParam:: 49 << 50 G4ErrorSurfaceTrajParam( const G4Point3D& pos, const G4Vector3D& mom, 50 << 51 const G4Plane3D& plane ) 51 { 52 { 52 SetParameters(pos, mom, plane); << 53 SetParameters( pos, mom, plane ); 53 } 54 } 54 55 55 //-------------------------------------------- 56 //------------------------------------------------------------------------ 56 void G4ErrorSurfaceTrajParam::SetParameters(co << 57 void G4ErrorSurfaceTrajParam:: 57 co << 58 SetParameters( const G4Point3D& pos, const G4Vector3D& mom, 58 co << 59 const G4Plane3D& plane ) 59 { 60 { 60 //--- Get two perpendicular vectors: first p 61 //--- Get two perpendicular vectors: first parallel X 61 // (unless normal is parallel to X, then 62 // (unless normal is parallel to X, then take Y) 62 63 63 G4double kCarTolerance = 64 G4double kCarTolerance = 64 G4GeometryTolerance::GetInstance()->GetSur 65 G4GeometryTolerance::GetInstance()->GetSurfaceTolerance(); 65 66 66 G4ThreeVector Xvec(1., 0., 0.); << 67 G4ThreeVector Xvec(1.,0.,0.); 67 G4Vector3D vecV = -Xvec.cross(plane.normal() 68 G4Vector3D vecV = -Xvec.cross(plane.normal()); 68 if(vecV.mag() < kCarTolerance) << 69 if( vecV.mag() < kCarTolerance ) 69 { 70 { 70 G4ThreeVector Zvec(0., 0., 1.); << 71 G4ThreeVector Zvec(0.,0.,1.); 71 vecV = Zvec.cross(plane.normal()); 72 vecV = Zvec.cross(plane.normal()); 72 } 73 } 73 74 74 G4Vector3D vecW = plane.normal().cross(vecV) << 75 G4Vector3D vecW = plane.normal().cross( vecV ); 75 76 76 SetParameters(pos, mom, vecV, vecW); << 77 SetParameters( pos, mom, vecV, vecW ); 77 } 78 } 78 79 >> 80 79 //-------------------------------------------- 81 //------------------------------------------------------------------------ 80 void G4ErrorSurfaceTrajParam::SetParameters(co << 82 void G4ErrorSurfaceTrajParam:: 81 co << 83 SetParameters( const G4Point3D& pos, const G4Vector3D& mom, 82 co << 84 const G4Vector3D& vecV, const G4Vector3D& vecW ) 83 co << 84 { 85 { 85 if(mom.mag() > 0.) << 86 if( mom.mag() > 0. ) { 86 { << 87 fDir = mom; 87 fDir = mom; 88 fDir /= mom.mag(); 88 fDir /= mom.mag(); 89 } << 89 } else { 90 else << 90 fDir = G4Vector3D(0.,0.,0.); 91 { << 92 fDir = G4Vector3D(0., 0., 0.); << 93 } 91 } 94 fVectorV = vecV / vecV.mag(); 92 fVectorV = vecV / vecV.mag(); 95 fVectorW = vecW / vecW.mag(); 93 fVectorW = vecW / vecW.mag(); 96 fInvP = 1. / mom.mag(); << 94 fInvP = 1./mom.mag(); 97 G4ThreeVector momv(mom); 95 G4ThreeVector momv(mom); 98 // check 3 vectors are ortogonal and right h << 96 //check 3 vectors are ortogonal and right handed 99 97 100 // now all 4 scalar memeber variables retain 98 // now all 4 scalar memeber variables retain the signs 101 // fPV = momv.project( vecV ).mag(); 99 // fPV = momv.project( vecV ).mag(); 102 // fPW = momv.project( vecW ).mag(); 100 // fPW = momv.project( vecW ).mag(); 103 fPV = momv.dot(vecV); << 101 fPV = momv.dot( vecV ); 104 fPW = momv.dot(vecW); << 102 fPW = momv.dot( vecW ); >> 103 105 104 106 G4ThreeVector posv(pos); 105 G4ThreeVector posv(pos); 107 // fV = posv.project( vecV ).mag(); 106 // fV = posv.project( vecV ).mag(); 108 // fW = posv.project( vecW ).mag(); 107 // fW = posv.project( vecW ).mag(); 109 fV = posv.dot(vecV); << 108 fV = posv.dot( vecV ); 110 fW = posv.dot(vecW); << 109 fW = posv.dot( vecW ); 111 } 110 } 112 111 >> 112 113 //-------------------------------------------- 113 //------------------------------------------------------------------------ 114 std::ostream& operator<<(std::ostream& out, co 114 std::ostream& operator<<(std::ostream& out, const G4ErrorSurfaceTrajParam& tp) 115 { 115 { 116 // long mode = out.setf(std::ios::fixed,std 116 // long mode = out.setf(std::ios::fixed,std::ios::floatfield); 117 << 117 118 // out << tp.theType; 118 // out << tp.theType; 119 // out << std::setprecision(5) << std::setw 119 // out << std::setprecision(5) << std::setw(10); 120 out << " InvP= " << tp.fInvP << " PV= " << t << 120 out << " InvP= " << tp.fInvP << " PV= " << tp.fPV 121 << " V= " << tp.fV << " W= " << tp.fW << << 121 << " PW= " << tp.fPW << " V= " << tp.fV << " W= " << tp.fW << G4endl; 122 out << " vectorV direction= " << tp.fVectorV 122 out << " vectorV direction= " << tp.fVectorV 123 << " vectorW direction= " << tp.fVectorW 123 << " vectorW direction= " << tp.fVectorW << G4endl; 124 << 124 125 return out; 125 return out; 126 } 126 } 127 127