Small fixes

ButterscotchV · ButterscotchV · commit fbecabfe48b0 · 2026-03-01T05:03:30.000-05:00
diff --git a/server/core/src/test/java/dev/slimevr/unit/ResetTheoryTests.kt b/server/core/src/test/java/dev/slimevr/unit/ResetTheoryTests.kt
@@ -1,8 +1,10 @@
 package dev.slimevr.unit
 
 import com.jme3.math.FastMath
+import dev.slimevr.unit.TrackerTestUtils.assertAngleEquals
 import dev.slimevr.unit.TrackerTestUtils.assertQuatEquals
 import dev.slimevr.unit.TrackerTestUtils.assertQuatNotEquals
+import dev.slimevr.unit.TrackerTestUtils.quatApproxEqual
 import io.github.axisangles.ktmath.EulerAngles
 import io.github.axisangles.ktmath.EulerOrder
 import io.github.axisangles.ktmath.Quaternion
@@ -102,19 +104,20 @@ class ResetTheoryTests {
 	) {
 		val boneOrientationA = (rawOrientation * attitudeAlign).toEulerAngles(EulerOrder.YZX)
 		val boneOrientationB = (headingCorrect * rawOrientation * attitudeAlign).toEulerAngles(EulerOrder.YZX)
-		assertEquals(boneOrientationA.x, boneOrientationB.x, FastMath.ZERO_TOLERANCE)
-		assertEquals(boneOrientationA.z, boneOrientationB.z, FastMath.ZERO_TOLERANCE)
+		assertAngleEquals(boneOrientationA.x, boneOrientationB.x, FastMath.ZERO_TOLERANCE)
+		assertAngleEquals(boneOrientationA.z, boneOrientationB.z, FastMath.ZERO_TOLERANCE)
 		// We can also show that we're calculating the right attitude alignment.
 		val attitudeAlignEul = attitudeAlign.toEulerAngles(EulerOrder.YZX)
-		assertEquals(attitudeAlignEul.x, boneOrientationA.x, FastMath.ZERO_TOLERANCE)
-		assertEquals(attitudeAlignEul.z, boneOrientationA.z, FastMath.ZERO_TOLERANCE)
+		assertAngleEquals(attitudeAlignEul.x, boneOrientationA.x, FastMath.ZERO_TOLERANCE)
+		assertAngleEquals(attitudeAlignEul.z, boneOrientationA.z, FastMath.ZERO_TOLERANCE)
 	}
 
 	@TestFactory
 	fun attitudeHeadingAlignDependenceTests(): List<DynamicTest> {
 		// Order doesn't matter if the attitude alignment has no attitude.
 		return roughAttitude.filterNot { FastMath.isApproxZero(it.x) && FastMath.isApproxZero(it.z) }.flatMap { aA ->
-			roughHeading.map { hA ->
+			// Same for if heading alignment is the quaternion identity.
+			roughHeading.filterNot { quatApproxEqual(it, Quaternion.IDENTITY) }.map { hA ->
 				DynamicTest.dynamicTest(
 					"testAttitudeHeadingAlignDependence( aA: $aA, hA: $hA )",
 				) {
