Files
EnderIO/common/crazypants/vecmath/Vector3d.java
T

104 lines
1.7 KiB
Java

package crazypants.vecmath;
public class Vector3d {
public double x;
public double y;
public double z;
public Vector3d() {
x = 0;
y = 0;
z = 0;
}
public Vector3d(double x, double y, double z) {
this.x = x;
this.y = y;
this.z = z;
}
public Vector3d(Vector3d other) {
this(other.x, other.y, other.z);
}
public void set(double x, double y, double z) {
this.x = x;
this.y = y;
this.z = z;
}
public void set(Vector3d vec) {
x = vec.x;
y = vec.y;
z = vec.z;
}
public Vector3d add(Vector3d vec) {
x += vec.x;
y += vec.y;
z += vec.z;
return this;
}
public void sub(Vector3d vec) {
x -= vec.x;
y -= vec.y;
z -= vec.z;
}
public Vector3d negate() {
x = -x;
y = -y;
z = -z;
return this;
}
public void scale(double s) {
x *= s;
y *= s;
z *= s;
}
public void normalize() {
double scale = 1.0 / Math.sqrt(x * x + y * y + z * z);
scale(scale);
}
public double dot(Vector3d other) {
return x * other.x + y * other.y + z * other.z;
}
public void cross(Vector3d v1, Vector3d v2) {
x = v1.y * v2.z - v1.z * v2.y;
y = v2.x * v1.z - v2.z * v1.x;
z = v1.x * v2.y - v1.y * v2.x;
}
public double lengthSquared() {
return x * x + y * y + z * z;
}
public double length() {
return Math.sqrt(lengthSquared());
}
public double distanceSquared(Vector3d v) {
double dx, dy, dz;
dx = x - v.x;
dy = y - v.y;
dz = z - v.z;
return (dx * dx + dy * dy + dz * dz);
}
public double distance(Vector3d v) {
return Math.sqrt(distanceSquared(v));
}
@Override
public String toString() {
return "Vector3d(" + x + ", " + y + ", " + z + ")";
}
}