288 lines
6.7 KiB
Java
288 lines
6.7 KiB
Java
/*
|
|
* Copyright (c) 2002 Lightweight Java Game Library Project
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are
|
|
* met:
|
|
*
|
|
* * Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
*
|
|
* * Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* * Neither the name of 'Light Weight Java Game Library' nor the names of
|
|
* its contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
|
|
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
|
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
|
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
|
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
package org.lwjgl.vector;
|
|
|
|
import java.nio.FloatBuffer;
|
|
|
|
import org.lwjgl.Math;
|
|
|
|
/**
|
|
* $Id$
|
|
*
|
|
* Holds a 3-tuple vector.
|
|
*
|
|
* @author cix_foo <cix_foo@users.sourceforge.net>
|
|
* @version $Revision$
|
|
*/
|
|
|
|
public class Vector3f extends Vector {
|
|
|
|
public float x, y, z;
|
|
|
|
/**
|
|
* Constructor for Vector3f.
|
|
*/
|
|
public Vector3f() {
|
|
super();
|
|
}
|
|
|
|
/**
|
|
* Constructor
|
|
*/
|
|
public Vector3f(Vector3f src) {
|
|
set(src);
|
|
}
|
|
|
|
/**
|
|
* Constructor
|
|
*/
|
|
public Vector3f(float x, float y, float z) {
|
|
set(x, y, z);
|
|
}
|
|
|
|
/**
|
|
* Set values
|
|
* @return this
|
|
*/
|
|
public Vector3f set(float x, float y, float z) {
|
|
this.x = x;
|
|
this.y = y;
|
|
this.z = z;
|
|
return this;
|
|
}
|
|
|
|
/**
|
|
* Load from another Vector3f
|
|
* @param src The source vector
|
|
* @return this
|
|
*/
|
|
public Vector3f set(Vector3f src) {
|
|
x = src.x;
|
|
y = src.y;
|
|
z = src.z;
|
|
return this;
|
|
}
|
|
|
|
/**
|
|
* @return the length squared of the vector
|
|
*/
|
|
public float lengthSquared() {
|
|
return x * x + y * y + z * z;
|
|
}
|
|
|
|
/**
|
|
* Translate a vector
|
|
* @param x The translation in x
|
|
* @param y the translation in y
|
|
* @return this
|
|
*/
|
|
public Vector3f translate(float x, float y, float z) {
|
|
this.x += x;
|
|
this.y += y;
|
|
this.z += z;
|
|
return this;
|
|
}
|
|
|
|
/**
|
|
* Add a vector to another vector and place the result in a destination
|
|
* vector.
|
|
* @param left The LHS vector
|
|
* @param right The RHS vector
|
|
* @param dest The destination vector, or null if a new vector is to be created
|
|
* @return the sum of left and right in dest
|
|
*/
|
|
public static Vector3f add(Vector3f left, Vector3f right, Vector3f dest) {
|
|
if (dest == null)
|
|
return new Vector3f(left.x + right.x, left.y + right.y, left.z + right.z);
|
|
else {
|
|
return dest.set(left.x + right.x, left.y + right.y, left.z + right.z);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Subtract a vector from another vector and place the result in a destination
|
|
* vector.
|
|
* @param left The LHS vector
|
|
* @param right The RHS vector
|
|
* @param dest The destination vector, or null if a new vector is to be created
|
|
* @return left minus right in dest
|
|
*/
|
|
public static Vector3f sub(Vector3f left, Vector3f right, Vector3f dest) {
|
|
if (dest == null)
|
|
return new Vector3f(left.x - right.x, left.y - right.y, left.z - right.z);
|
|
else {
|
|
return dest.set(left.x - right.x, left.y - right.y, left.z - right.z);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* The cross product of two vectors.
|
|
*
|
|
* @param left The LHS vector
|
|
* @param right The RHS vector
|
|
* @param dest The destination result, or null if a new vector is to be created
|
|
* @return left cross right
|
|
*/
|
|
public static Vector3f cross(
|
|
Vector3f left,
|
|
Vector3f right,
|
|
Vector3f dest)
|
|
{
|
|
|
|
if (dest == null)
|
|
dest = new Vector3f();
|
|
|
|
dest.set(
|
|
left.y * right.z - left.z * right.y,
|
|
right.x * left.z - right.z * left.x,
|
|
left.x * right.y - left.y * right.x
|
|
);
|
|
|
|
return dest;
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
* Negate a vector
|
|
* @return this
|
|
*/
|
|
public Vector negate() {
|
|
x = -x;
|
|
y = -y;
|
|
z = -z;
|
|
return this;
|
|
}
|
|
|
|
/**
|
|
* Negate a vector and place the result in a destination vector.
|
|
* @param dest The destination vector or null if a new vector is to be created
|
|
* @return the negated vector
|
|
*/
|
|
public Vector3f negate(Vector3f dest) {
|
|
if (dest == null)
|
|
dest = new Vector3f();
|
|
dest.x = -x;
|
|
dest.y = -y;
|
|
dest.z = -z;
|
|
return dest;
|
|
}
|
|
|
|
|
|
/**
|
|
* Normalise this vector and place the result in another vector.
|
|
* @param dest The destination vector, or null if a new vector is to be created
|
|
* @return the normalised vector
|
|
*/
|
|
public Vector3f normalise(Vector3f dest) {
|
|
float l = length();
|
|
|
|
if (dest == null)
|
|
dest = new Vector3f(x / l, y / l, z / l);
|
|
else
|
|
dest.set(x / l, y / l, z / l);
|
|
|
|
return dest;
|
|
}
|
|
|
|
/**
|
|
* Get the magnitude of of the vector
|
|
* @return the magnitude of the vector
|
|
*/
|
|
public float magnitude()
|
|
{
|
|
return Math.sqrt( (x * x) + (y * y) + (z * z) );
|
|
}
|
|
|
|
/**
|
|
* The dot product of two vectors is calculated as
|
|
* v1.x * v2.x + v1.y * v2.y + v1.z * v2.z
|
|
* @param left The LHS vector
|
|
* @param right The RHS vector
|
|
* @return left dot right
|
|
*/
|
|
public static float dot(Vector3f left, Vector3f right) {
|
|
return left.x * right.x + left.y * right.y + left.z * right.z;
|
|
}
|
|
|
|
/**
|
|
* Calculate the angle between two vectors, in degrees
|
|
* @param a A vector
|
|
* @param b The other vector
|
|
* @return the angle between the two vectors, in degrees
|
|
*/
|
|
public static float angle(Vector3f a, Vector3f b) {
|
|
float dls = dot(a, b) / (a.length() * b.length());
|
|
if (dls < -1f)
|
|
dls = -1f;
|
|
else if (dls > 1.0f)
|
|
dls = 1.0f;
|
|
return Math.acos(dls);
|
|
}
|
|
|
|
/* (non-Javadoc)
|
|
* @see org.lwjgl.vector.Vector#load(FloatBuffer)
|
|
*/
|
|
public Vector load(FloatBuffer buf) {
|
|
x = buf.get();
|
|
y = buf.get();
|
|
z = buf.get();
|
|
return this;
|
|
}
|
|
|
|
/* (non-Javadoc)
|
|
* @see org.lwjgl.vector.Vector#scale(float)
|
|
*/
|
|
public Vector scale(float scale) {
|
|
|
|
x *= scale;
|
|
y *= scale;
|
|
z *= scale;
|
|
|
|
return this;
|
|
|
|
}
|
|
|
|
/* (non-Javadoc)
|
|
* @see org.lwjgl.vector.Vector#store(FloatBuffer)
|
|
*/
|
|
public Vector store(FloatBuffer buf) {
|
|
|
|
buf.put(x);
|
|
buf.put(y);
|
|
buf.put(z);
|
|
|
|
return this;
|
|
}
|
|
|
|
}
|