| Geant4 Cross Reference |
1 // -*- C++ -*- 1 // -*- C++ -*-
>> 2 // $Id:$
2 // ------------------------------------------- 3 // ---------------------------------------------------------------------------
3 4
4 #include "CLHEP/Geometry/Point3D.h" 5 #include "CLHEP/Geometry/Point3D.h"
5 #include "CLHEP/Geometry/Transform3D.h" 6 #include "CLHEP/Geometry/Transform3D.h"
6 7
7 namespace HepGeom { 8 namespace HepGeom {
8 //------------------------------------------ 9 //--------------------------------------------------------------------------
9 Point3D<float> & 10 Point3D<float> &
10 Point3D<float>::transform(const Transform3D 11 Point3D<float>::transform(const Transform3D & m) {
11 double vx = x(), vy = y(), vz = z(); 12 double vx = x(), vy = y(), vz = z();
12 set(m.xx()*vx + m.xy()*vy + m.xz()*vz + m. 13 set(m.xx()*vx + m.xy()*vy + m.xz()*vz + m.dx(),
13 m.yx()*vx + m.yy()*vy + m.yz()*vz + m.dy(), 14 m.yx()*vx + m.yy()*vy + m.yz()*vz + m.dy(),
14 m.zx()*vx + m.zy()*vy + m.zz()*vz + m.dz()); 15 m.zx()*vx + m.zy()*vy + m.zz()*vz + m.dz());
15 return *this; 16 return *this;
16 } 17 }
17 18
18 //------------------------------------------ 19 //--------------------------------------------------------------------------
19 Point3D<float> 20 Point3D<float>
20 operator*(const Transform3D & m, const Point 21 operator*(const Transform3D & m, const Point3D<float> & v) {
21 double vx = v.x(), vy = v.y(), vz = v.z(); 22 double vx = v.x(), vy = v.y(), vz = v.z();
22 return Point3D<float> 23 return Point3D<float>
23 (m.xx()*vx + m.xy()*vy + m.xz()*vz + m.d 24 (m.xx()*vx + m.xy()*vy + m.xz()*vz + m.dx(),
24 m.yx()*vx + m.yy()*vy + m.yz()*vz + m.d 25 m.yx()*vx + m.yy()*vy + m.yz()*vz + m.dy(),
25 m.zx()*vx + m.zy()*vy + m.zz()*vz + m.d 26 m.zx()*vx + m.zy()*vy + m.zz()*vz + m.dz());
26 } 27 }
27 28
28 //------------------------------------------ 29 //--------------------------------------------------------------------------
29 Point3D<double> & 30 Point3D<double> &
30 Point3D<double>::transform(const Transform3D 31 Point3D<double>::transform(const Transform3D & m) {
31 double vx = x(), vy = y(), vz = z(); 32 double vx = x(), vy = y(), vz = z();
32 set(m.xx()*vx + m.xy()*vy + m.xz()*vz + m. 33 set(m.xx()*vx + m.xy()*vy + m.xz()*vz + m.dx(),
33 m.yx()*vx + m.yy()*vy + m.yz()*vz + m.dy(), 34 m.yx()*vx + m.yy()*vy + m.yz()*vz + m.dy(),
34 m.zx()*vx + m.zy()*vy + m.zz()*vz + m.dz()); 35 m.zx()*vx + m.zy()*vy + m.zz()*vz + m.dz());
35 return *this; 36 return *this;
36 } 37 }
37 38
38 //------------------------------------------ 39 //--------------------------------------------------------------------------
39 Point3D<double> 40 Point3D<double>
40 operator*(const Transform3D & m, const Point 41 operator*(const Transform3D & m, const Point3D<double> & v) {
41 double vx = v.x(), vy = v.y(), vz = v.z(); 42 double vx = v.x(), vy = v.y(), vz = v.z();
42 return Point3D<double> 43 return Point3D<double>
43 (m.xx()*vx + m.xy()*vy + m.xz()*vz + m.d 44 (m.xx()*vx + m.xy()*vy + m.xz()*vz + m.dx(),
44 m.yx()*vx + m.yy()*vy + m.yz()*vz + m.d 45 m.yx()*vx + m.yy()*vy + m.yz()*vz + m.dy(),
45 m.zx()*vx + m.zy()*vy + m.zz()*vz + m.d 46 m.zx()*vx + m.zy()*vy + m.zz()*vz + m.dz());
46 } 47 }
47 } /* namespace HepGeom */ 48 } /* namespace HepGeom */
48 49