-
Notifications
You must be signed in to change notification settings - Fork 0
/
vector.cpp
139 lines (125 loc) · 2.44 KB
/
vector.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
#ifndef _VECTOR_SIMPLE_INCLUDED_
#define _VECTOR_SIMPLE_INCLUDED_
class Vector{
public:
double x;
double y;
double z;
Vector(){
}
Vector(double _x, double _y, double _z){
x = _x;
y = _y;
z = _z;
}
Vector(double d){
x = y = z = d;
}
Vector(const Vector& v){
x = v.x;
y = v.y;
z = v.z;
}
Vector(Matrix <3,1> M){
x = M.val[0][0];
y = M.val[1][0];
z = M.val[2][0];
}
Vector(Matrix <4,1> M){
x = M.val[0][0];
y = M.val[1][0];
z = M.val[2][0];
}
Vector operator+(Vector v){
return Vector(x+v.x,y+v.y,z+v.z);
}
Vector operator-(Vector v){
return Vector(x-v.x,y-v.y,z-v.z);
}
Vector operator-(){
return Vector(-x,-y,-z);
}
Vector operator*(double d){
return Vector(x*d,y*d,z*d);
}
Vector operator/(double d){
return Vector(x/d,y/d,z/d);
}
double dot(Vector v){
return (x*v.x + y*v.y + z*v.z);
}
double operator^(Vector v){
return (*this).dot(v);
}
double mod(){
return (x*x)+(y*y)+(z*z);
}
double mod2(){
return sqrt((x*x)+(y*y)+(z*z));
}
Vector unit(){
return (*this)/mod2();
}
Vector component(Vector dir){
double r = (*this)^dir;
if(r < 0) r = -r;
return (dir*r)/dir.mod();
}
Vector operator/(Vector v){
return (*this).component(v);
}
Vector reflect(Vector n){
n = ((*this)/n)*2;
return n + (*this);
}
Vector refract(Vector _n, double coeff){
//cout<<"\n# ";_n.print();cout<<" #\n";
Vector i = unit();
Vector n = _n.unit();
double ci = i^n;
if(ci > 0)return refract(-_n, 1/coeff);
ci *= -1;
double si = sqrt(1 - (ci*ci));
double sr = si/coeff;
if(sr >= 1){
return reflect(_n);
}
Vector Il = -(i/n);
Vector Ip = i - Il;
Vector r = Il;
if(compare(Ip.mod(), 0) == 0) Ip = Vector(0,0,0);
else Ip = Ip.unit();
double tr = sr/sqrt(1 - (sr*sr));
Ip = Ip*(Il.mod2()*tr);
return (Il + Ip);
}
Vector transform(Matrix<3,3> M);
Vector transform(Matrix<4,4> M);
Vector operator*(Matrix<3,3> M);
Vector operator*(Matrix<4,4> M);
Vector cross(Vector v);
Vector operator*(Vector v);
void print(){
cout<<x<<" "<<y<<" "<<z;
}
int operator==(Vector v){
return(v.x == x && v.y == y && v.z == z);
}
};
Vector operator*(double d, Vector v){
return v*d;
}
Vector operator/(double d, Vector v){
return v/d;
}
// Matrix <3,1> operator=(Matrix& <3,1> M, Vector v){
// M.val[0][0] = v.x;
// M.val[1][0] = v.y;
// M.val[2][0] = v.z;
// return M;
// }
// Vector Vector::transform(Matrix<3,3> M){
// Matrix <3,1> m = (*this);
// return *this;
// }
#endif