Geant4 Cross Reference

Cross-Referencing   Geant4
Geant4/externals/clhep/src/EulerAngles.cc

Version: [ ReleaseNotes ] [ 1.0 ] [ 1.1 ] [ 2.0 ] [ 3.0 ] [ 3.1 ] [ 3.2 ] [ 4.0 ] [ 4.0.p1 ] [ 4.0.p2 ] [ 4.1 ] [ 4.1.p1 ] [ 5.0 ] [ 5.0.p1 ] [ 5.1 ] [ 5.1.p1 ] [ 5.2 ] [ 5.2.p1 ] [ 5.2.p2 ] [ 6.0 ] [ 6.0.p1 ] [ 6.1 ] [ 6.2 ] [ 6.2.p1 ] [ 6.2.p2 ] [ 7.0 ] [ 7.0.p1 ] [ 7.1 ] [ 7.1.p1 ] [ 8.0 ] [ 8.0.p1 ] [ 8.1 ] [ 8.1.p1 ] [ 8.1.p2 ] [ 8.2 ] [ 8.2.p1 ] [ 8.3 ] [ 8.3.p1 ] [ 8.3.p2 ] [ 9.0 ] [ 9.0.p1 ] [ 9.0.p2 ] [ 9.1 ] [ 9.1.p1 ] [ 9.1.p2 ] [ 9.1.p3 ] [ 9.2 ] [ 9.2.p1 ] [ 9.2.p2 ] [ 9.2.p3 ] [ 9.2.p4 ] [ 9.3 ] [ 9.3.p1 ] [ 9.3.p2 ] [ 9.4 ] [ 9.4.p1 ] [ 9.4.p2 ] [ 9.4.p3 ] [ 9.4.p4 ] [ 9.5 ] [ 9.5.p1 ] [ 9.5.p2 ] [ 9.6 ] [ 9.6.p1 ] [ 9.6.p2 ] [ 9.6.p3 ] [ 9.6.p4 ] [ 10.0 ] [ 10.0.p1 ] [ 10.0.p2 ] [ 10.0.p3 ] [ 10.0.p4 ] [ 10.1 ] [ 10.1.p1 ] [ 10.1.p2 ] [ 10.1.p3 ] [ 10.2 ] [ 10.2.p1 ] [ 10.2.p2 ] [ 10.2.p3 ] [ 10.3 ] [ 10.3.p1 ] [ 10.3.p2 ] [ 10.3.p3 ] [ 10.4 ] [ 10.4.p1 ] [ 10.4.p2 ] [ 10.4.p3 ] [ 10.5 ] [ 10.5.p1 ] [ 10.6 ] [ 10.6.p1 ] [ 10.6.p2 ] [ 10.6.p3 ] [ 10.7 ] [ 10.7.p1 ] [ 10.7.p2 ] [ 10.7.p3 ] [ 10.7.p4 ] [ 11.0 ] [ 11.0.p1 ] [ 11.0.p2 ] [ 11.0.p3, ] [ 11.0.p4 ] [ 11.1 ] [ 11.1.1 ] [ 11.1.2 ] [ 11.1.3 ] [ 11.2 ] [ 11.2.1 ] [ 11.2.2 ] [ 11.3.0 ]

  1 // ----------------------------------------------------------------------
  2 //
  3 // EulerAngles.cc
  4 //
  5 // Methods for classes, and instances of globals, declared in EulerAngles.h
  6 //
  7 // History:
  8 //
  9 // 04-Dec-1997  MF  Stub with just PI
 10 // 12-Jan-1998  WEB PI now found in ZMutility; used ZMutility headers
 11 //      where available
 12 // 16-Mar-1998  WEB Corrected ZMpvEulerAnglesRep
 13 // 15-Jun-1998  WEB Added namespace support
 14 // 26-Jul-2000  MF  CLHEP version
 15 // 12-Apr-2001  MF    NaN-proofing
 16 // 19-Nov-2001  MF    Correction to ZMpvEulerAnglesRep, which was affecting
 17 //      .isNear().  array[3] had been incorrect.
 18 //      Note - the correct form was used in all other places 
 19 //      including Rotation.set(phi, theta, psi).
 20 //
 21 // ----------------------------------------------------------------------
 22 
 23 
 24 #include "CLHEP/Vector/EulerAngles.h"
 25 
 26 #include "CLHEP/Vector/ThreeVector.h"
 27 
 28 #include <cmath>
 29 #include <iostream>
 30 
 31 namespace CLHEP  {
 32 
 33 //-*************
 34 // static consts
 35 //-*************
 36 
 37 double HepEulerAngles::tolerance = Hep3Vector::ToleranceTicks * 1.0e-8;
 38 
 39 //-*******************
 40 // measure of distance
 41 //-*******************
 42 
 43 
 44 static void ZMpvEulerAnglesRep ( const HepEulerAngles & ex, double array[] ) {
 45 
 46   double sinPhi   = std::sin( ex.phi() )  , cosPhi   = std::cos( ex.phi() );
 47   double sinTheta = std::sin( ex.theta() ), cosTheta = std::cos( ex.theta() );
 48   double sinPsi   = std::sin( ex.psi() )  , cosPsi   = std::cos( ex.psi() );
 49 
 50   array[0] =   cosPsi * cosPhi   - sinPsi * cosTheta * sinPhi;
 51   array[1] =   cosPsi * sinPhi   + sinPsi * cosTheta * cosPhi;
 52   array[2] =   sinPsi * sinTheta;
 53 
 54   array[3] = - sinPsi * cosPhi - cosPsi * cosTheta * sinPhi;
 55   array[4] = - sinPsi * sinPhi   + cosPsi * cosTheta * cosPhi;
 56   array[5] =   cosPsi * sinTheta;
 57 
 58   array[6] =   sinTheta * sinPhi;
 59   array[7] = - sinTheta * cosPhi;
 60   array[8] =   cosTheta;
 61 
 62 } // ZMpvEulerAnglesRep
 63 
 64 
 65 double HepEulerAngles::distance( const EA & ex ) const  {
 66 
 67   double thisRep[9];
 68   double exRep[9];
 69 
 70   ZMpvEulerAnglesRep ( *this, thisRep );
 71   ZMpvEulerAnglesRep ( ex,    exRep );
 72 
 73   double sum = 0.0;
 74   for (int i = 0; i < 9; i++)  {
 75     sum += thisRep[i] * exRep[i];
 76   }
 77 
 78   double d = 3.0 - sum;   // NaN-proofing: 
 79   return  (d >= 0) ? d : 0;   // sqrt(distance) is used in howNear()
 80 
 81 }  // HepEulerAngles::distance()
 82 
 83 
 84 bool HepEulerAngles::isNear( const EA & ex, double epsilon ) const  {
 85 
 86   return  distance( ex ) <= epsilon*epsilon ;
 87 
 88 }  // HepEulerAngles::isNear()
 89 
 90 
 91 double HepEulerAngles::howNear( const EA & ex ) const  {
 92 
 93   return  std::sqrt( distance( ex ) );
 94 
 95 }  // HepEulerAngles::howNear()
 96 
 97 //-**************
 98 // Global Methods
 99 //-**************
100 
101 std::ostream & operator<<(std::ostream & os, const HepEulerAngles & ea)
102 {
103   os << "(" << ea.phi() << ", " << ea.theta() << ", " << ea.psi() << ")";
104   return  os;
105 }  // operator<<()
106 
107 void ZMinput3doubles ( std::istream & is, const char * type,
108                        double & x, double & y, double & z );
109 
110 std::istream & operator>>(std::istream & is, HepEulerAngles & ea) {
111   double thePhi;
112   double theTheta;
113   double thePsi;
114   ZMinput3doubles ( is, "HepEulerAngle", thePhi , theTheta , thePsi );
115   ea.set ( thePhi , theTheta , thePsi );
116   return  is;
117 }  // operator>>()
118 
119 }  // namespace CLHEP
120 
121 
122