Warning, /include/Geant4/tools/lina/vec3f is written in an unsupported language. File is not indexed.
0001 // Copyright (C) 2010, Guy Barrand. All rights reserved.
0002 // See the file tools.license for terms.
0003
0004 #ifndef tools_vec3f
0005 #define tools_vec3f
0006
0007 #include "vec3"
0008 #include "../S_STRING"
0009 #include <cmath> //sqrt
0010
0011 namespace tools {
0012
0013 class vec3f : public vec3<float> {
0014 typedef vec3<float> parent;
0015 public:
0016 TOOLS_SCLASS(tools::vec3f) //for stype()
0017 public:
0018 vec3f():parent(){}
0019 vec3f(const float a_vec[3]):parent(a_vec){}
0020 vec3f(float a0,float a1,float a2):parent(a0,a1,a2){}
0021 virtual ~vec3f() {}
0022 public:
0023 vec3f(const vec3f& a_from):parent(a_from){}
0024 vec3f& operator=(const vec3f& a_from){
0025 parent::operator=(a_from);
0026 return *this;
0027 }
0028
0029 vec3f(const parent& a_from):parent(a_from){}
0030
0031 public: //operators
0032 vec3f operator*(float a_v) const {
0033 return vec3f(m_data[0]*a_v,
0034 m_data[1]*a_v,
0035 m_data[2]*a_v);
0036 }
0037 vec3f operator+(const vec3f& a_v) const {
0038 return vec3f(m_data[0]+a_v.m_data[0],
0039 m_data[1]+a_v.m_data[1],
0040 m_data[2]+a_v.m_data[2]);
0041 }
0042 vec3f operator-(const vec3f& a_v) const {
0043 return vec3f(m_data[0]-a_v.m_data[0],
0044 m_data[1]-a_v.m_data[1],
0045 m_data[2]-a_v.m_data[2]);
0046 }
0047 vec3f& operator+=(const vec3f& a_v) {
0048 m_data[0] += a_v.m_data[0];
0049 m_data[1] += a_v.m_data[1];
0050 m_data[2] += a_v.m_data[2];
0051 return *this;
0052 }
0053 vec3f& operator-=(const vec3f& a_v) {
0054 m_data[0] -= a_v.m_data[0];
0055 m_data[1] -= a_v.m_data[1];
0056 m_data[2] -= a_v.m_data[2];
0057 return *this;
0058 }
0059 vec3f& operator*=(float a_v) {
0060 m_data[0] *= a_v;
0061 m_data[1] *= a_v;
0062 m_data[2] *= a_v;
0063 return *this;
0064 }
0065 vec3f operator-() const {
0066 return vec3f(-m_data[0],-m_data[1],-m_data[2]);
0067 }
0068 public:
0069 float length() const {
0070 return float(::sqrt(m_data[0]*m_data[0]+m_data[1]*m_data[1]+m_data[2]*m_data[2]));
0071 }
0072 float normalize() {
0073 float norme = length();
0074 if(!norme) return 0;
0075 divide(norme);
0076 return norme;
0077 }
0078 bool cos_angle(const vec3f& a_v,float& a_cos) const {
0079 //WARNING : if ret false, a_cos is not set.
0080 float this_length = length();
0081 if(this_length==0.0f) return false;
0082 float a_v_length = a_v.length();
0083 if(a_v_length==0.0f) return false;
0084 a_cos = dot(a_v)/(this_length*a_v_length);
0085 return true;
0086 }
0087
0088 bool theta_phi(float& a_theta,float& a_phi) const {
0089 return parent::theta_phi(a_theta,a_phi,::sqrtf,::atan2f);
0090 }
0091 public: //iv2sg
0092 bool equals(const vec3f& a_v,const float a_epsil) const {
0093 //if(a_epsil<0.0f))
0094 float d0 = m_data[0]-a_v.m_data[0];
0095 float d1 = m_data[1]-a_v.m_data[1];
0096 float d2 = m_data[2]-a_v.m_data[2];
0097 return ((d0*d0+d1*d1+d2*d2)<=a_epsil);
0098 }
0099 void negate() {
0100 m_data[0] = -m_data[0];
0101 m_data[1] = -m_data[1];
0102 m_data[2] = -m_data[2];
0103 }
0104
0105 private:static void check_instantiation() {vec3f v(0,0,0);v.set_value(1,1,1);}
0106 };
0107
0108 inline vec3f operator*(float a_f,const vec3f& a_v) {
0109 vec3f res(a_v);
0110 res *= a_f;
0111 return res;
0112 }
0113
0114 inline void get_normal(const vec3f& a_p0,const vec3f& a_p1,const vec3f& a_p2,vec3f& a_nm,
0115 vec3f& a_tmp_1,vec3f& a_tmp_2) {
0116 // Used to optimize sg::bin().
0117 //(a_p1-a_p0).cross(a_p2-a_p1,a_nm);
0118
0119 a_tmp_1 = a_p1;
0120 a_tmp_1.subtract(a_p0);
0121
0122 a_tmp_2 = a_p2;
0123 a_tmp_2.subtract(a_p1);
0124
0125 a_tmp_1.cross(a_tmp_2,a_nm);
0126
0127 a_nm.normalize();
0128 }
0129
0130 }
0131
0132 #include <vector>
0133
0134 namespace tools {
0135
0136 #ifndef SWIG
0137 //for sf, mf :
0138 inline bool set_from_vec(vec3f& a_v,const std::vector<float>& a_sv) {
0139 if(a_sv.size()!=3) return false;
0140 a_v[0] = a_sv[0];
0141 a_v[1] = a_sv[1];
0142 a_v[2] = a_sv[2];
0143 return true;
0144 }
0145 #endif
0146
0147 }
0148
0149 #endif
