Something went wrong. Try again.
The Minecraft: Java Edition decompiled source code.
Something went wrong. Try again.
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178package com.mojang.math;
import org.apache.commons.lang3.tuple.Triple;import org.joml.Math;import org.joml.Matrix3f;import org.joml.Matrix4f;import org.joml.Matrix4fc;import org.joml.Quaternionf;import org.joml.Vector3f;
public class MatrixUtil { private static final float G = 3.0F + 2.0F * Math.sqrt(2.0F); private static final GivensParameters PI_4 = GivensParameters.fromPositiveAngle((float) (java.lang.Math.PI / 4));
private MatrixUtil() { }
public static Matrix4f mulComponentWise(Matrix4f matrix4f, float f) { return matrix4f.set( matrix4f.m00() * f, matrix4f.m01() * f, matrix4f.m02() * f, matrix4f.m03() * f, matrix4f.m10() * f, matrix4f.m11() * f, matrix4f.m12() * f, matrix4f.m13() * f, matrix4f.m20() * f, matrix4f.m21() * f, matrix4f.m22() * f, matrix4f.m23() * f, matrix4f.m30() * f, matrix4f.m31() * f, matrix4f.m32() * f, matrix4f.m33() * f ); }
private static GivensParameters approxGivensQuat(float f, float g, float h) { float i = 2.0F * (f - h); return G * g * g < i * i ? GivensParameters.fromUnnormalized(g, i) : PI_4; }
private static GivensParameters qrGivensQuat(float f, float g) { float h = (float)java.lang.Math.hypot((double)f, (double)g); float i = h > 1.0E-6F ? g : 0.0F; float j = Math.abs(f) + Math.max(h, 1.0E-6F); if (f < 0.0F) { float k = i; i = j; j = k; }
return GivensParameters.fromUnnormalized(i, j); }
private static void similarityTransform(Matrix3f matrix3f, Matrix3f matrix3f1) { matrix3f.mul(matrix3f1); matrix3f1.transpose(); matrix3f1.mul(matrix3f); matrix3f.set(matrix3f1); }
private static void stepJacobi(Matrix3f matrix3f, Matrix3f matrix3f1, Quaternionf quaternionf, Quaternionf quaternionf1) { if (matrix3f.m01 * matrix3f.m01 + matrix3f.m10 * matrix3f.m10 > 1.0E-6F) { GivensParameters givensParameters = approxGivensQuat(matrix3f.m00, 0.5F * (matrix3f.m01 + matrix3f.m10), matrix3f.m11); Quaternionf quaternionf2 = givensParameters.aroundZ(quaternionf); quaternionf1.mul(quaternionf2); givensParameters.aroundZ(matrix3f1); similarityTransform(matrix3f, matrix3f1); }
if (matrix3f.m02 * matrix3f.m02 + matrix3f.m20 * matrix3f.m20 > 1.0E-6F) { GivensParameters givensParameters1 = approxGivensQuat(matrix3f.m00, 0.5F * (matrix3f.m02 + matrix3f.m20), matrix3f.m22).inverse(); Quaternionf quaternionf3 = givensParameters1.aroundY(quaternionf); quaternionf1.mul(quaternionf3); givensParameters1.aroundY(matrix3f1); similarityTransform(matrix3f, matrix3f1); }
if (matrix3f.m12 * matrix3f.m12 + matrix3f.m21 * matrix3f.m21 > 1.0E-6F) { GivensParameters givensParameters2 = approxGivensQuat(matrix3f.m11, 0.5F * (matrix3f.m12 + matrix3f.m21), matrix3f.m22); Quaternionf quaternionf4 = givensParameters2.aroundX(quaternionf); quaternionf1.mul(quaternionf4); givensParameters2.aroundX(matrix3f1); similarityTransform(matrix3f, matrix3f1); } }
public static Quaternionf eigenvalueJacobi(Matrix3f matrix3f, int i) { Quaternionf quaternionf = new Quaternionf(); Matrix3f matrix3f1 = new Matrix3f(); Quaternionf quaternionf1 = new Quaternionf();
for (int j = 0; j < i; j++) { stepJacobi(matrix3f, matrix3f1, quaternionf1, quaternionf); }
quaternionf.normalize(); return quaternionf; }
public static Triple<Quaternionf, Vector3f, Quaternionf> svdDecompose(Matrix3f matrix3f) { Matrix3f matrix3f1 = new Matrix3f(matrix3f); matrix3f1.transpose(); matrix3f1.mul(matrix3f); Quaternionf quaternionf = eigenvalueJacobi(matrix3f1, 5); float f = matrix3f1.m00; float g = matrix3f1.m11; boolean bl = (double)f < 1.0E-6; boolean bl1 = (double)g < 1.0E-6; Matrix3f matrix3f2 = matrix3f.rotate(quaternionf); Quaternionf quaternionf1 = new Quaternionf(); Quaternionf quaternionf2 = new Quaternionf(); GivensParameters givensParameters; if (bl) { givensParameters = qrGivensQuat(matrix3f2.m11, -matrix3f2.m10); } else { givensParameters = qrGivensQuat(matrix3f2.m00, matrix3f2.m01); }
Quaternionf quaternionf3 = givensParameters.aroundZ(quaternionf2); Matrix3f matrix3f3 = givensParameters.aroundZ(matrix3f1); quaternionf1.mul(quaternionf3); matrix3f3.transpose().mul(matrix3f2); if (bl) { givensParameters = qrGivensQuat(matrix3f3.m22, -matrix3f3.m20); } else { givensParameters = qrGivensQuat(matrix3f3.m00, matrix3f3.m02); }
givensParameters = givensParameters.inverse(); Quaternionf quaternionf4 = givensParameters.aroundY(quaternionf2); Matrix3f matrix3f4 = givensParameters.aroundY(matrix3f2); quaternionf1.mul(quaternionf4); matrix3f4.transpose().mul(matrix3f3); if (bl1) { givensParameters = qrGivensQuat(matrix3f4.m22, -matrix3f4.m21); } else { givensParameters = qrGivensQuat(matrix3f4.m11, matrix3f4.m12); }
Quaternionf quaternionf5 = givensParameters.aroundX(quaternionf2); Matrix3f matrix3f5 = givensParameters.aroundX(matrix3f3); quaternionf1.mul(quaternionf5); matrix3f5.transpose().mul(matrix3f4); Vector3f vector3f = new Vector3f(matrix3f5.m00, matrix3f5.m11, matrix3f5.m22); return Triple.of(quaternionf1, vector3f, quaternionf.conjugate()); }
private static boolean checkPropertyRaw(Matrix4fc matrix4fc, int i) { return (matrix4fc.properties() & i) != 0; }
public static boolean checkProperty(Matrix4fc matrix4fc, int i) { if (checkPropertyRaw(matrix4fc, i)) { return true; } else if (matrix4fc instanceof Matrix4f matrix4f) { matrix4f.determineProperties(); return checkPropertyRaw(matrix4fc, i); } else { return false; } }
public static boolean isIdentity(Matrix4fc matrix4fc) { return checkProperty(matrix4fc, 4); }
public static boolean isPureTranslation(Matrix4fc matrix4fc) { return checkProperty(matrix4fc, 8); }
public static boolean isOrthonormal(Matrix4fc matrix4fc) { return checkProperty(matrix4fc, 16); }}