Merged Engine into the Core! Woooo open source

src/resources/Location.java

@@ -0,0 +1,202 @@
+package resources;
+
+import java.io.Serializable;
+
+
+public class Location implements Serializable {
+	
+	private static final long serialVersionUID = 1L;
+	
+	private Terrain terrain = null;
+	
+	private double x = Double.NaN;
+	private double y = Double.NaN;
+	private double z = Double.NaN;
+	
+	private double oX = Double.NaN;
+	private double oY = Double.NaN;
+	private double oZ = Double.NaN;
+	private double oW = Double.NaN;
+	
+	public Location() {
+		
+	}
+	
+	public Location(double x, double y, double z, Terrain terrain) {
+		this.terrain = terrain;
+		this.x = x;
+		this.y = y;
+		this.z = z;
+	}
+	
+	public Location(Location l) {
+		this.terrain = l.terrain;
+		this.x = l.x;
+		this.y = l.y;
+		this.z = l.z;
+		this.oX = l.oX;
+		this.oY = l.oY;
+		this.oZ = l.oZ;
+		this.oW = l.oW;
+	}
+	
+	public void setTerrain(Terrain terrain) { this.terrain = terrain; }
+	public void setX(double x) { this.x = x; }
+	public void setY(double y) { this.y = y; }
+	public void setZ(double z) { this.z = z; }
+	public void setOrientationX(double oX) { this.oX = oX; }
+	public void setOrientationY(double oY) { this.oY = oY; }
+	public void setOrientationZ(double oZ) { this.oZ = oZ; }
+	public void setOrientationW(double oW) { this.oW = oW; }
+	
+	public Terrain getTerrain() { return terrain; }
+	public double getX() { return x; }
+	public double getY() { return y; }
+	public double getZ() { return z; }
+	public double getOrientationX() { return oX; }
+	public double getOrientationY() { return oY; }
+	public double getOrientationZ() { return oZ; }
+	public double getOrientationW() { return oW; }
+	
+	public boolean isWithinDistance(Location l, double x, double y, double z) {
+		double xD = Math.abs(this.x - l.getX());
+		double yD = Math.abs(this.y - l.getY());
+		double zD = Math.abs(this.z - l.getZ());
+		return xD <= x && yD <= y && zD <= z;
+	}
+	
+	public void translatePosition(double x, double y, double z) {
+		this.x += x;
+		this.y += y;
+		this.z += z;
+	}
+	
+	public Location translate(double x, double y, double z) {
+		Location loc = new Location(this);
+		loc.translatePosition(x, y, z);
+		return loc;
+	}
+	
+	public Location translate(Location l) {
+		return translate(l.getX(), l.getY(), l.getZ());
+	}
+	
+	public boolean mergeWith(Location l) {
+		boolean changed = false;
+		if (terrain == null || terrain != l.getTerrain()) {
+			terrain = l.getTerrain();
+			changed = true;
+		}
+		changed = mergeLocation(l.getX(), l.getY(), l.getZ()) || true;
+		changed = mergeOrientation(l) || true;
+		return changed;
+	}
+	
+	public boolean mergeLocation(double lX, double lY, double lZ) {
+		boolean changed = false;
+		if (Double.isNaN(x) || x != lX) {
+			x = lX;
+			changed = true;
+		}
+		if (Double.isNaN(y) || y != lY) {
+			y = lY;
+			changed = true;
+		}
+		if (Double.isNaN(z) || z != lZ) {
+			z = lZ;
+			changed = true;
+		}
+		return changed;
+	}
+	
+	private boolean mergeOrientation(Location l) {
+		boolean changed = false;
+		if (Double.isNaN(oX) || oX != l.getOrientationX()) {
+			oX = l.getOrientationX();
+			changed = true;
+		}
+		if (Double.isNaN(oY) || oY != l.getOrientationY()) {
+			oY = l.getOrientationY();
+			changed = true;
+		}
+		if (Double.isNaN(oZ) || oZ != l.getOrientationZ()) {
+			oZ = l.getOrientationZ();
+			changed = true;
+		}
+		if (Double.isNaN(oW) || oW != l.getOrientationW()) {
+			oW = l.getOrientationW();
+			changed = true;
+		}
+		return changed;
+	}
+	
+	public double getSpeed(Location l, double deltaTime) {
+		double dist = Math.sqrt(square(x-l.x) + square(y-l.y) + square(z-l.z));
+		return dist / deltaTime;
+	}
+	
+	public double getYaw() {
+		double w = oW;
+		double y = oY;
+		double angle = 0;
+		
+		if (w * w + y * y > 0) {
+			if (w > 0 && y < 0)
+				w *= -1;
+			angle = 2 * Math.acos(w);
+		} else {
+			angle = 0;
+		}
+		
+		return angle;
+	}
+	
+	private double square(double x) {
+		return x*x;
+	}
+	
+	public boolean isNaN() {
+		return Double.isNaN(x) && Double.isNaN(y) && Double.isNaN(z) && Double.isNaN(oX) && Double.isNaN(oY) && Double.isNaN(oZ) && Double.isNaN(oW);
+	}
+	
+	public boolean equals(Location l) {
+		if (terrain != l.terrain)
+			return false;
+		if (!isEqual(l.x, x))
+			return false;
+		if (!isEqual(l.y, y))
+			return false;
+		if (!isEqual(l.z, z))
+			return false;
+		if (!isEqual(l.oX, oX))
+			return false;
+		if (!isEqual(l.oY, oY))
+			return false;
+		if (!isEqual(l.oZ, oZ))
+			return false;
+		if (!isEqual(l.oW, oW))
+			return false;
+		return true;
+	}
+	
+	public int hashCode() {
+		return hash(x)*13 + hash(y)*17 + hash(z)*19 + hash(oX)*23 + hash(oY)*29 + hash(oZ)*31 + hash(oW)*37;
+	}
+	
+	private int hash(double x) {
+		long v = Double.doubleToLongBits(x);
+		return (int)(v^(v>>>32));
+	}
+	
+	private boolean isEqual(double x, double y) {
+		if (Double.isNaN(x))
+			return Double.isNaN(y);
+		if (Double.isNaN(y))
+			return false;
+		return x == y;
+	}
+	
+	public String toString() {
+		return "Location[TRN=" + terrain + ", POS=(" + x + ", " + y + ", " + z + ") ORTN=(" + oX + ", " + oY + ", " + oZ + ", " + oW + ")]";
+	}
+}