Subversion Repositories gelsvn

Rev

Rev 12 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
2 bj 1 
#include <algorithm>
2 
#include "ArithVec3Float.h"
3 
#include "Vec3f.h"
4 
#include "Vec3d.h"
5 
 
6 
using namespace std;
7 
 
8 
namespace CGLA {
9 
 
12 jab 10 
  template<class T, class V>
11 
  void ArithVec3Float<T,V>::get_spherical(T &theta, T &phi, T &rlen ) const
12 
  {
13 
    rlen = length();
14 
    theta = acos((*this)[2]/rlen);
15 
    if ((*this)[0]>0)
16 
      phi = atan((*this)[1]/(*this)[0]);
17 
    else
18 
      if ((*this)[0]<0)
19 
	phi = atan((*this)[1]/(*this)[0]) + M_PI;
20 
      else
21 
	phi = ((*this)[1]>0) ? M_PI_2 : -1 * M_PI_2;
22 
  }
2 bj 23 
 
24 
 
12 jab 25 
  template<class T, class V>
26 
  void ArithVec3Float<T,V>::set_spherical(T theta, T phi, T rlen )
27 
  {
28 
    (*this)[0] = rlen * sin(theta) * cos(phi);
29 
    (*this)[1] = rlen * sin(theta) * sin(phi);
30 
    (*this)[2] = rlen * cos(theta);
31 
  }
2 bj 32 
 
12 jab 33 
  template<class T, class V>
34 
  void orthogonal(const ArithVec3Float<T,V>& _a,
35 
		  ArithVec3Float<T,V>& b,
36 
		  ArithVec3Float<T,V>& c)
37 
  {
38 
    V a = normalize(_a);
39 
    T max_sqval=sqr(a[0]);
40 
    int mi=0;
41 
    for(int i=1;i<3;i++)
42 
      {
43 
	T sqval = sqr(a[i]);
44 
	if(max_sqval<sqval)
45 
	  {
46 
	    max_sqval = sqval;
47 
	    mi = i;
48 
	  }
49 
      }
50 
    b[mi] = 0;
51 
    b[(mi+1)%3] = 1;
52 
    b[(mi+2)%3] = 0;
2 bj 53 
 
12 jab 54 
    b = normalize(b-a*dot(b,a));
55 
    c = normalize(cross(a,b));
2 bj 56 
 
12 jab 57 
    if(dot(cross(b,c), a) < 0) swap(b,c);
58 
  }
2 bj 59 
 
60 
 
12 jab 61 
  template class ArithVec3Float<float, Vec3f>;
62 
  template void orthogonal<float,Vec3f>(const ArithVec3Float<float,Vec3f>& a,
63 
					ArithVec3Float<float,Vec3f>& b,
64 
					ArithVec3Float<float,Vec3f>& c);
2 bj 65 
 
12 jab 66 
  template class ArithVec3Float<double, Vec3d>;
67 
  template void orthogonal<double,Vec3d>(const ArithVec3Float<double,Vec3d>& a,
68 
					 ArithVec3Float<double,Vec3d>& b,
69 
					 ArithVec3Float<double,Vec3d>& c);
2 bj 70 
 
71 
}