MatrixUtil.java
com.mojang.math.MatrixUtil
信息
- 全限定名：com.mojang.math.MatrixUtil
- 类型：public class
- 包：com.mojang.math
- 源码路径：src/main/java/com/mojang/math/MatrixUtil.java
- 起始行号：L11
- 职责：
TODO
字段/常量
-
G- 类型:
float - 修饰符:
private static final - 源码定位:
L12 - 说明:
TODO
- 类型:
-
PI_4- 类型:
GivensParameters - 修饰符:
private static final - 源码定位:
L13 - 说明:
TODO
- 类型:
内部类/嵌套类型
- 无
构造器
private MatrixUtil() @ L15
- 构造器名：MatrixUtil
- 源码定位：L15
- 修饰符：private
参数:
- 无
说明:
TODO
方法
下面的方法块按源码顺序生成。
public static Matrix4f mulComponentWise(Matrix4f m, float factor) @ L18
- 方法名：mulComponentWise
- 源码定位：L18
- 返回类型：Matrix4f
- 修饰符：public static
参数:
- m: Matrix4f
- factor: float
说明:
TODO
private static GivensParameters approxGivensQuat(float a11, float a12, float a22) @ L39
- 方法名：approxGivensQuat
- 源码定位：L39
- 返回类型：GivensParameters
- 修饰符：private static
参数:
- a11: float
- a12: float
- a22: float
说明:
TODO
private static GivensParameters qrGivensQuat(float a1, float a2) @ L44
- 方法名：qrGivensQuat
- 源码定位：L44
- 返回类型：GivensParameters
- 修饰符：private static
参数:
- a1: float
- a2: float
说明:
TODO
private static void similarityTransform(Matrix3f a, Matrix3f q) @ L57
- 方法名：similarityTransform
- 源码定位：L57
- 返回类型：void
- 修饰符：private static
参数:
- a: Matrix3f
- q: Matrix3f
说明:
TODO
private static void stepJacobi(Matrix3f m, Matrix3f tmpMat, Quaternionf tmpQ, Quaternionf output) @ L64
- 方法名：stepJacobi
- 源码定位：L64
- 返回类型：void
- 修饰符：private static
参数:
- m: Matrix3f
- tmpMat: Matrix3f
- tmpQ: Quaternionf
- output: Quaternionf
说明:
TODO
public static Quaternionf eigenvalueJacobi(Matrix3f inOut, int steps) @ L90
- 方法名：eigenvalueJacobi
- 源码定位：L90
- 返回类型：Quaternionf
- 修饰符：public static
参数:
- inOut: Matrix3f
- steps: int
说明:
TODO
public static Triple<Quaternionf,Vector3f,Quaternionf> svdDecompose(Matrix3f matrix) @ L103
- 方法名：svdDecompose
- 源码定位：L103
- 返回类型：Triple<Quaternionf,Vector3f,Quaternionf>
- 修饰符：public static
参数:
- matrix: Matrix3f
说明:
TODO
public static boolean checkPropertyRaw(Matrix4fc matrix, int property) @ L151
- 方法名：checkPropertyRaw
- 源码定位：L151
- 返回类型：boolean
- 修饰符：public static
参数:
- matrix: Matrix4fc
- property: int
说明:
TODO
public static boolean checkProperty(Matrix4fc matrix, int property) @ L155
- 方法名：checkProperty
- 源码定位：L155
- 返回类型：boolean
- 修饰符：public static
参数:
- matrix: Matrix4fc
- property: int
说明:
TODO
public static boolean isIdentity(Matrix4fc matrix) @ L168
- 方法名：isIdentity
- 源码定位：L168
- 返回类型：boolean
- 修饰符：public static
参数:
- matrix: Matrix4fc
说明:
TODO
public static boolean isPureTranslation(Matrix4fc matrix) @ L172
- 方法名：isPureTranslation
- 源码定位：L172
- 返回类型：boolean
- 修饰符：public static
参数:
- matrix: Matrix4fc
说明:
TODO
代码
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 m, float factor) {
return m.set(
m.m00() * factor,
m.m01() * factor,
m.m02() * factor,
m.m03() * factor,
m.m10() * factor,
m.m11() * factor,
m.m12() * factor,
m.m13() * factor,
m.m20() * factor,
m.m21() * factor,
m.m22() * factor,
m.m23() * factor,
m.m30() * factor,
m.m31() * factor,
m.m32() * factor,
m.m33() * factor
);
}
private static GivensParameters approxGivensQuat(float a11, float a12, float a22) {
float ch = 2.0F * (a11 - a22);
return G * a12 * a12 < ch * ch ? GivensParameters.fromUnnormalized(a12, ch) : PI_4;
}
private static GivensParameters qrGivensQuat(float a1, float a2) {
float p = (float)java.lang.Math.hypot(a1, a2);
float sh = p > 1.0E-6F ? a2 : 0.0F;
float ch = Math.abs(a1) + Math.max(p, 1.0E-6F);
if (a1 < 0.0F) {
float f = sh;
sh = ch;
ch = f;
}
return GivensParameters.fromUnnormalized(sh, ch);
}
private static void similarityTransform(Matrix3f a, Matrix3f q) {
a.mul(q);
q.transpose();
q.mul(a);
a.set(q);
}
private static void stepJacobi(Matrix3f m, Matrix3f tmpMat, Quaternionf tmpQ, Quaternionf output) {
if (m.m01 * m.m01 + m.m10 * m.m10 > 1.0E-6F) {
GivensParameters p = approxGivensQuat(m.m00, 0.5F * (m.m01 + m.m10), m.m11);
Quaternionf qt = p.aroundZ(tmpQ);
output.mul(qt);
p.aroundZ(tmpMat);
similarityTransform(m, tmpMat);
}
if (m.m02 * m.m02 + m.m20 * m.m20 > 1.0E-6F) {
GivensParameters p = approxGivensQuat(m.m00, 0.5F * (m.m02 + m.m20), m.m22).inverse();
Quaternionf qt = p.aroundY(tmpQ);
output.mul(qt);
p.aroundY(tmpMat);
similarityTransform(m, tmpMat);
}
if (m.m12 * m.m12 + m.m21 * m.m21 > 1.0E-6F) {
GivensParameters p = approxGivensQuat(m.m11, 0.5F * (m.m12 + m.m21), m.m22);
Quaternionf qt = p.aroundX(tmpQ);
output.mul(qt);
p.aroundX(tmpMat);
similarityTransform(m, tmpMat);
}
}
public static Quaternionf eigenvalueJacobi(Matrix3f inOut, int steps) {
Quaternionf v = new Quaternionf();
Matrix3f scratchMat = new Matrix3f();
Quaternionf scratchQ = new Quaternionf();
for (int i = 0; i < steps; i++) {
stepJacobi(inOut, scratchMat, scratchQ, v);
}
v.normalize();
return v;
}
public static Triple<Quaternionf, Vector3f, Quaternionf> svdDecompose(Matrix3f matrix) {
Matrix3f b = new Matrix3f(matrix);
b.transpose();
b.mul(matrix);
Quaternionf v = eigenvalueJacobi(b, 5);
float columnScaleSquare0 = b.m00;
float columnScaleSquare1 = b.m11;
boolean zeroColumn0 = columnScaleSquare0 < 1.0E-6;
boolean zeroColumn1 = columnScaleSquare1 < 1.0E-6;
Matrix3f u012s = matrix.rotate(v);
Quaternionf u = new Quaternionf();
Quaternionf tmpQ = new Quaternionf();
GivensParameters p;
if (zeroColumn0) {
p = qrGivensQuat(u012s.m11, -u012s.m10);
} else {
p = qrGivensQuat(u012s.m00, u012s.m01);
}
Quaternionf qt0 = p.aroundZ(tmpQ);
Matrix3f u12s = p.aroundZ(b);
u.mul(qt0);
u12s.transpose().mul(u012s);
if (zeroColumn0) {
p = qrGivensQuat(u12s.m22, -u12s.m20);
} else {
p = qrGivensQuat(u12s.m00, u12s.m02);
}
p = p.inverse();
Quaternionf qt1 = p.aroundY(tmpQ);
Matrix3f u2s = p.aroundY(u012s);
u.mul(qt1);
u2s.transpose().mul(u12s);
if (zeroColumn1) {
p = qrGivensQuat(u2s.m22, -u2s.m21);
} else {
p = qrGivensQuat(u2s.m11, u2s.m12);
}
Quaternionf qt2 = p.aroundX(tmpQ);
Matrix3f s = p.aroundX(u12s);
u.mul(qt2);
s.transpose().mul(u2s);
Vector3f scale = new Vector3f(s.m00, s.m11, s.m22);
return Triple.of(u, scale, v.conjugate());
}
public static boolean checkPropertyRaw(Matrix4fc matrix, int property) {
return (matrix.properties() & property) != 0;
}
public static boolean checkProperty(Matrix4fc matrix, int property) {
if (checkPropertyRaw(matrix, property)) {
return true;
} else if (matrix instanceof Matrix4f mutableMatrix) {
int currentProperties = mutableMatrix.properties();
mutableMatrix.determineProperties();
mutableMatrix.assume(mutableMatrix.properties() | currentProperties);
return checkPropertyRaw(matrix, property);
} else {
return false;
}
}
public static boolean isIdentity(Matrix4fc matrix) {
return checkProperty(matrix, 4);
}
public static boolean isPureTranslation(Matrix4fc matrix) {
return checkProperty(matrix, 8);
}
}引用的其他类
- GivensParameters
- 引用位置:
字段/方法调用/返回值 - 关联成员:
GivensParameters.fromPositiveAngle(), GivensParameters.fromUnnormalized()
- 引用位置: