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 + ")"; } }