Files
make-cad/scene-contract/src/transforms.ts
T
2026-07-23 03:16:27 +08:00

36 lines
1.4 KiB
TypeScript

/** Deterministic rigid-transform primitives used by Scene validation. */
type JsonRecord = Record<string, unknown>;
export function composeRigidTransforms(left: JsonRecord, right: JsonRecord): JsonRecord {
const origin = left.origin as number[];
const xAxis = left.x_axis as number[];
const yAxis = left.y_axis as number[];
const zAxis = left.z_axis as number[];
const rotate = (vector: number[]): number[] => [0, 1, 2].map((index) =>
(xAxis[index] * vector[0] + yAxis[index] * vector[1]) + zAxis[index] * vector[2]
);
const rotatedOrigin = rotate(right.origin as number[]);
return {
origin: origin.map((component, index) => component + rotatedOrigin[index]),
x_axis: rotate(right.x_axis as number[]),
y_axis: rotate(right.y_axis as number[]),
z_axis: rotate(right.z_axis as number[]),
};
}
export function rigidTransformsEqual(actual: JsonRecord, expected: JsonRecord): boolean {
const actualOrigin = actual.origin as number[];
const expectedOrigin = expected.origin as number[];
const originEpsilon = Math.max(
1e-9,
1e-12 * Math.max(1, ...actualOrigin.map(Math.abs), ...expectedOrigin.map(Math.abs)),
);
return actualOrigin.every((component, index) => Math.abs(component - expectedOrigin[index]) <= originEpsilon) &&
["x_axis", "y_axis", "z_axis"].every((key) =>
(actual[key] as number[]).every((component, index) =>
Math.abs(component - (expected[key] as number[])[index]) <= 1e-12
)
);
}