You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
67 lines
2.1 KiB
67 lines
2.1 KiB
package sig;
|
|
|
|
public class Vector {
|
|
public float x,y,z,w;
|
|
Vector() {
|
|
this(0,0,0,1);
|
|
}
|
|
public Vector(float x,float y,float z) {
|
|
this(x,y,z,1);
|
|
}
|
|
public Vector(float x,float y,float z,float w) {
|
|
this.x=x;
|
|
this.y=y;
|
|
this.z=z;
|
|
this.w=w;
|
|
}
|
|
@Override
|
|
protected Object clone(){
|
|
return new Vector(x,y,z,w);
|
|
}
|
|
|
|
public static Vector add(Vector v1,Vector v2) {
|
|
return new Vector(v1.x+v2.x,v1.y+v2.y,v1.z+v2.z);
|
|
}
|
|
public static Vector subtract(Vector v1,Vector v2) {
|
|
return new Vector(v1.x-v2.x,v1.y-v2.y,v1.z-v2.z);
|
|
}
|
|
public static Vector multiply(Vector v1,float k) {
|
|
return new Vector(v1.x*k,v1.y*k,v1.z*k);
|
|
}
|
|
public static Vector divide(Vector v1,float k) {
|
|
return new Vector(v1.x/k,v1.y/k,v1.z/k);
|
|
}
|
|
public static float dotProduct(Vector v1,Vector v2) {
|
|
return v1.x*v2.x+v1.y*v2.y+v1.z*v2.z;
|
|
}
|
|
public static float length(Vector v) {
|
|
return (float)Math.sqrt(dotProduct(v,v));
|
|
}
|
|
public static Vector normalize(Vector v) {
|
|
float l = length(v);
|
|
return new Vector(v.x/l,v.y/l,v.z/l);
|
|
}
|
|
public static Vector crossProduct(Vector v1,Vector v2) {
|
|
Vector v = new Vector();
|
|
v.x=v1.y*v2.z-v1.z*v2.y;
|
|
v.y=v1.z*v2.x-v1.x*v2.z;
|
|
v.z=v1.x*v2.y-v1.y*v2.x;
|
|
return v;
|
|
}
|
|
|
|
@Override
|
|
public String toString() {
|
|
return "Vector ["+x+","+y+","+z+","+w+"]";
|
|
}
|
|
public static Vector IntersectPlane(Vector plane_p,Vector plane_n,Vector lineStart,Vector lineEnd,ExtraData tt) {
|
|
plane_n = Vector.normalize(plane_n);
|
|
float plane_d = -Vector.dotProduct(plane_n,plane_p);
|
|
float ad = Vector.dotProduct(lineStart,plane_n);
|
|
float bd = Vector.dotProduct(lineEnd,plane_n);
|
|
float t = (-plane_d-ad)/(bd-ad);
|
|
tt.t=t;
|
|
Vector lineStartToEnd = Vector.subtract(lineEnd,lineStart);
|
|
Vector lineToIntersect = Vector.multiply(lineStartToEnd,t);
|
|
return Vector.add(lineStart,lineToIntersect);
|
|
}
|
|
}
|
|
|