| 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 // GEANT 4 class implementation file
29 // ------------------------------------------------------------
30 //
31
32 #include "G4ErrorSurfaceTrajParam.hh"
33 #include <iomanip>
34
35 #include "G4ThreeVector.hh"
36 #include "G4GeometryTolerance.hh"
37
38 //------------------------------------------------------------------------
39 G4ErrorSurfaceTrajParam::G4ErrorSurfaceTrajParam(const G4Point3D& pos,
40 const G4Vector3D& mom,
41 const G4Vector3D& vecV,
42 const G4Vector3D& vecW)
43 {
44 SetParameters(pos, mom, vecV, vecW);
45 }
46
47 //------------------------------------------------------------------------
48 G4ErrorSurfaceTrajParam::G4ErrorSurfaceTrajParam(const G4Point3D& pos,
49 const G4Vector3D& mom,
50 const G4Plane3D& plane)
51 {
52 SetParameters(pos, mom, plane);
53 }
54
55 //------------------------------------------------------------------------
56 void G4ErrorSurfaceTrajParam::SetParameters(const G4Point3D& pos,
57 const G4Vector3D& mom,
58 const G4Plane3D& plane)
59 {
60 //--- Get two perpendicular vectors: first parallel X
61 // (unless normal is parallel to X, then take Y)
62
63 G4double kCarTolerance =
64 G4GeometryTolerance::GetInstance()->GetSurfaceTolerance();
65
66 G4ThreeVector Xvec(1., 0., 0.);
67 G4Vector3D vecV = -Xvec.cross(plane.normal());
68 if(vecV.mag() < kCarTolerance)
69 {
70 G4ThreeVector Zvec(0., 0., 1.);
71 vecV = Zvec.cross(plane.normal());
72 }
73
74 G4Vector3D vecW = plane.normal().cross(vecV);
75
76 SetParameters(pos, mom, vecV, vecW);
77 }
78
79 //------------------------------------------------------------------------
80 void G4ErrorSurfaceTrajParam::SetParameters(const G4Point3D& pos,
81 const G4Vector3D& mom,
82 const G4Vector3D& vecV,
83 const G4Vector3D& vecW)
84 {
85 if(mom.mag() > 0.)
86 {
87 fDir = mom;
88 fDir /= mom.mag();
89 }
90 else
91 {
92 fDir = G4Vector3D(0., 0., 0.);
93 }
94 fVectorV = vecV / vecV.mag();
95 fVectorW = vecW / vecW.mag();
96 fInvP = 1. / mom.mag();
97 G4ThreeVector momv(mom);
98 // check 3 vectors are ortogonal and right handed
99
100 // now all 4 scalar memeber variables retain the signs
101 // fPV = momv.project( vecV ).mag();
102 // fPW = momv.project( vecW ).mag();
103 fPV = momv.dot(vecV);
104 fPW = momv.dot(vecW);
105
106 G4ThreeVector posv(pos);
107 // fV = posv.project( vecV ).mag();
108 // fW = posv.project( vecW ).mag();
109 fV = posv.dot(vecV);
110 fW = posv.dot(vecW);
111 }
112
113 //------------------------------------------------------------------------
114 std::ostream& operator<<(std::ostream& out, const G4ErrorSurfaceTrajParam& tp)
115 {
116 // long mode = out.setf(std::ios::fixed,std::ios::floatfield);
117
118 // out << tp.theType;
119 // out << std::setprecision(5) << std::setw(10);
120 out << " InvP= " << tp.fInvP << " PV= " << tp.fPV << " PW= " << tp.fPW
121 << " V= " << tp.fV << " W= " << tp.fW << G4endl;
122 out << " vectorV direction= " << tp.fVectorV
123 << " vectorW direction= " << tp.fVectorW << G4endl;
124
125 return out;
126 }
127