Subversion Repositories gelsvn

Rev

Rev 125 | 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 
 
45 jab 10 
		template<class T, class V>
11 
		void ArithVec3Float<T,V>::get_spherical(T &theta, T &phi, T &rlen ) const
12 
		{
125 jab 13 
				rlen = this->length();
45 jab 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 
 
45 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 
 
45 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 
				unsigned int mi=0;
41 
				for(unsigned 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 
 
45 jab 54 
				b = normalize(b-a*dot(b,a));
55 
				c = normalize(cross(a,b));
2 bj 56 
 
45 jab 57 
				if(dot(cross(b,c), a) < 0) swap(b,c);
58 
		}
2 bj 59 
 
60 
 
45 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 
 
45 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 
}