Geant4 Cross Reference |
1 // -*- C++ -*- 1 2 // ------------------------------------------- 3 // 4 // This file is a part of the CLHEP - a Class 5 // 6 // This is the implementation of methods of th 7 // were introduced when ZOOM PhysicsVectors wa 8 // involving Euler or axis/angle representatio 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 & rot 20 boost.set(0,0,0); 21 rotation = axisAngle(); 22 } 23 24 void HepRotation::decompose(Hep3Vector & boost 25 boost.set(0,0,0); 26 rotation = axisAngle(); 27 } 28 29 double HepRotation::distance2( const HepRotati 30 double sum = rxx * r.rxx + rxy * r.rxy + rxz 31 + ryx * r.ryx + ryy * r.ryy + 32 + rzx * r.rzx + rzy * r.rzy + 33 double answer = 3.0 - sum; 34 return (answer >= 0 ) ? answer : 0; 35 } 36 37 double HepRotation::howNear( const HepRotati 38 return std::sqrt( distance2( r ) ); 39 } 40 41 bool HepRotation::isNear( const HepRotation 42 double ep 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