| Geant4 Cross Reference |
1 // -*- C++ -*- 1 // -*- C++ -*-
2 // ------------------------------------------- 2 // ---------------------------------------------------------------------------
3 // 3 //
4 // This file is a part of the CLHEP - a Class 4 // This file is a part of the CLHEP - a Class Library for High Energy Physics.
5 // 5 //
6 // This is the implementation of methods of th 6 // This is the implementation of methods of the HepRotation class which
7 // were introduced when ZOOM PhysicsVectors wa 7 // were introduced when ZOOM PhysicsVectors was merged in, other than those
8 // involving Euler or axis/angle representatio 8 // involving Euler or axis/angle representations, lengthy corrections of
9 // the rotation matrix, or I/O. 9 // the rotation matrix, or I/O.
10 // 10 //
11 11
12 #include "CLHEP/Vector/Rotation.h" 12 #include "CLHEP/Vector/Rotation.h"
13 13
14 #include <cmath> 14 #include <cmath>
15 15
16 16
17 namespace CLHEP { 17 namespace CLHEP {
18 18
19 void HepRotation::decompose(HepAxisAngle & rot 19 void HepRotation::decompose(HepAxisAngle & rotation, Hep3Vector & boost)const {
20 boost.set(0,0,0); 20 boost.set(0,0,0);
21 rotation = axisAngle(); 21 rotation = axisAngle();
22 } 22 }
23 23
24 void HepRotation::decompose(Hep3Vector & boost 24 void HepRotation::decompose(Hep3Vector & boost, HepAxisAngle & rotation)const {
25 boost.set(0,0,0); 25 boost.set(0,0,0);
26 rotation = axisAngle(); 26 rotation = axisAngle();
27 } 27 }
28 28
29 double HepRotation::distance2( const HepRotati 29 double HepRotation::distance2( const HepRotation & r ) const {
30 double sum = rxx * r.rxx + rxy * r.rxy + rxz 30 double sum = rxx * r.rxx + rxy * r.rxy + rxz * r.rxz
31 + ryx * r.ryx + ryy * r.ryy + 31 + ryx * r.ryx + ryy * r.ryy + ryz * r.ryz
32 + rzx * r.rzx + rzy * r.rzy + 32 + rzx * r.rzx + rzy * r.rzy + rzz * r.rzz;
33 double answer = 3.0 - sum; 33 double answer = 3.0 - sum;
34 return (answer >= 0 ) ? answer : 0; 34 return (answer >= 0 ) ? answer : 0;
35 } 35 }
36 36
37 double HepRotation::howNear( const HepRotati 37 double HepRotation::howNear( const HepRotation & r ) const {
38 return std::sqrt( distance2( r ) ); 38 return std::sqrt( distance2( r ) );
39 } 39 }
40 40
41 bool HepRotation::isNear( const HepRotation 41 bool HepRotation::isNear( const HepRotation & r,
42 double ep 42 double epsilon) const {
43 return distance2( r ) <= epsilon*epsilon; 43 return distance2( r ) <= epsilon*epsilon;
44 } 44 }
45 45
46 double HepRotation::norm2() const { 46 double HepRotation::norm2() const {
47 double answer = 3.0 - rxx - ryy - rzz; 47 double answer = 3.0 - rxx - ryy - rzz;
48 return (answer >= 0 ) ? answer : 0; 48 return (answer >= 0 ) ? answer : 0;
49 } 49 }
50 50
51 } // namespace CLHEP 51 } // namespace CLHEP
52 52