Vector4f.java

public class Vector4f
{
    private final float x;
    private final float y;
    private final float z;
    private final float w;

    public Vector4f(float x, float y, float z, float w)
    {
        this.x = x;
        this.y = y;
        this.z = z;
        this.w = w;
    }

    public float Length()
    {
        return (float)Math.sqrt(x * x + y * y + z * z + w * w);
    }

    public float Max()
    {
        return Math.max(Math.max(x, y), Math.max(z, w));
    }

    public float Dot(Vector4f r)
    {
        return x * r.GetX() + y * r.GetY() + z * r.GetZ() + w * r.GetW();
    }

    public Vector4f Cross(Vector4f r)
    {
        float x_ = y * r.GetZ() - z * r.GetY();
        float y_ = z * r.GetX() - x * r.GetZ();
        float z_ = x * r.GetY() - y * r.GetX();

        return new Vector4f(x_, y_, z_, 0);
    }

    public Vector4f Normalized()
    {
        float length = Length();

        return new Vector4f(x / length, y / length, z / length, w / length);
    }

    public Vector4f Rotate(Vector4f axis, float angle)
    {
        float sinAngle = (float)Math.sin(-angle);
        float cosAngle = (float)Math.cos(-angle);

        return this.Cross(axis.Mul(sinAngle)).Add(           //Rotation on local X
                (this.Mul(cosAngle)).Add(                     //Rotation on local Z
                        axis.Mul(this.Dot(axis.Mul(1 - cosAngle))))); //Rotation on local Y
    }

//	public Vector3f rotate(Quaternion rotation)
//	{
//		Quaternion conjugate = rotation.conjugate();
//
//		Quaternion w = rotation.mul(this).mul(conjugate);
//
//		return new Vector3f(w.getX(), w.getY(), w.getZ());
//	}

    public Vector4f Lerp(Vector4f dest, float lerpFactor)
    {
        return dest.Sub(this).Mul(lerpFactor).Add(this);
    }

    public Vector4f Add(Vector4f r)
    {
        return new Vector4f(x + r.GetX(), y + r.GetY(), z + r.GetZ(), w + r.GetW());
    }

    public Vector4f Add(float r)
    {
        return new Vector4f(x + r, y + r, z + r, w + r);
    }

    public Vector4f Sub(Vector4f r)
    {
        return new Vector4f(x - r.GetX(), y - r.GetY(), z - r.GetZ(), w - r.GetW());
    }

    public Vector4f Sub(float r)
    {
        return new Vector4f(x - r, y - r, z - r, w - r);
    }

    public Vector4f Mul(Vector4f r)
    {
        return new Vector4f(x * r.GetX(), y * r.GetY(), z * r.GetZ(), w * r.GetW());
    }

    public Vector4f Mul(float r)
    {
        return new Vector4f(x * r, y * r, z * r, w * r);
    }

    public Vector4f Div(Vector4f r)
    {
        return new Vector4f(x / r.GetX(), y / r.GetY(), z / r.GetZ(), w / r.GetW());
    }

    public Vector4f Div(float r)
    {
        return new Vector4f(x / r, y / r, z / r, w / r);
    }

    public Vector4f Abs()
    {
        return new Vector4f(Math.abs(x), Math.abs(y), Math.abs(z), Math.abs(w));
    }

    public String toString()
    {
        return "(" + x + ", " + y + ", " + z + ", " + w + ")";
    }

    public float GetX()
    {
        return x;
    }

    public float GetY()
    {
        return y;
    }

    public float GetZ()
    {
        return z;
    }

    public float GetW()
    {
        return w;
    }

    public boolean equals(Vector4f r)
    {
        return x == r.GetX() && y == r.GetY() && z == r.GetZ() && w == r.GetW();
    }
}