WebSVN – gelsvn – Diff – /branches/wireframe-experiments/src/CGLA/ArithVec3Float.cpp


#include <algorithm>
#include "ArithVec3Float.h"
#include "Vec3f.h"
#include "Vec3d.h"
 
using namespace std;
 
namespace CGLA {
 
		template<class T, class V>
		void ArithVec3Float<T,V>::get_spherical(T &theta, T &phi, T &rlen ) const
		{  
				rlen = this->length();
				theta = acos((*this)[2]/rlen);    
				if ((*this)[0]>0)
						phi = atan((*this)[1]/(*this)[0]);
				else 
						if ((*this)[0]<0)
								phi = atan((*this)[1]/(*this)[0]) + M_PI;
						else 
								phi = ((*this)[1]>0) ? M_PI_2 : -1 * M_PI_2;
		}
 
 
		template<class T, class V>
		void ArithVec3Float<T,V>::set_spherical(T theta, T phi, T rlen )
		{
				(*this)[0] = rlen * sin(theta) * cos(phi);
				(*this)[1] = rlen * sin(theta) * sin(phi);
				(*this)[2] = rlen * cos(theta);
		}
 
		template<class T, class V>
		void orthogonal(const ArithVec3Float<T,V>& _a, 
										ArithVec3Float<T,V>& b, 
										ArithVec3Float<T,V>& c)
		{
				V a = normalize(_a);
				T max_sqval=sqr(a[0]);
				unsigned int mi=0;
				for(unsigned int i=1;i<3;i++)
				{
						T sqval = sqr(a[i]);
						if(max_sqval<sqval)
						{
								max_sqval = sqval;
								mi = i;
						}
				}
				b[mi] = 0;
				b[(mi+1)%3] = 1;
				b[(mi+2)%3] = 0;
 
				b = normalize(b-a*dot(b,a));
				c = normalize(cross(a,b));
 
				if(dot(cross(b,c), a) < 0) swap(b,c);
		}
 
 
		template class ArithVec3Float<float, Vec3f>;
		template void orthogonal<float,Vec3f>(const ArithVec3Float<float,Vec3f>& a, 
																					ArithVec3Float<float,Vec3f>& b, 
																					ArithVec3Float<float,Vec3f>& c);
 
		template class ArithVec3Float<double, Vec3d>;
		template void orthogonal<double,Vec3d>(const ArithVec3Float<double,Vec3d>& a,
																					 ArithVec3Float<double,Vec3d>& b, 
																					 ArithVec3Float<double,Vec3d>& c);
 
}
 

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

Subversion Repositories gelsvn

(root)/branches/wireframe-experiments/src/CGLA/ArithVec3Float.cpp – Rev 125 → 393