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