Files
faceclaw/tests/imu-types.test.cjs
James Babcock e09f8eae96 Simplify glanceboard-trigger angle setting; fix incorrectly-rotated accelerometer readings on G1
The glanceboard head-tilt option was more complicated than necessary,
because it wanted the user to take two angle measurements, a baseline
angle and a tilt angle. That was a workaround to not knowing the
accelerometer's orientation/calibration, but actually, we do know those.

(Except, as it turns out, on the G1, the accelerometer orientation is
different than it is on the G2, and there was a bug where EvenHub apps
got their accelerometer readings in the wrong orientation. So for
example the EvenHub Level app didn't work correctly.)
2026-11-15 23:29:02 -08:00

31 lines
1.2 KiB
JavaScript

const test = require("node:test");
const assert = require("node:assert/strict");
const { imuPitchDegrees } = require("../.test-build/app/native/imu-types.js");
const rad = (deg) => (deg * Math.PI) / 180;
/**
* A reading at rest in the canonical frame (+x forward, +y left, +z up), in
* m/s^2 to show the scale does not matter: the head pitched up by pitchDeg,
* then rolled by rollDeg.
*/
function reading(pitchDeg, rollDeg = 0) {
const p = rad(pitchDeg);
const r = rad(rollDeg);
return { x: 9.8 * Math.sin(p), y: 9.8 * Math.cos(p) * Math.sin(r), z: 9.8 * Math.cos(p) * Math.cos(r) };
}
test("imuPitchDegrees reads the head's pitch from one reading, past 45° and with the head rolled", () => {
for (const pitch of [-30, 0, 5, 20, 45, 50, 60, 75]) {
for (const roll of [0, 30, -40]) {
assert.ok(Math.abs(imuPitchDegrees(reading(pitch, roll)) - pitch) < 1e-6, `pitch ${pitch} roll ${roll}`);
}
}
// The poses measured on a G2 (in g).
const s = Math.SQRT1_2;
assert.ok(Math.abs(imuPitchDegrees({ x: 0, y: 0, z: 1 })) < 1e-9);
assert.ok(Math.abs(imuPitchDegrees({ x: s, y: 0, z: s }) - 45) < 1e-9);
assert.ok(Math.abs(imuPitchDegrees({ x: 0, y: s, z: s })) < 1e-9);
});