1 | package pl.vorg.mowa.core.graphics; |
---|
2 | |
---|
3 | /** |
---|
4 | * A vector in 3d space. |
---|
5 | * |
---|
6 | * @author vorg |
---|
7 | */ |
---|
8 | public class Vec3 { |
---|
9 | private float[] v = {0,0,0}; |
---|
10 | |
---|
11 | public Vec3() { |
---|
12 | |
---|
13 | } |
---|
14 | |
---|
15 | public Vec3(float x, float y, float z) { |
---|
16 | v[0] = x; |
---|
17 | v[1] = y; |
---|
18 | v[2] = z; |
---|
19 | } |
---|
20 | |
---|
21 | public Vec3(Vec3 vec) { |
---|
22 | float[] w = vec.getVector(); |
---|
23 | v[0] = w[0]; |
---|
24 | v[1] = w[1]; |
---|
25 | v[2] = w[2]; |
---|
26 | } |
---|
27 | |
---|
28 | public Vec3(float[] vec) { |
---|
29 | v[0] = vec[0]; |
---|
30 | v[1] = vec[1]; |
---|
31 | v[2] = vec[2]; |
---|
32 | } |
---|
33 | |
---|
34 | @Override |
---|
35 | public boolean equals(java.lang.Object obj) { |
---|
36 | float[] w = ((Vec3)obj).getVector(); |
---|
37 | return (v[0] == w[0]) && (v[1] == w[1]) && (v[2] == w[2]); |
---|
38 | } |
---|
39 | |
---|
40 | public float getX() { |
---|
41 | return v[0]; |
---|
42 | } |
---|
43 | |
---|
44 | public float getY() { |
---|
45 | return v[1]; |
---|
46 | } |
---|
47 | |
---|
48 | public float getZ() { |
---|
49 | return v[2]; |
---|
50 | } |
---|
51 | |
---|
52 | public void setX(float x) { |
---|
53 | v[0] = x; |
---|
54 | } |
---|
55 | |
---|
56 | public void setY(float y) { |
---|
57 | v[1] = y; |
---|
58 | } |
---|
59 | |
---|
60 | public void setZ(float z) { |
---|
61 | v[2] = z; |
---|
62 | } |
---|
63 | |
---|
64 | |
---|
65 | public float[] getVector() { |
---|
66 | return v; |
---|
67 | } |
---|
68 | |
---|
69 | public void normalize() { |
---|
70 | float length = length(); |
---|
71 | if (length > 0) { |
---|
72 | v[0] /= length; |
---|
73 | v[1] /= length; |
---|
74 | v[2] /= length; |
---|
75 | } |
---|
76 | } |
---|
77 | |
---|
78 | public float length() { |
---|
79 | return (float)Math.sqrt(v[0]*v[0]+v[1]*v[1]+v[2]*v[2]); |
---|
80 | } |
---|
81 | |
---|
82 | public void add(Vec3 a) { |
---|
83 | v[0] += a.getX(); |
---|
84 | v[1] += a.getY(); |
---|
85 | v[2] += a.getZ(); |
---|
86 | } |
---|
87 | |
---|
88 | public static Vec3 add(Vec3 a, Vec3 b) { |
---|
89 | return new Vec3( |
---|
90 | a.getX() + b.getX(), |
---|
91 | a.getY() + b.getY(), |
---|
92 | a.getZ() + b.getZ() |
---|
93 | ); |
---|
94 | } |
---|
95 | |
---|
96 | public void sub(Vec3 a) { |
---|
97 | v[0] -= a.getX(); |
---|
98 | v[1] -= a.getY(); |
---|
99 | v[2] -= a.getZ(); |
---|
100 | } |
---|
101 | |
---|
102 | public static Vec3 sub(Vec3 a, Vec3 b) { |
---|
103 | return new Vec3( |
---|
104 | a.getX() - b.getX(), |
---|
105 | a.getY() - b.getY(), |
---|
106 | a.getZ() - b.getZ() |
---|
107 | ); |
---|
108 | } |
---|
109 | |
---|
110 | public void mul(float f) { |
---|
111 | v[0] *= f; |
---|
112 | v[1] *= f; |
---|
113 | v[2] *= f; |
---|
114 | } |
---|
115 | |
---|
116 | public static Vec3 mul(float f, Vec3 a) { |
---|
117 | return new Vec3( |
---|
118 | a.getX() * f, |
---|
119 | a.getY() * f, |
---|
120 | a.getZ() * f |
---|
121 | ); |
---|
122 | } |
---|
123 | |
---|
124 | public static Vec3 cross(Vec3 a, Vec3 b) { |
---|
125 | float[] va = a.getVector(); |
---|
126 | float[] vb = b.getVector(); |
---|
127 | return new Vec3( |
---|
128 | va[1]*vb[2] - va[2]*vb[1], |
---|
129 | va[2]*vb[0] - va[0]*vb[2], |
---|
130 | va[0]*vb[1] - va[1]*vb[0] |
---|
131 | ); |
---|
132 | } |
---|
133 | |
---|
134 | public float dot(Vec3 a) { |
---|
135 | float[] va = a.getVector(); |
---|
136 | return v[0]*va[0] + v[1]*va[1] + v[2]*va[2]; |
---|
137 | } |
---|
138 | |
---|
139 | public static float dot(Vec3 a, Vec3 b) { |
---|
140 | float[] va = a.getVector(); |
---|
141 | float[] vb = b.getVector(); |
---|
142 | return va[0]*vb[0] + va[1]*vb[1] + va[2]*vb[2]; |
---|
143 | } |
---|
144 | |
---|
145 | public float angle(Vec3 a) { |
---|
146 | float len = length(); |
---|
147 | float alen = a.length(); |
---|
148 | if ((len == 0) || (alen == 0)) { |
---|
149 | return 0; |
---|
150 | } |
---|
151 | return (float)Math.acos(this.dot(a)/(len*alen)); |
---|
152 | } |
---|
153 | |
---|
154 | public static Vec3 normalized(Vec3 a) { |
---|
155 | Vec3 na = new Vec3(a); |
---|
156 | na.normalize(); |
---|
157 | return na; |
---|
158 | } |
---|
159 | |
---|
160 | public static Vec3 neg(Vec3 a) { |
---|
161 | return new Vec3(-a.getX(), -a.getY(), -a.getZ()); |
---|
162 | } |
---|
163 | } |
---|