@flighthq/physics3d 0.4.0-next.1694.598ef6f

package/dist/jointMath.js

@@ -0,0 +1,361 @@
+import { applySymmetricTensor, TENSOR_XX, TENSOR_XY, TENSOR_XZ, TENSOR_YY, TENSOR_YZ, TENSOR_ZZ, } from './symmetricTensor';
+// The constraint arithmetic every 3D joint kind is assembled from: lever arms, effective-mass blocks,
+// frame extraction, and the two impulse appliers.
+//
+// Package-internal, like `symmetricTensor`. These take and return loose numbers rather than
+// `@flighthq/geometry`'s `Quaternion` and `Vector3`, which are `Entity` types over a `Float32Array` — both
+// an indirection in a per-iteration loop and a precision step down from what a solver's accumulators need.
+// That is also why the quaternion helpers here are private rather than reaching for
+// `multiplyQuaternion`/`rotateVector3ByQuaternion`: those operate on the entity form.
+//
+// ONE SIGN CONVENTION HOLDS THROUGHOUT: every impulse is applied POSITIVE TO B and NEGATIVE TO A, and every
+// relative quantity is measured B RELATIVE TO A. So a positive impulse along a direction increases the
+// relative velocity along it, and `impulse = -mass * (velocity + bias)` drives the constraint to rest. The
+// contact solver uses the opposite sense, because a contact normal points out of B and resolving pushes A
+// away; mixing the two is not a small error, because the correction then adds to the violation and
+// compounds every iteration.
+// Applies an equal and opposite PURE angular impulse: B gains it, A loses it. No linear velocity changes,
+// which is what makes it usable for a hinge's axis rows without disturbing the point constraint holding the
+// same joint together.
+export function applyPhysics3DJointAngularImpulse(bodyA, bodyB, impulseX, impulseY, impulseZ) {
+    readWorldInverseInertia(bodyA, angularImpulseTensor);
+    applySymmetricTensor(angularImpulseTensor, impulseX, impulseY, impulseZ, angularImpulseVector);
+    bodyA.angularVelocityX -= angularImpulseVector[0];
+    bodyA.angularVelocityY -= angularImpulseVector[1];
+    bodyA.angularVelocityZ -= angularImpulseVector[2];
+    readWorldInverseInertia(bodyB, angularImpulseTensor);
+    applySymmetricTensor(angularImpulseTensor, impulseX, impulseY, impulseZ, angularImpulseVector);
+    bodyB.angularVelocityX += angularImpulseVector[0];
+    bodyB.angularVelocityY += angularImpulseVector[1];
+    bodyB.angularVelocityZ += angularImpulseVector[2];
+}
+// Applies an equal and opposite linear impulse at the two anchors: B gains it, A loses it. Each body also
+// picks up the torque of the impulse about its own lever arm, which is the term that lets a joint spin a
+// body it is only pulling on.
+//
+// A static or fixed-rotation body's zero inverse mass and zero inverse inertia make this a no-op with no
+// branch, which is the whole reason infinite mass is a zero inverse rather than a flag.
+export function applyPhysics3DJointImpulse(bodyA, bodyB, rAX, rAY, rAZ, rBX, rBY, rBZ, impulseX, impulseY, impulseZ) {
+    applyBodyJointImpulse(bodyA, rAX, rAY, rAZ, -impulseX, -impulseY, -impulseZ);
+    applyBodyJointImpulse(bodyB, rBX, rBY, rBZ, impulseX, impulseY, impulseZ);
+}
+// Applies one scalar constraint row's impulse — the counterpart of `getPhysics3DJointRowMass`, acting
+// through the same linear direction and the same two angular arms, so a row's mass and its impulse can
+// never describe different constraints.
+//
+// The arms are given rather than derived because they are NOT always `r x direction`. A slider's
+// perpendicular row acts through `(rA + separation) x direction` on A, since its axis is carried by A and
+// rotates with it; using A's bare lever arm there leaks motion sideways whenever the rail body turns.
+export function applyPhysics3DJointRowImpulse(bodyA, bodyB, directionX, directionY, directionZ, armAX, armAY, armAZ, armBX, armBY, armBZ, impulse) {
+    bodyA.velocityX -= impulse * directionX * bodyA.inverseMass;
+    bodyA.velocityY -= impulse * directionY * bodyA.inverseMass;
+    bodyA.velocityZ -= impulse * directionZ * bodyA.inverseMass;
+    readWorldInverseInertia(bodyA, rowImpulseTensor);
+    applySymmetricTensor(rowImpulseTensor, armAX * impulse, armAY * impulse, armAZ * impulse, rowImpulseVector);
+    bodyA.angularVelocityX -= rowImpulseVector[0];
+    bodyA.angularVelocityY -= rowImpulseVector[1];
+    bodyA.angularVelocityZ -= rowImpulseVector[2];
+    bodyB.velocityX += impulse * directionX * bodyB.inverseMass;
+    bodyB.velocityY += impulse * directionY * bodyB.inverseMass;
+    bodyB.velocityZ += impulse * directionZ * bodyB.inverseMass;
+    readWorldInverseInertia(bodyB, rowImpulseTensor);
+    applySymmetricTensor(rowImpulseTensor, armBX * impulse, armBY * impulse, armBZ * impulse, rowImpulseVector);
+    bodyB.angularVelocityX += rowImpulseVector[0];
+    bodyB.angularVelocityY += rowImpulseVector[1];
+    bodyB.angularVelocityZ += rowImpulseVector[2];
+}
+// The scalar effective mass of one constraint row, given its linear direction and the two angular arms the
+// row acts through. Returns 0 when the pair cannot move along the row at all, so the impulse computed from
+// it is zero rather than infinite.
+//
+// The linear term is scaled by the direction's own squared length, so a PURELY ANGULAR row — a hinge's
+// motor, a twist limit — passes a zero direction and the two bodies' translational masses drop out on their
+// own. Without that scaling the caller would have to choose between two nearly identical functions, and the
+// one place that picked wrong would report a hinge motor as heavier than it is by the pair's whole mass.
+export function getPhysics3DJointRowMass(bodyA, bodyB, directionX, directionY, directionZ, armAX, armAY, armAZ, armBX, armBY, armBZ) {
+    const linear = directionX * directionX + directionY * directionY + directionZ * directionZ;
+    let denominator = (bodyA.inverseMass + bodyB.inverseMass) * linear;
+    readWorldInverseInertia(bodyA, rowMassTensor);
+    applySymmetricTensor(rowMassTensor, armAX, armAY, armAZ, rowMassVector);
+    denominator += armAX * rowMassVector[0] + armAY * rowMassVector[1] + armAZ * rowMassVector[2];
+    readWorldInverseInertia(bodyB, rowMassTensor);
+    applySymmetricTensor(rowMassTensor, armBX, armBY, armBZ, rowMassVector);
+    denominator += armBX * rowMassVector[0] + armBY * rowMassVector[1] + armBZ * rowMassVector[2];
+    return denominator > 0 ? 1 / denominator : 0;
+}
+// The rate at which one constraint row's coordinate is changing — B relative to A, so a positive value means
+// the row's error is growing. The third member of the row triple, and the one every solve reads before
+// deciding an impulse.
+export function getPhysics3DJointRowVelocity(bodyA, bodyB, directionX, directionY, directionZ, armAX, armAY, armAZ, armBX, armBY, armBZ) {
+    return ((bodyB.velocityX - bodyA.velocityX) * directionX +
+        (bodyB.velocityY - bodyA.velocityY) * directionY +
+        (bodyB.velocityZ - bodyA.velocityZ) * directionZ +
+        bodyB.angularVelocityX * armBX +
+        bodyB.angularVelocityY * armBY +
+        bodyB.angularVelocityZ * armBZ -
+        bodyA.angularVelocityX * armAX -
+        bodyA.angularVelocityY * armAY -
+        bodyA.angularVelocityZ * armAZ);
+}
+// Exchanges a frame-bearing joint's two local rotations, so the generic end swap the registry performs
+// stays consistent for every kind that carries a frame. Each rotation belongs to its body and travels with
+// it; nothing about a frame reverses sign, unlike the direction-bearing scalars a kind may also hold.
+export function swapPhysics3DJointFrames(frames) {
+    const x = frames.localRotationAX;
+    const y = frames.localRotationAY;
+    const z = frames.localRotationAZ;
+    const w = frames.localRotationAW;
+    frames.localRotationAX = frames.localRotationBX;
+    frames.localRotationAY = frames.localRotationBY;
+    frames.localRotationAZ = frames.localRotationBZ;
+    frames.localRotationAW = frames.localRotationBW;
+    frames.localRotationBX = x;
+    frames.localRotationBY = y;
+    frames.localRotationBZ = z;
+    frames.localRotationBW = w;
+}
+// Rotates each body's local anchor into world space, relative to that body's CENTRE OF MASS, and writes the
+// two lever arms onto the joint.
+//
+// Measured from the centre of mass rather than from the body's origin, because that is the point a body
+// rotates about: an impulse at an anchor produces the torque of its arm about the centre, and an arm taken
+// from the origin gives an offset body the swing of a shape it does not have. The two coincide only when a
+// body's centre of mass sits at its origin, which is why the error survives every test built from centred
+// primitives.
+export function writePhysics3DJointAnchors(bodyA, bodyB, joint) {
+    rotateByQuaternion(joint.localAnchorAX - bodyA.centerX, joint.localAnchorAY - bodyA.centerY, joint.localAnchorAZ - bodyA.centerZ, bodyA.orientationX, bodyA.orientationY, bodyA.orientationZ, bodyA.orientationW, anchorVector);
+    joint.rAX = anchorVector[0];
+    joint.rAY = anchorVector[1];
+    joint.rAZ = anchorVector[2];
+    rotateByQuaternion(joint.localAnchorBX - bodyB.centerX, joint.localAnchorBY - bodyB.centerY, joint.localAnchorBZ - bodyB.centerZ, bodyB.orientationX, bodyB.orientationY, bodyB.orientationZ, bodyB.orientationW, anchorVector);
+    joint.rBX = anchorVector[0];
+    joint.rBY = anchorVector[1];
+    joint.rBZ = anchorVector[2];
+}
+// The velocity of B's anchor relative to A's, written into `out` as three world-space components. Each
+// anchor's velocity is its body's linear velocity plus the rotational contribution at its lever arm — the
+// term that makes an anchor move even when the body's centre is still.
+export function writePhysics3DJointAnchorVelocity(bodyA, bodyB, joint, out) {
+    const anchorAX = bodyA.velocityX + (bodyA.angularVelocityY * joint.rAZ - bodyA.angularVelocityZ * joint.rAY);
+    const anchorAY = bodyA.velocityY + (bodyA.angularVelocityZ * joint.rAX - bodyA.angularVelocityX * joint.rAZ);
+    const anchorAZ = bodyA.velocityZ + (bodyA.angularVelocityX * joint.rAY - bodyA.angularVelocityY * joint.rAX);
+    out[0] = bodyB.velocityX + (bodyB.angularVelocityY * joint.rBZ - bodyB.angularVelocityZ * joint.rBY) - anchorAX;
+    out[1] = bodyB.velocityY + (bodyB.angularVelocityZ * joint.rBX - bodyB.angularVelocityX * joint.rBZ) - anchorAY;
+    out[2] = bodyB.velocityZ + (bodyB.angularVelocityX * joint.rBY - bodyB.angularVelocityY * joint.rBX) - anchorAZ;
+}
+// The pair's angular effective-mass block — the sum of the two world inverse inertia tensors — written into
+// `out` in the six-component symmetric form. Invert it with `inverseSymmetricTensor` to solve a three-row
+// angular constraint; project it onto an axis with `getPhysics3DJointRowMass` to solve a single row.
+export function writePhysics3DJointAngularMass(bodyA, bodyB, out) {
+    out[TENSOR_XX] = bodyA.inverseInertiaWorldXX + bodyB.inverseInertiaWorldXX;
+    out[TENSOR_YY] = bodyA.inverseInertiaWorldYY + bodyB.inverseInertiaWorldYY;
+    out[TENSOR_ZZ] = bodyA.inverseInertiaWorldZZ + bodyB.inverseInertiaWorldZZ;
+    out[TENSOR_XY] = bodyA.inverseInertiaWorldXY + bodyB.inverseInertiaWorldXY;
+    out[TENSOR_XZ] = bodyA.inverseInertiaWorldXZ + bodyB.inverseInertiaWorldXZ;
+    out[TENSOR_YZ] = bodyA.inverseInertiaWorldYZ + bodyB.inverseInertiaWorldYZ;
+}
+// The world-space axes of one body's joint frame, written into `out` as nine numbers in COLUMN-MAJOR order:
+// `out[0..2]` is the frame's X axis, `out[3..5]` its Y, `out[6..8]` its Z.
+//
+// X first is the convention every axis-bearing kind shares — a hinge spins about it, a slider translates
+// along it, a cone-twist twists about it — so a caller that needs only the primary axis reads the first
+// three numbers and stops.
+export function writePhysics3DJointFrameBasis(body, localRotationX, localRotationY, localRotationZ, localRotationW, out) {
+    multiplyQuaternions(body.orientationX, body.orientationY, body.orientationZ, body.orientationW, localRotationX, localRotationY, localRotationZ, localRotationW, basisRotation);
+    const x = basisRotation[0];
+    const y = basisRotation[1];
+    const z = basisRotation[2];
+    const w = basisRotation[3];
+    const x2 = x + x;
+    const y2 = y + y;
+    const z2 = z + z;
+    const xx2 = x * x2;
+    const yy2 = y * y2;
+    const zz2 = z * z2;
+    const xy2 = x * y2;
+    const xz2 = x * z2;
+    const yz2 = y * z2;
+    const wx2 = w * x2;
+    const wy2 = w * y2;
+    const wz2 = w * z2;
+    out[0] = 1 - yy2 - zz2;
+    out[1] = xy2 + wz2;
+    out[2] = xz2 - wy2;
+    out[3] = xy2 - wz2;
+    out[4] = 1 - xx2 - zz2;
+    out[5] = yz2 + wx2;
+    out[6] = xz2 + wy2;
+    out[7] = yz2 - wx2;
+    out[8] = 1 - xx2 - yy2;
+}
+// One body's joint frame as a world-space unit quaternion, written into `out` as `[x, y, z, w]`. The
+// rotation half of the frame `writePhysics3DJointFrameBasis` expands into axes; kinds that measure an angle
+// rather than project onto an axis want this form.
+export function writePhysics3DJointFrameRotation(body, localRotationX, localRotationY, localRotationZ, localRotationW, out) {
+    multiplyQuaternions(body.orientationX, body.orientationY, body.orientationZ, body.orientationW, localRotationX, localRotationY, localRotationZ, localRotationW, out);
+}
+// The 3x3 effective-mass block of a point-to-point constraint, written into `out` in the six-component
+// symmetric form.
+//
+// `K = (invMassA + invMassB) * identity + skew(rA) * invInertiaA * transpose(skew(rA)) + (same for B)`, and
+// it is symmetric by construction because each term is. Invert it with `inverseSymmetricTensor` and the
+// three rows are solved as one coupled block; solving x, then y, then z instead lets each axis undo part of
+// the previous correction, which presents as a loaded joint that visibly creeps.
+export function writePhysics3DJointPointMass(bodyA, bodyB, rAX, rAY, rAZ, rBX, rBY, rBZ, out) {
+    const diagonal = bodyA.inverseMass + bodyB.inverseMass;
+    out[TENSOR_XX] = diagonal;
+    out[TENSOR_YY] = diagonal;
+    out[TENSOR_ZZ] = diagonal;
+    out[TENSOR_XY] = 0;
+    out[TENSOR_XZ] = 0;
+    out[TENSOR_YZ] = 0;
+    readWorldInverseInertia(bodyA, pointMassTensor);
+    addSkewSandwich(pointMassTensor, rAX, rAY, rAZ, out);
+    readWorldInverseInertia(bodyB, pointMassTensor);
+    addSkewSandwich(pointMassTensor, rBX, rBY, rBZ, out);
+}
+// The rotation taking frame A onto frame B, written into `out` as `[x, y, z, w]` and expressed IN A'S OWN
+// FRAME rather than in world space. `conjugate(frameA) * frameB`.
+//
+// A's frame is the useful one for a kind that has to take the rotation apart — a cone-twist reads its twist
+// straight off the X component here, because A's X is what twist is defined about. A kind that only needs
+// the error as one vector wants `writePhysics3DJointRotationError` instead, which is this rotated out to
+// world space where the inverse inertia tensors live.
+//
+// `w` is always non-negative on return. A unit quaternion and its negation name the same rotation, so
+// without that fix half of all inputs would decompose as the long way round: a frame a degree from aligned
+// would read as 359 degrees out, and every limit built on it would fire against the wrong bound.
+export function writePhysics3DJointRelativeRotation(frameAX, frameAY, frameAZ, frameAW, frameBX, frameBY, frameBZ, frameBW, out) {
+    multiplyQuaternions(-frameAX, -frameAY, -frameAZ, frameAW, frameBX, frameBY, frameBZ, frameBW, out);
+    if (out[3] < 0) {
+        out[0] = -out[0];
+        out[1] = -out[1];
+        out[2] = -out[2];
+        out[3] = -out[3];
+    }
+}
+// The rotation taking frame A onto frame B, written into `out` as a world-space vector whose direction is
+// the axis and whose magnitude is the angle in radians. Zero exactly when the two frames coincide, which is
+// what makes it usable directly as the positional error of an angular constraint.
+//
+// The angle comes from `2 * atan2(|v|, w)` rather than from the small-angle shortcut `2 * v`. The shortcut
+// is `2 * sin(angle/2) * axis`, which agrees near zero and is 10% short by a quarter turn — invisible on a
+// locked axis, and a limit that stops progressively early as it opens up.
+//
+// The shorter of the two arcs is always chosen. A unit quaternion and its negation name the same rotation,
+// so without the sign fix half of all inputs would report the long way round: a frame a degree from aligned
+// would read as 359 degrees out and the constraint would drive it the wrong way.
+export function writePhysics3DJointRotationError(frameAX, frameAY, frameAZ, frameAW, frameBX, frameBY, frameBZ, frameBW, out) {
+    writePhysics3DJointRelativeRotation(frameAX, frameAY, frameAZ, frameAW, frameBX, frameBY, frameBZ, frameBW, rotationErrorRelative);
+    const x = rotationErrorRelative[0];
+    const y = rotationErrorRelative[1];
+    const z = rotationErrorRelative[2];
+    const sine = Math.sqrt(x * x + y * y + z * z);
+    if (sine < QUATERNION_EPSILON) {
+        out[0] = 0;
+        out[1] = 0;
+        out[2] = 0;
+        return;
+    }
+    const scale = (2 * Math.atan2(sine, rotationErrorRelative[3])) / sine;
+    rotateByQuaternion(x * scale, y * scale, z * scale, frameAX, frameAY, frameAZ, frameAW, out);
+}
+// The world-space offset from A's anchor to B's, written into `out` — the positional error of a
+// point-to-point constraint, and the vector every axis-bearing kind projects onto its frame.
+//
+// Built as `worldCenter + leverArm` rather than `bodyOrigin + leverArm`. The lever arm is measured from the
+// centre of mass, so adding it to the origin lands on the anchor only when the two coincide; for a body
+// whose centre is offset, the two anchors are each wrong by their own rotated offset and the difference
+// does not cancel.
+export function writePhysics3DJointSeparation(bodyA, bodyB, joint, out) {
+    writeWorldCenter(bodyA, separationCenter);
+    const anchorAX = separationCenter[0] + joint.rAX;
+    const anchorAY = separationCenter[1] + joint.rAY;
+    const anchorAZ = separationCenter[2] + joint.rAZ;
+    writeWorldCenter(bodyB, separationCenter);
+    out[0] = separationCenter[0] + joint.rBX - anchorAX;
+    out[1] = separationCenter[1] + joint.rBY - anchorAY;
+    out[2] = separationCenter[2] + joint.rBZ - anchorAZ;
+}
+// Adds `skew(r) * tensor * transpose(skew(r))` into an accumulating symmetric block. The rows of `skew(r)`
+// are the three vectors below, and entry (i,j) of the product is `row_i . tensor . row_j` — six distinct
+// entries for a symmetric result, which is why only six are computed.
+function addSkewSandwich(tensor, rX, rY, rZ, out) {
+    applySymmetricTensor(tensor, 0, -rZ, rY, skewRow0);
+    applySymmetricTensor(tensor, rZ, 0, -rX, skewRow1);
+    applySymmetricTensor(tensor, -rY, rX, 0, skewRow2);
+    out[TENSOR_XX] += -rZ * skewRow0[1] + rY * skewRow0[2];
+    out[TENSOR_YY] += rZ * skewRow1[0] - rX * skewRow1[2];
+    out[TENSOR_ZZ] += -rY * skewRow2[0] + rX * skewRow2[1];
+    out[TENSOR_XY] += -rZ * skewRow1[1] + rY * skewRow1[2];
+    out[TENSOR_XZ] += -rZ * skewRow2[1] + rY * skewRow2[2];
+    out[TENSOR_YZ] += rZ * skewRow2[0] - rX * skewRow2[2];
+}
+function applyBodyJointImpulse(body, rX, rY, rZ, impulseX, impulseY, impulseZ) {
+    body.velocityX += impulseX * body.inverseMass;
+    body.velocityY += impulseY * body.inverseMass;
+    body.velocityZ += impulseZ * body.inverseMass;
+    const torqueX = rY * impulseZ - rZ * impulseY;
+    const torqueY = rZ * impulseX - rX * impulseZ;
+    const torqueZ = rX * impulseY - rY * impulseX;
+    readWorldInverseInertia(body, bodyImpulseTensor);
+    applySymmetricTensor(bodyImpulseTensor, torqueX, torqueY, torqueZ, bodyImpulseVector);
+    body.angularVelocityX += bodyImpulseVector[0];
+    body.angularVelocityY += bodyImpulseVector[1];
+    body.angularVelocityZ += bodyImpulseVector[2];
+}
+// `out = a * b`, the Hamilton product, in the order that composes b's rotation FIRST and then a's. Frames
+// are built as `bodyOrientation * localRotation` for exactly that reason: the local rotation is expressed in
+// body space and the body's orientation carries it out to the world.
+function multiplyQuaternions(aX, aY, aZ, aW, bX, bY, bZ, bW, out) {
+    out[0] = aW * bX + aX * bW + aY * bZ - aZ * bY;
+    out[1] = aW * bY - aX * bZ + aY * bW + aZ * bX;
+    out[2] = aW * bZ + aX * bY - aY * bX + aZ * bW;
+    out[3] = aW * bW - aX * bX - aY * bY - aZ * bZ;
+}
+function readWorldInverseInertia(body, out) {
+    out[TENSOR_XX] = body.inverseInertiaWorldXX;
+    out[TENSOR_YY] = body.inverseInertiaWorldYY;
+    out[TENSOR_ZZ] = body.inverseInertiaWorldZZ;
+    out[TENSOR_XY] = body.inverseInertiaWorldXY;
+    out[TENSOR_XZ] = body.inverseInertiaWorldXZ;
+    out[TENSOR_YZ] = body.inverseInertiaWorldYZ;
+}
+// `v + 2 * q.xyz x (q.xyz x v + q.w * v)`, the standard reduction of `q * v * conjugate(q)` for a unit
+// quaternion. Safe when `out` is one of the inputs, since every component is read into a local first.
+function rotateByQuaternion(vX, vY, vZ, qX, qY, qZ, qW, out) {
+    const tX = qY * vZ - qZ * vY + qW * vX;
+    const tY = qZ * vX - qX * vZ + qW * vY;
+    const tZ = qX * vY - qY * vX + qW * vZ;
+    out[0] = vX + 2 * (qY * tZ - qZ * tY);
+    out[1] = vY + 2 * (qZ * tX - qX * tZ);
+    out[2] = vZ + 2 * (qX * tY - qY * tX);
+}
+function writeWorldCenter(body, out) {
+    rotateByQuaternion(body.centerX, body.centerY, body.centerZ, body.orientationX, body.orientationY, body.orientationZ, body.orientationW, out);
+    out[0] += body.x;
+    out[1] += body.y;
+    out[2] += body.z;
+}
+// Below the tolerance the rotation error is genuinely zero and the axis is undefined; returning a zero
+// vector is correct there, where dividing by the vanishing sine would seed NaN into both bodies.
+const QUATERNION_EPSILON = 1e-12;
+// Per-function scratch, never shared between two functions that can be live at once. One shared pool would
+// be smaller and would corrupt the outer call the first time one of these grew a nested use.
+const angularImpulseTensor = [0, 0, 0, 0, 0, 0];
+const angularImpulseVector = [0, 0, 0];
+const anchorVector = [0, 0, 0];
+const basisRotation = [0, 0, 0, 0];
+const bodyImpulseTensor = [0, 0, 0, 0, 0, 0];
+const bodyImpulseVector = [0, 0, 0];
+const pointMassTensor = [0, 0, 0, 0, 0, 0];
+const rotationErrorRelative = [0, 0, 0, 0];
+const rowImpulseTensor = [0, 0, 0, 0, 0, 0];
+const rowImpulseVector = [0, 0, 0];
+const rowMassTensor = [0, 0, 0, 0, 0, 0];
+const rowMassVector = [0, 0, 0];
+const separationCenter = [0, 0, 0];
+const skewRow0 = [0, 0, 0];
+const skewRow1 = [0, 0, 0];
+const skewRow2 = [0, 0, 0];
+//# sourceMappingURL=jointMath.js.map

package/dist/jointMath.js.map

@@ -0,0 +1 @@
+{"version":3,"file":"jointMath.js","sourceRoot":"","sources":["../src/jointMath.ts"],"names":[],"mappings":"AAEA,OAAO,EACL,oBAAoB,EACpB,SAAS,EACT,SAAS,EACT,SAAS,EACT,SAAS,EACT,SAAS,EACT,SAAS,GACV,MAAM,mBAAmB,CAAC;AAE3B,sGAAsG;AACtG,kDAAkD;AAClD,EAAE;AACF,4FAA4F;AAC5F,2GAA2G;AAC3G,2GAA2G;AAC3G,oFAAoF;AACpF,sFAAsF;AACtF,EAAE;AACF,4GAA4G;AAC5G,uGAAuG;AACvG,2GAA2G;AAC3G,0GAA0G;AAC1G,mGAAmG;AACnG,6BAA6B;AAE7B,0GAA0G;AAC1G,4GAA4G;AAC5G,uBAAuB;AACvB,MAAM,UAAU,iCAAiC,CAC/C,KAAkB,EAClB,KAAkB,EAClB,QAAgB,EAChB,QAAgB,EAChB,QAAgB;IAEhB,uBAAuB,CAAC,KAAK,EAAE,oBAAoB,CAAC,CAAC;IACrD,oBAAoB,CAAC,oBAAoB,EAAE,QAAQ,EAAE,QAAQ,EAAE,QAAQ,EAAE,oBAAoB,CAAC,CAAC;IAC/F,KAAK,CAAC,gBAAgB,IAAI,oBAAoB,CAAC,CAAC,CAAC,CAAC;IAClD,KAAK,CAAC,gBAAgB,IAAI,oBAAoB,CAAC,CAAC,CAAC,CAAC;IAClD,KAAK,CAAC,gBAAgB,IAAI,oBAAoB,CAAC,CAAC,CAAC,CAAC;IAElD,uBAAuB,CAAC,KAAK,EAAE,oBAAoB,CAAC,CAAC;IACrD,oBAAoB,CAAC,oBAAoB,EAAE,QAAQ,EAAE,QAAQ,EAAE,QAAQ,EAAE,oBAAoB,CAAC,CAAC;IAC/F,KAAK,CAAC,gBAAgB,IAAI,oBAAoB,CAAC,CAAC,CAAC,CAAC;IAClD,KAAK,CAAC,gBAAgB,IAAI,oBAAoB,CAAC,CAAC,CAAC,CAAC;IAClD,KAAK,CAAC,gBAAgB,IAAI,oBAAoB,CAAC,CAAC,CAAC,CAAC;AACpD,CAAC;AAED,0GAA0G;AAC1G,yGAAyG;AACzG,8BAA8B;AAC9B,EAAE;AACF,yGAAyG;AACzG,wFAAwF;AACxF,MAAM,UAAU,0BAA0B,CACxC,KAAkB,EAClB,KAAkB,EAClB,GAAW,EACX,GAAW,EACX,GAAW,EACX,GAAW,EACX,GAAW,EACX,GAAW,EACX,QAAgB,EAChB,QAAgB,EAChB,QAAgB;IAEhB,qBAAqB,CAAC,KAAK,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC,QAAQ,EAAE,CAAC,QAAQ,EAAE,CAAC,QAAQ,CAAC,CAAC;IAC7E,qBAAqB,CAAC,KAAK,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,QAAQ,EAAE,QAAQ,EAAE,QAAQ,CAAC,CAAC;AAC5E,CAAC;AAED,sGAAsG;AACtG,uGAAuG;AACvG,wCAAwC;AACxC,EAAE;AACF,iGAAiG;AACjG,0GAA0G;AAC1G,sGAAsG;AACtG,MAAM,UAAU,6BAA6B,CAC3C,KAAkB,EAClB,KAAkB,EAClB,UAAkB,EAClB,UAAkB,EAClB,UAAkB,EAClB,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa,EACb,OAAe;IAEf,KAAK,CAAC,SAAS,IAAI,OAAO,GAAG,UAAU,GAAG,KAAK,CAAC,WAAW,CAAC;IAC5D,KAAK,CAAC,SAAS,IAAI,OAAO,GAAG,UAAU,GAAG,KAAK,CAAC,WAAW,CAAC;IAC5D,KAAK,CAAC,SAAS,IAAI,OAAO,GAAG,UAAU,GAAG,KAAK,CAAC,WAAW,CAAC;IAC5D,uBAAuB,CAAC,KAAK,EAAE,gBAAgB,CAAC,CAAC;IACjD,oBAAoB,CAAC,gBAAgB,EAAE,KAAK,GAAG,OAAO,EAAE,KAAK,GAAG,OAAO,EAAE,KAAK,GAAG,OAAO,EAAE,gBAAgB,CAAC,CAAC;IAC5G,KAAK,CAAC,gBAAgB,IAAI,gBAAgB,CAAC,CAAC,CAAC,CAAC;IAC9C,KAAK,CAAC,gBAAgB,IAAI,gBAAgB,CAAC,CAAC,CAAC,CAAC;IAC9C,KAAK,CAAC,gBAAgB,IAAI,gBAAgB,CAAC,CAAC,CAAC,CAAC;IAE9C,KAAK,CAAC,SAAS,IAAI,OAAO,GAAG,UAAU,GAAG,KAAK,CAAC,WAAW,CAAC;IAC5D,KAAK,CAAC,SAAS,IAAI,OAAO,GAAG,UAAU,GAAG,KAAK,CAAC,WAAW,CAAC;IAC5D,KAAK,CAAC,SAAS,IAAI,OAAO,GAAG,UAAU,GAAG,KAAK,CAAC,WAAW,CAAC;IAC5D,uBAAuB,CAAC,KAAK,EAAE,gBAAgB,CAAC,CAAC;IACjD,oBAAoB,CAAC,gBAAgB,EAAE,KAAK,GAAG,OAAO,EAAE,KAAK,GAAG,OAAO,EAAE,KAAK,GAAG,OAAO,EAAE,gBAAgB,CAAC,CAAC;IAC5G,KAAK,CAAC,gBAAgB,IAAI,gBAAgB,CAAC,CAAC,CAAC,CAAC;IAC9C,KAAK,CAAC,gBAAgB,IAAI,gBAAgB,CAAC,CAAC,CAAC,CAAC;IAC9C,KAAK,CAAC,gBAAgB,IAAI,gBAAgB,CAAC,CAAC,CAAC,CAAC;AAChD,CAAC;AAED,2GAA2G;AAC3G,2GAA2G;AAC3G,mCAAmC;AACnC,EAAE;AACF,uGAAuG;AACvG,4GAA4G;AAC5G,4GAA4G;AAC5G,yGAAyG;AACzG,MAAM,UAAU,wBAAwB,CACtC,KAA4B,EAC5B,KAA4B,EAC5B,UAAkB,EAClB,UAAkB,EAClB,UAAkB,EAClB,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa;IAEb,MAAM,MAAM,GAAG,UAAU,GAAG,UAAU,GAAG,UAAU,GAAG,UAAU,GAAG,UAAU,GAAG,UAAU,CAAC;IAC3F,IAAI,WAAW,GAAG,CAAC,KAAK,CAAC,WAAW,GAAG,KAAK,CAAC,WAAW,CAAC,GAAG,MAAM,CAAC;IAEnE,uBAAuB,CAAC,KAAK,EAAE,aAAa,CAAC,CAAC;IAC9C,oBAAoB,CAAC,aAAa,EAAE,KAAK,EAAE,KAAK,EAAE,KAAK,EAAE,aAAa,CAAC,CAAC;IACxE,WAAW,IAAI,KAAK,GAAG,aAAa,CAAC,CAAC,CAAC,GAAG,KAAK,GAAG,aAAa,CAAC,CAAC,CAAC,GAAG,KAAK,GAAG,aAAa,CAAC,CAAC,CAAC,CAAC;IAE9F,uBAAuB,CAAC,KAAK,EAAE,aAAa,CAAC,CAAC;IAC9C,oBAAoB,CAAC,aAAa,EAAE,KAAK,EAAE,KAAK,EAAE,KAAK,EAAE,aAAa,CAAC,CAAC;IACxE,WAAW,IAAI,KAAK,GAAG,aAAa,CAAC,CAAC,CAAC,GAAG,KAAK,GAAG,aAAa,CAAC,CAAC,CAAC,GAAG,KAAK,GAAG,aAAa,CAAC,CAAC,CAAC,CAAC;IAE9F,OAAO,WAAW,GAAG,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,WAAW,CAAC,CAAC,CAAC,CAAC,CAAC;AAC/C,CAAC;AAED,6GAA6G;AAC7G,uGAAuG;AACvG,uBAAuB;AACvB,MAAM,UAAU,4BAA4B,CAC1C,KAA4B,EAC5B,KAA4B,EAC5B,UAAkB,EAClB,UAAkB,EAClB,UAAkB,EAClB,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa,EACb,KAAa;IAEb,OAAO,CACL,CAAC,KAAK,CAAC,SAAS,GAAG,KAAK,CAAC,SAAS,CAAC,GAAG,UAAU;QAChD,CAAC,KAAK,CAAC,SAAS,GAAG,KAAK,CAAC,SAAS,CAAC,GAAG,UAAU;QAChD,CAAC,KAAK,CAAC,SAAS,GAAG,KAAK,CAAC,SAAS,CAAC,GAAG,UAAU;QAChD,KAAK,CAAC,gBAAgB,GAAG,KAAK;QAC9B,KAAK,CAAC,gBAAgB,GAAG,KAAK;QAC9B,KAAK,CAAC,gBAAgB,GAAG,KAAK;QAC9B,KAAK,CAAC,gBAAgB,GAAG,KAAK;QAC9B,KAAK,CAAC,gBAAgB,GAAG,KAAK;QAC9B,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAC/B,CAAC;AACJ,CAAC;AAED,uGAAuG;AACvG,2GAA2G;AAC3G,sGAAsG;AACtG,MAAM,UAAU,wBAAwB,CAAC,MAA4B;IACnE,MAAM,CAAC,GAAG,MAAM,CAAC,eAAe,CAAC;IACjC,MAAM,CAAC,GAAG,MAAM,CAAC,eAAe,CAAC;IACjC,MAAM,CAAC,GAAG,MAAM,CAAC,eAAe,CAAC;IACjC,MAAM,CAAC,GAAG,MAAM,CAAC,eAAe,CAAC;IACjC,MAAM,CAAC,eAAe,GAAG,MAAM,CAAC,eAAe,CAAC;IAChD,MAAM,CAAC,eAAe,GAAG,MAAM,CAAC,eAAe,CAAC;IAChD,MAAM,CAAC,eAAe,GAAG,MAAM,CAAC,eAAe,CAAC;IAChD,MAAM,CAAC,eAAe,GAAG,MAAM,CAAC,eAAe,CAAC;IAChD,MAAM,CAAC,eAAe,GAAG,CAAC,CAAC;IAC3B,MAAM,CAAC,eAAe,GAAG,CAAC,CAAC;IAC3B,MAAM,CAAC,eAAe,GAAG,CAAC,CAAC;IAC3B,MAAM,CAAC,eAAe,GAAG,CAAC,CAAC;AAC7B,CAAC;AAED,4GAA4G;AAC5G,iCAAiC;AACjC,EAAE;AACF,wGAAwG;AACxG,2GAA2G;AAC3G,2GAA2G;AAC3G,0GAA0G;AAC1G,cAAc;AACd,MAAM,UAAU,0BAA0B,CACxC,KAA4B,EAC5B,KAA4B,EAC5B,KAAqB;IAErB,kBAAkB,CAChB,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,OAAO,EACnC,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,OAAO,EACnC,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,OAAO,EACnC,KAAK,CAAC,YAAY,EAClB,KAAK,CAAC,YAAY,EAClB,KAAK,CAAC,YAAY,EAClB,KAAK,CAAC,YAAY,EAClB,YAAY,CACb,CAAC;IACF,KAAK,CAAC,GAAG,GAAG,YAAY,CAAC,CAAC,CAAC,CAAC;IAC5B,KAAK,CAAC,GAAG,GAAG,YAAY,CAAC,CAAC,CAAC,CAAC;IAC5B,KAAK,CAAC,GAAG,GAAG,YAAY,CAAC,CAAC,CAAC,CAAC;IAE5B,kBAAkB,CAChB,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,OAAO,EACnC,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,OAAO,EACnC,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,OAAO,EACnC,KAAK,CAAC,YAAY,EAClB,KAAK,CAAC,YAAY,EAClB,KAAK,CAAC,YAAY,EAClB,KAAK,CAAC,YAAY,EAClB,YAAY,CACb,CAAC;IACF,KAAK,CAAC,GAAG,GAAG,YAAY,CAAC,CAAC,CAAC,CAAC;IAC5B,KAAK,CAAC,GAAG,GAAG,YAAY,CAAC,CAAC,CAAC,CAAC;IAC5B,KAAK,CAAC,GAAG,GAAG,YAAY,CAAC,CAAC,CAAC,CAAC;AAC9B,CAAC;AAED,uGAAuG;AACvG,0GAA0G;AAC1G,uEAAuE;AACvE,MAAM,UAAU,iCAAiC,CAC/C,KAA4B,EAC5B,KAA4B,EAC5B,KAA+B,EAC/B,GAAa;IAEb,MAAM,QAAQ,GAAG,KAAK,CAAC,SAAS,GAAG,CAAC,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,GAAG,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,CAAC,CAAC;IAC7G,MAAM,QAAQ,GAAG,KAAK,CAAC,SAAS,GAAG,CAAC,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,GAAG,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,CAAC,CAAC;IAC7G,MAAM,QAAQ,GAAG,KAAK,CAAC,SAAS,GAAG,CAAC,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,GAAG,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,CAAC,CAAC;IAE7G,GAAG,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,SAAS,GAAG,CAAC,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,GAAG,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,CAAC,GAAG,QAAQ,CAAC;IAChH,GAAG,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,SAAS,GAAG,CAAC,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,GAAG,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,CAAC,GAAG,QAAQ,CAAC;IAChH,GAAG,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,SAAS,GAAG,CAAC,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,GAAG,KAAK,CAAC,gBAAgB,GAAG,KAAK,CAAC,GAAG,CAAC,GAAG,QAAQ,CAAC;AAClH,CAAC;AAED,4GAA4G;AAC5G,0GAA0G;AAC1G,qGAAqG;AACrG,MAAM,UAAU,8BAA8B,CAC5C,KAA4B,EAC5B,KAA4B,EAC5B,GAAa;IAEb,GAAG,CAAC,SAAS,CAAC,GAAG,KAAK,CAAC,qBAAqB,GAAG,KAAK,CAAC,qBAAqB,CAAC;IAC3E,GAAG,CAAC,SAAS,CAAC,GAAG,KAAK,CAAC,qBAAqB,GAAG,KAAK,CAAC,qBAAqB,CAAC;IAC3E,GAAG,CAAC,SAAS,CAAC,GAAG,KAAK,CAAC,qBAAqB,GAAG,KAAK,CAAC,qBAAqB,CAAC;IAC3E,GAAG,CAAC,SAAS,CAAC,GAAG,KAAK,CAAC,qBAAqB,GAAG,KAAK,CAAC,qBAAqB,CAAC;IAC3E,GAAG,CAAC,SAAS,CAAC,GAAG,KAAK,CAAC,qBAAqB,GAAG,KAAK,CAAC,qBAAqB,CAAC;IAC3E,GAAG,CAAC,SAAS,CAAC,GAAG,KAAK,CAAC,qBAAqB,GAAG,KAAK,CAAC,qBAAqB,CAAC;AAC7E,CAAC;AAED,4GAA4G;AAC5G,2EAA2E;AAC3E,EAAE;AACF,yGAAyG;AACzG,wGAAwG;AACxG,2BAA2B;AAC3B,MAAM,UAAU,6BAA6B,CAC3C,IAA2B,EAC3B,cAAsB,EACtB,cAAsB,EACtB,cAAsB,EACtB,cAAsB,EACtB,GAAa;IAEb,mBAAmB,CACjB,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,cAAc,EACd,cAAc,EACd,cAAc,EACd,cAAc,EACd,aAAa,CACd,CAAC;IAEF,MAAM,CAAC,GAAG,aAAa,CAAC,CAAC,CAAC,CAAC;IAC3B,MAAM,CAAC,GAAG,aAAa,CAAC,CAAC,CAAC,CAAC;IAC3B,MAAM,CAAC,GAAG,aAAa,CAAC,CAAC,CAAC,CAAC;IAC3B,MAAM,CAAC,GAAG,aAAa,CAAC,CAAC,CAAC,CAAC;IAC3B,MAAM,EAAE,GAAG,CAAC,GAAG,CAAC,CAAC;IACjB,MAAM,EAAE,GAAG,CAAC,GAAG,CAAC,CAAC;IACjB,MAAM,EAAE,GAAG,CAAC,GAAG,CAAC,CAAC;IACjB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IACnB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IACnB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IACnB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IACnB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IACnB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IACnB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IACnB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IACnB,MAAM,GAAG,GAAG,CAAC,GAAG,EAAE,CAAC;IAEnB,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;IACvB,GAAG,CAAC,CAAC,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;IACnB,GAAG,CAAC,CAAC,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;IACnB,GAAG,CAAC,CAAC,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;IACnB,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;IACvB,GAAG,CAAC,CAAC,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;IACnB,GAAG,CAAC,CAAC,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;IACnB,GAAG,CAAC,CAAC,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;IACnB,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,GAAG,GAAG,GAAG,GAAG,CAAC;AACzB,CAAC;AAED,qGAAqG;AACrG,4GAA4G;AAC5G,mDAAmD;AACnD,MAAM,UAAU,gCAAgC,CAC9C,IAA2B,EAC3B,cAAsB,EACtB,cAAsB,EACtB,cAAsB,EACtB,cAAsB,EACtB,GAAa;IAEb,mBAAmB,CACjB,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,cAAc,EACd,cAAc,EACd,cAAc,EACd,cAAc,EACd,GAAG,CACJ,CAAC;AACJ,CAAC;AAED,uGAAuG;AACvG,kBAAkB;AAClB,EAAE;AACF,4GAA4G;AAC5G,wGAAwG;AACxG,4GAA4G;AAC5G,iFAAiF;AACjF,MAAM,UAAU,4BAA4B,CAC1C,KAA4B,EAC5B,KAA4B,EAC5B,GAAW,EACX,GAAW,EACX,GAAW,EACX,GAAW,EACX,GAAW,EACX,GAAW,EACX,GAAa;IAEb,MAAM,QAAQ,GAAG,KAAK,CAAC,WAAW,GAAG,KAAK,CAAC,WAAW,CAAC;IACvD,GAAG,CAAC,SAAS,CAAC,GAAG,QAAQ,CAAC;IAC1B,GAAG,CAAC,SAAS,CAAC,GAAG,QAAQ,CAAC;IAC1B,GAAG,CAAC,SAAS,CAAC,GAAG,QAAQ,CAAC;IAC1B,GAAG,CAAC,SAAS,CAAC,GAAG,CAAC,CAAC;IACnB,GAAG,CAAC,SAAS,CAAC,GAAG,CAAC,CAAC;IACnB,GAAG,CAAC,SAAS,CAAC,GAAG,CAAC,CAAC;IAEnB,uBAAuB,CAAC,KAAK,EAAE,eAAe,CAAC,CAAC;IAChD,eAAe,CAAC,eAAe,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,CAAC,CAAC;IACrD,uBAAuB,CAAC,KAAK,EAAE,eAAe,CAAC,CAAC;IAChD,eAAe,CAAC,eAAe,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,CAAC,CAAC;AACvD,CAAC;AAED,0GAA0G;AAC1G,kEAAkE;AAClE,EAAE;AACF,4GAA4G;AAC5G,0GAA0G;AAC1G,yGAAyG;AACzG,sDAAsD;AACtD,EAAE;AACF,sGAAsG;AACtG,2GAA2G;AAC3G,iGAAiG;AACjG,MAAM,UAAU,mCAAmC,CACjD,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,GAAa;IAEb,mBAAmB,CAAC,CAAC,OAAO,EAAE,CAAC,OAAO,EAAE,CAAC,OAAO,EAAE,OAAO,EAAE,OAAO,EAAE,OAAO,EAAE,OAAO,EAAE,OAAO,EAAE,GAAG,CAAC,CAAC;IACpG,IAAI,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,EAAE,CAAC;QACf,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,GAAG,CAAC,CAAC,CAAC,CAAC;QACjB,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,GAAG,CAAC,CAAC,CAAC,CAAC;QACjB,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,GAAG,CAAC,CAAC,CAAC,CAAC;QACjB,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,GAAG,CAAC,CAAC,CAAC,CAAC;IACnB,CAAC;AACH,CAAC;AAED,0GAA0G;AAC1G,4GAA4G;AAC5G,kFAAkF;AAClF,EAAE;AACF,2GAA2G;AAC3G,2GAA2G;AAC3G,0EAA0E;AAC1E,EAAE;AACF,2GAA2G;AAC3G,4GAA4G;AAC5G,iFAAiF;AACjF,MAAM,UAAU,gCAAgC,CAC9C,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,OAAe,EACf,GAAa;IAEb,mCAAmC,CACjC,OAAO,EACP,OAAO,EACP,OAAO,EACP,OAAO,EACP,OAAO,EACP,OAAO,EACP,OAAO,EACP,OAAO,EACP,qBAAqB,CACtB,CAAC;IAEF,MAAM,CAAC,GAAG,qBAAqB,CAAC,CAAC,CAAC,CAAC;IACnC,MAAM,CAAC,GAAG,qBAAqB,CAAC,CAAC,CAAC,CAAC;IACnC,MAAM,CAAC,GAAG,qBAAqB,CAAC,CAAC,CAAC,CAAC;IACnC,MAAM,IAAI,GAAG,IAAI,CAAC,IAAI,CAAC,CAAC,GAAG,CAAC,GAAG,CAAC,GAAG,CAAC,GAAG,CAAC,GAAG,CAAC,CAAC,CAAC;IAC9C,IAAI,IAAI,GAAG,kBAAkB,EAAE,CAAC;QAC9B,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC;QACX,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC;QACX,GAAG,CAAC,CAAC,CAAC,GAAG,CAAC,CAAC;QACX,OAAO;IACT,CAAC;IAED,MAAM,KAAK,GAAG,CAAC,CAAC,GAAG,IAAI,CAAC,KAAK,CAAC,IAAI,EAAE,qBAAqB,CAAC,CAAC,CAAC,CAAC,CAAC,GAAG,IAAI,CAAC;IACtE,kBAAkB,CAAC,CAAC,GAAG,KAAK,EAAE,CAAC,GAAG,KAAK,EAAE,CAAC,GAAG,KAAK,EAAE,OAAO,EAAE,OAAO,EAAE,OAAO,EAAE,OAAO,EAAE,GAAG,CAAC,CAAC;AAC/F,CAAC;AAED,gGAAgG;AAChG,6FAA6F;AAC7F,EAAE;AACF,4GAA4G;AAC5G,wGAAwG;AACxG,wGAAwG;AACxG,mBAAmB;AACnB,MAAM,UAAU,6BAA6B,CAC3C,KAA4B,EAC5B,KAA4B,EAC5B,KAA+B,EAC/B,GAAa;IAEb,gBAAgB,CAAC,KAAK,EAAE,gBAAgB,CAAC,CAAC;IAC1C,MAAM,QAAQ,GAAG,gBAAgB,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,GAAG,CAAC;IACjD,MAAM,QAAQ,GAAG,gBAAgB,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,GAAG,CAAC;IACjD,MAAM,QAAQ,GAAG,gBAAgB,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,GAAG,CAAC;IAEjD,gBAAgB,CAAC,KAAK,EAAE,gBAAgB,CAAC,CAAC;IAC1C,GAAG,CAAC,CAAC,CAAC,GAAG,gBAAgB,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,GAAG,GAAG,QAAQ,CAAC;IACpD,GAAG,CAAC,CAAC,CAAC,GAAG,gBAAgB,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,GAAG,GAAG,QAAQ,CAAC;IACpD,GAAG,CAAC,CAAC,CAAC,GAAG,gBAAgB,CAAC,CAAC,CAAC,GAAG,KAAK,CAAC,GAAG,GAAG,QAAQ,CAAC;AACtD,CAAC;AAED,2GAA2G;AAC3G,yGAAyG;AACzG,sEAAsE;AACtE,SAAS,eAAe,CAAC,MAAmC,EAAE,EAAU,EAAE,EAAU,EAAE,EAAU,EAAE,GAAa;IAC7G,oBAAoB,CAAC,MAAM,EAAE,CAAC,EAAE,CAAC,EAAE,EAAE,EAAE,EAAE,QAAQ,CAAC,CAAC;IACnD,oBAAoB,CAAC,MAAM,EAAE,EAAE,EAAE,CAAC,EAAE,CAAC,EAAE,EAAE,QAAQ,CAAC,CAAC;IACnD,oBAAoB,CAAC,MAAM,EAAE,CAAC,EAAE,EAAE,EAAE,EAAE,CAAC,EAAE,QAAQ,CAAC,CAAC;IAEnD,GAAG,CAAC,SAAS,CAAC,IAAI,CAAC,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,CAAC;IACvD,GAAG,CAAC,SAAS,CAAC,IAAI,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,CAAC;IACtD,GAAG,CAAC,SAAS,CAAC,IAAI,CAAC,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,CAAC;IACvD,GAAG,CAAC,SAAS,CAAC,IAAI,CAAC,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,CAAC;IACvD,GAAG,CAAC,SAAS,CAAC,IAAI,CAAC,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,CAAC;IACvD,GAAG,CAAC,SAAS,CAAC,IAAI,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,QAAQ,CAAC,CAAC,CAAC,CAAC;AACxD,CAAC;AAED,SAAS,qBAAqB,CAC5B,IAAiB,EACjB,EAAU,EACV,EAAU,EACV,EAAU,EACV,QAAgB,EAChB,QAAgB,EAChB,QAAgB;IAEhB,IAAI,CAAC,SAAS,IAAI,QAAQ,GAAG,IAAI,CAAC,WAAW,CAAC;IAC9C,IAAI,CAAC,SAAS,IAAI,QAAQ,GAAG,IAAI,CAAC,WAAW,CAAC;IAC9C,IAAI,CAAC,SAAS,IAAI,QAAQ,GAAG,IAAI,CAAC,WAAW,CAAC;IAE9C,MAAM,OAAO,GAAG,EAAE,GAAG,QAAQ,GAAG,EAAE,GAAG,QAAQ,CAAC;IAC9C,MAAM,OAAO,GAAG,EAAE,GAAG,QAAQ,GAAG,EAAE,GAAG,QAAQ,CAAC;IAC9C,MAAM,OAAO,GAAG,EAAE,GAAG,QAAQ,GAAG,EAAE,GAAG,QAAQ,CAAC;IAE9C,uBAAuB,CAAC,IAAI,EAAE,iBAAiB,CAAC,CAAC;IACjD,oBAAoB,CAAC,iBAAiB,EAAE,OAAO,EAAE,OAAO,EAAE,OAAO,EAAE,iBAAiB,CAAC,CAAC;IACtF,IAAI,CAAC,gBAAgB,IAAI,iBAAiB,CAAC,CAAC,CAAC,CAAC;IAC9C,IAAI,CAAC,gBAAgB,IAAI,iBAAiB,CAAC,CAAC,CAAC,CAAC;IAC9C,IAAI,CAAC,gBAAgB,IAAI,iBAAiB,CAAC,CAAC,CAAC,CAAC;AAChD,CAAC;AAED,0GAA0G;AAC1G,6GAA6G;AAC7G,qEAAqE;AACrE,SAAS,mBAAmB,CAC1B,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,GAAa;IAEb,GAAG,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC;IAC/C,GAAG,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC;IAC/C,GAAG,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC;IAC/C,GAAG,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC;AACjD,CAAC;AAED,SAAS,uBAAuB,CAAC,IAA2B,EAAE,GAAa;IACzE,GAAG,CAAC,SAAS,CAAC,GAAG,IAAI,CAAC,qBAAqB,CAAC;IAC5C,GAAG,CAAC,SAAS,CAAC,GAAG,IAAI,CAAC,qBAAqB,CAAC;IAC5C,GAAG,CAAC,SAAS,CAAC,GAAG,IAAI,CAAC,qBAAqB,CAAC;IAC5C,GAAG,CAAC,SAAS,CAAC,GAAG,IAAI,CAAC,qBAAqB,CAAC;IAC5C,GAAG,CAAC,SAAS,CAAC,GAAG,IAAI,CAAC,qBAAqB,CAAC;IAC5C,GAAG,CAAC,SAAS,CAAC,GAAG,IAAI,CAAC,qBAAqB,CAAC;AAC9C,CAAC;AAED,uGAAuG;AACvG,sGAAsG;AACtG,SAAS,kBAAkB,CACzB,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,EAAU,EACV,GAAa;IAEb,MAAM,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC;IACvC,MAAM,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC;IACvC,MAAM,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC;IAEvC,GAAG,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,CAAC,GAAG,CAAC,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC,CAAC;IACtC,GAAG,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,CAAC,GAAG,CAAC,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC,CAAC;IACtC,GAAG,CAAC,CAAC,CAAC,GAAG,EAAE,GAAG,CAAC,GAAG,CAAC,EAAE,GAAG,EAAE,GAAG,EAAE,GAAG,EAAE,CAAC,CAAC;AACxC,CAAC;AAED,SAAS,gBAAgB,CAAC,IAA2B,EAAE,GAAa;IAClE,kBAAkB,CAChB,IAAI,CAAC,OAAO,EACZ,IAAI,CAAC,OAAO,EACZ,IAAI,CAAC,OAAO,EACZ,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,IAAI,CAAC,YAAY,EACjB,GAAG,CACJ,CAAC;IACF,GAAG,CAAC,CAAC,CAAC,IAAI,IAAI,CAAC,CAAC,CAAC;IACjB,GAAG,CAAC,CAAC,CAAC,IAAI,IAAI,CAAC,CAAC,CAAC;IACjB,GAAG,CAAC,CAAC,CAAC,IAAI,IAAI,CAAC,CAAC,CAAC;AACnB,CAAC;AAED,uGAAuG;AACvG,iGAAiG;AACjG,MAAM,kBAAkB,GAAG,KAAK,CAAC;AACjC,2GAA2G;AAC3G,6FAA6F;AAC7F,MAAM,oBAAoB,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAChD,MAAM,oBAAoB,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AACvC,MAAM,YAAY,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAC/B,MAAM,aAAa,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AACnC,MAAM,iBAAiB,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAC7C,MAAM,iBAAiB,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AACpC,MAAM,eAAe,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAC3C,MAAM,qBAAqB,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAC3C,MAAM,gBAAgB,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAC5C,MAAM,gBAAgB,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AACnC,MAAM,aAAa,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AACzC,MAAM,aAAa,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAChC,MAAM,gBAAgB,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AACnC,MAAM,QAAQ,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAC3B,MAAM,QAAQ,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC;AAC3B,MAAM,QAAQ,GAAG,CAAC,CAAC,EAAE,CAAC,EAAE,CAAC,CAAC,CAAC"}

package/dist/jointRegistry.d.ts

@@ -0,0 +1,8 @@
+import type { Physics3DJoint, Physics3DJointKind, Physics3DJointSolver, Physics3DWorld } from '@flighthq/types/contract';
+export declare function addPhysics3DJoint<T extends Physics3DJoint>(world: Physics3DWorld, joint: T): T;
+export declare function getPhysics3DJointSolver(world: Readonly<Physics3DWorld>, kind: Physics3DJointKind): Physics3DJointSolver | null;
+export declare function invalidatePhysics3DJoint(world: Physics3DWorld, joint: Physics3DJoint): boolean;
+export declare function isPhysics3DPairOrdered(a: number, b: number): boolean;
+export declare function registerPhysics3DJointSolver(world: Physics3DWorld, kind: Physics3DJointKind, solver: Physics3DJointSolver): void;
+export declare function removePhysics3DJoint(world: Physics3DWorld, joint: Physics3DJoint): boolean;
+//# sourceMappingURL=jointRegistry.d.ts.map

package/dist/jointRegistry.d.ts.map

@@ -0,0 +1 @@
+{"version":3,"file":"jointRegistry.d.ts","sourceRoot":"","sources":["../src/jointRegistry.ts"],"names":[],"mappings":"AAAA,OAAO,KAAK,EACV,cAAc,EACd,kBAAkB,EAClB,oBAAoB,EACpB,cAAc,EACf,MAAM,0BAA0B,CAAC;AAalC,wBAAgB,iBAAiB,CAAC,CAAC,SAAS,cAAc,EAAE,KAAK,EAAE,cAAc,EAAE,KAAK,EAAE,CAAC,GAAG,CAAC,CAqB9F;AAKD,wBAAgB,uBAAuB,CACrC,KAAK,EAAE,QAAQ,CAAC,cAAc,CAAC,EAC/B,IAAI,EAAE,kBAAkB,GACvB,oBAAoB,GAAG,IAAI,CAE7B;AASD,wBAAgB,wBAAwB,CAAC,KAAK,EAAE,cAAc,EAAE,KAAK,EAAE,cAAc,GAAG,OAAO,CAa9F;AAOD,wBAAgB,sBAAsB,CAAC,CAAC,EAAE,MAAM,EAAE,CAAC,EAAE,MAAM,GAAG,OAAO,CAEpE;AASD,wBAAgB,4BAA4B,CAC1C,KAAK,EAAE,cAAc,EACrB,IAAI,EAAE,kBAAkB,EACxB,MAAM,EAAE,oBAAoB,GAC3B,IAAI,CAcN;AAGD,wBAAgB,oBAAoB,CAAC,KAAK,EAAE,cAAc,EAAE,KAAK,EAAE,cAAc,GAAG,OAAO,CAS1F"}

package/dist/jointRegistry.js

@@ -0,0 +1,144 @@
+import { rebuildPhysics3DJointCollisionSuppressions } from './jointCollisionSuppression';
+import { assertPhysics3DWorldNotStepping, physics3DJointOwners } from './ownership';
+import { findPhysics3DBody, wakePhysics3DBody } from './world';
+// Adds `joint` to `world` under the same canonical body ordering contacts use, exchanging its two ends when
+// the caller supplied them the other way round.
+//
+// A joint is a constraint in the SAME sequential solve list as a contact, so it inherits the same
+// obligation: each impulse lands on the velocities the previous one left, and an ordering that varied with
+// construction history would make the result vary with it. Contacts get their order from the broadphase pair
+// sort; joints have no broadphase, so it is enforced here, at the one place a joint enters a world.
+export function addPhysics3DJoint(world, joint) {
+    assertPhysics3DWorldNotStepping(world);
+    if (physics3DJointOwners.has(joint) || world.joints.includes(joint)) {
+        throw new Error('Cannot add a physics joint that already belongs to a physics world');
+    }
+    // Canonicalize only when the kind can be consulted. A joint whose solver is not registered yet is
+    // explicitly supported — a scene deserialized ahead of the code that solves it — and exchanging its ends
+    // now would move the bodies, anchors, and frames while the kind's own direction-bearing fields stayed as
+    // authored: the generic half of a swap with the kind's half missing, which no later registration repairs.
+    // An unregistered joint constrains nothing, so its order does not matter until a solver exists, and
+    // `registerPhysics3DJointSolver` canonicalizes what is already in the world at that point.
+    const active = getPhysics3DJointSolver(world, joint.kind) !== null;
+    if (active)
+        canonicalizeJointEnds(world, joint);
+    world.joints.push(joint);
+    physics3DJointOwners.set(joint, world);
+    rebuildPhysics3DJointCollisionSuppressions(world);
+    // Adding an active constraint changes what both bodies may do THIS step. A sleeping pair would skip
+    // prepare and solve forever unless something unrelated happened to wake it.
+    if (active)
+        wakeJointBodies(world, joint);
+    return joint;
+}
+// The solver registered for `kind` on this world, or null when none is. A missing solver is an expected
+// condition rather than an error: a scene deserialized with a joint kind the running build does not know
+// about should import and simply not constrain, rather than refuse to load.
+export function getPhysics3DJointSolver(world, kind) {
+    return world.jointSolvers.get(kind) ?? null;
+}
+// Discards solver-owned state after a stored joint's authored parameters change. Returns false when the
+// world does not hold the joint.
+//
+// A cached impulse is an answer to the PREVIOUS constraint equation. Reapplying it after an anchor, frame,
+// limit, or motor changes kicks both bodies before the new equation gets its first iteration — which reads
+// as a joint that lurches when it is edited rather than as a stale cache. The kind clears whatever
+// accumulators only it knows about; the common `impulse0..5` block is cleared here.
+export function invalidatePhysics3DJoint(world, joint) {
+    assertPhysics3DWorldNotStepping(world);
+    if (physics3DJointOwners.get(joint) !== world || !world.joints.includes(joint))
+        return false;
+    getPhysics3DJointSolver(world, joint.kind)?.clearAccumulatedImpulses?.(joint);
+    joint.impulse0 = 0;
+    joint.impulse1 = 0;
+    joint.impulse2 = 0;
+    joint.impulse3 = 0;
+    joint.impulse4 = 0;
+    joint.impulse5 = 0;
+    rebuildPhysics3DJointCollisionSuppressions(world);
+    wakeJointBodies(world, joint);
+    return true;
+}
+// Whether the two bodies are in canonical order — `bodyA` before `bodyB` by persistent index.
+//
+// Ordered by INDEX rather than by anything geometric. Any order derived from coordinates flips the moment
+// those coordinates cross, which would renumber a joint's ends mid-simulation and invalidate every
+// accumulator keyed to them. Identity survives motion; position does not.
+export function isPhysics3DPairOrdered(a, b) {
+    return a <= b;
+}
+// Registers `solver` for `kind` on this world. Last write wins, so a caller may replace a built-in with its
+// own — collisions are avoided by the vendor-prefix convention (bare names reserved for built-ins) rather
+// than by a guard that would make overriding impossible.
+//
+// Registration is per-world and explicit rather than a module-level table populated on import, so a bundle
+// that never registers a joint never links one: six solvers are six blocks of constraint math, and a game
+// using none of them should pay for none of them.
+export function registerPhysics3DJointSolver(world, kind, solver) {
+    assertPhysics3DWorldNotStepping(world);
+    world.jointSolvers.set(kind, solver);
+    // Joints of this kind may already be in the world: `addPhysics3DJoint` deliberately leaves an
+    // unknown-kind joint in its authored order. This is where that deferred work happens, so the outcome no
+    // longer depends on whether the scene or the solver arrived first.
+    for (const joint of world.joints) {
+        if (joint.kind !== kind)
+            continue;
+        canonicalizeJointEnds(world, joint);
+        // Registration turns an inert descriptor into a live constraint, and re-registration may replace its
+        // equation outright. Both are the same topology change from a sleeping neighbour's point of view.
+        wakeJointBodies(world, joint);
+    }
+    rebuildPhysics3DJointCollisionSuppressions(world);
+}
+// Removes `joint` from `world`. Returns false when the world does not hold it.
+export function removePhysics3DJoint(world, joint) {
+    assertPhysics3DWorldNotStepping(world);
+    const at = world.joints.indexOf(joint);
+    if (at < 0)
+        return false;
+    if (getPhysics3DJointSolver(world, joint.kind) !== null)
+        wakeJointBodies(world, joint);
+    world.joints.splice(at, 1);
+    physics3DJointOwners.delete(joint);
+    rebuildPhysics3DJointCollisionSuppressions(world);
+    return true;
+}
+// Exchanges `joint`'s ends when the pair is out of canonical order and the kind consents.
+//
+// The kind is asked only when a swap is actually pending, because `swapEnds` both vetoes AND transforms:
+// calling it otherwise would apply a reversal to ends that never moved. What the generic half can move is
+// only what every joint has — two body indices and two anchors. Anything a kind measures FROM bodyA TO
+// bodyB, including its frames, reverses with them and is the kind's own to carry across.
+function canonicalizeJointEnds(world, joint) {
+    const solver = getPhysics3DJointSolver(world, joint.kind);
+    if (solver?.usesBodyA === false)
+        return;
+    if (isPhysics3DPairOrdered(joint.bodyA, joint.bodyB))
+        return;
+    if (!(solver?.swapEnds?.(joint) ?? true))
+        return;
+    const bodyA = joint.bodyA;
+    joint.bodyA = joint.bodyB;
+    joint.bodyB = bodyA;
+    const anchorX = joint.localAnchorAX;
+    const anchorY = joint.localAnchorAY;
+    const anchorZ = joint.localAnchorAZ;
+    joint.localAnchorAX = joint.localAnchorBX;
+    joint.localAnchorAY = joint.localAnchorBY;
+    joint.localAnchorAZ = joint.localAnchorBZ;
+    joint.localAnchorBX = anchorX;
+    joint.localAnchorBY = anchorY;
+    joint.localAnchorBZ = anchorZ;
+}
+function wakeJointBodies(world, joint) {
+    const solver = getPhysics3DJointSolver(world, joint.kind);
+    if (solver === null)
+        return;
+    const bodyA = solver.usesBodyA === false ? null : findPhysics3DBody(world, joint.bodyA);
+    const bodyB = findPhysics3DBody(world, joint.bodyB);
+    if (bodyA !== null)
+        wakePhysics3DBody(bodyA);
+    if (bodyB !== null)
+        wakePhysics3DBody(bodyB);
+}
+//# sourceMappingURL=jointRegistry.js.map

package/dist/jointRegistry.js.map

@@ -0,0 +1 @@
+{"version":3,"file":"jointRegistry.js","sourceRoot":"","sources":["../src/jointRegistry.ts"],"names":[],"mappings":"AAOA,OAAO,EAAE,0CAA0C,EAAE,MAAM,6BAA6B,CAAC;AACzF,OAAO,EAAE,+BAA+B,EAAE,oBAAoB,EAAE,MAAM,aAAa,CAAC;AACpF,OAAO,EAAE,iBAAiB,EAAE,iBAAiB,EAAE,MAAM,SAAS,CAAC;AAE/D,4GAA4G;AAC5G,gDAAgD;AAChD,EAAE;AACF,kGAAkG;AAClG,2GAA2G;AAC3G,6GAA6G;AAC7G,oGAAoG;AACpG,MAAM,UAAU,iBAAiB,CAA2B,KAAqB,EAAE,KAAQ;IACzF,+BAA+B,CAAC,KAAK,CAAC,CAAC;IACvC,IAAI,oBAAoB,CAAC,GAAG,CAAC,KAAK,CAAC,IAAI,KAAK,CAAC,MAAM,CAAC,QAAQ,CAAC,KAAK,CAAC,EAAE,CAAC;QACpE,MAAM,IAAI,KAAK,CAAC,oEAAoE,CAAC,CAAC;IACxF,CAAC;IAED,kGAAkG;IAClG,yGAAyG;IACzG,yGAAyG;IACzG,0GAA0G;IAC1G,oGAAoG;IACpG,2FAA2F;IAC3F,MAAM,MAAM,GAAG,uBAAuB,CAAC,KAAK,EAAE,KAAK,CAAC,IAAI,CAAC,KAAK,IAAI,CAAC;IACnE,IAAI,MAAM;QAAE,qBAAqB,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;IAChD,KAAK,CAAC,MAAM,CAAC,IAAI,CAAC,KAAK,CAAC,CAAC;IACzB,oBAAoB,CAAC,GAAG,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;IACvC,0CAA0C,CAAC,KAAK,CAAC,CAAC;IAClD,oGAAoG;IACpG,4EAA4E;IAC5E,IAAI,MAAM;QAAE,eAAe,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;IAC1C,OAAO,KAAK,CAAC;AACf,CAAC;AAED,wGAAwG;AACxG,yGAAyG;AACzG,4EAA4E;AAC5E,MAAM,UAAU,uBAAuB,CACrC,KAA+B,EAC/B,IAAwB;IAExB,OAAO,KAAK,CAAC,YAAY,CAAC,GAAG,CAAC,IAAI,CAAC,IAAI,IAAI,CAAC;AAC9C,CAAC;AAED,wGAAwG;AACxG,iCAAiC;AACjC,EAAE;AACF,2GAA2G;AAC3G,2GAA2G;AAC3G,mGAAmG;AACnG,oFAAoF;AACpF,MAAM,UAAU,wBAAwB,CAAC,KAAqB,EAAE,KAAqB;IACnF,+BAA+B,CAAC,KAAK,CAAC,CAAC;IACvC,IAAI,oBAAoB,CAAC,GAAG,CAAC,KAAK,CAAC,KAAK,KAAK,IAAI,CAAC,KAAK,CAAC,MAAM,CAAC,QAAQ,CAAC,KAAK,CAAC;QAAE,OAAO,KAAK,CAAC;IAC7F,uBAAuB,CAAC,KAAK,EAAE,KAAK,CAAC,IAAI,CAAC,EAAE,wBAAwB,EAAE,CAAC,KAAK,CAAC,CAAC;IAC9E,KAAK,CAAC,QAAQ,GAAG,CAAC,CAAC;IACnB,KAAK,CAAC,QAAQ,GAAG,CAAC,CAAC;IACnB,KAAK,CAAC,QAAQ,GAAG,CAAC,CAAC;IACnB,KAAK,CAAC,QAAQ,GAAG,CAAC,CAAC;IACnB,KAAK,CAAC,QAAQ,GAAG,CAAC,CAAC;IACnB,KAAK,CAAC,QAAQ,GAAG,CAAC,CAAC;IACnB,0CAA0C,CAAC,KAAK,CAAC,CAAC;IAClD,eAAe,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;IAC9B,OAAO,IAAI,CAAC;AACd,CAAC;AAED,8FAA8F;AAC9F,EAAE;AACF,0GAA0G;AAC1G,mGAAmG;AACnG,0EAA0E;AAC1E,MAAM,UAAU,sBAAsB,CAAC,CAAS,EAAE,CAAS;IACzD,OAAO,CAAC,IAAI,CAAC,CAAC;AAChB,CAAC;AAED,4GAA4G;AAC5G,0GAA0G;AAC1G,yDAAyD;AACzD,EAAE;AACF,2GAA2G;AAC3G,0GAA0G;AAC1G,kDAAkD;AAClD,MAAM,UAAU,4BAA4B,CAC1C,KAAqB,EACrB,IAAwB,EACxB,MAA4B;IAE5B,+BAA+B,CAAC,KAAK,CAAC,CAAC;IACvC,KAAK,CAAC,YAAY,CAAC,GAAG,CAAC,IAAI,EAAE,MAAM,CAAC,CAAC;IACrC,8FAA8F;IAC9F,wGAAwG;IACxG,mEAAmE;IACnE,KAAK,MAAM,KAAK,IAAI,KAAK,CAAC,MAAM,EAAE,CAAC;QACjC,IAAI,KAAK,CAAC,IAAI,KAAK,IAAI;YAAE,SAAS;QAClC,qBAAqB,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;QACpC,qGAAqG;QACrG,kGAAkG;QAClG,eAAe,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;IAChC,CAAC;IACD,0CAA0C,CAAC,KAAK,CAAC,CAAC;AACpD,CAAC;AAED,+EAA+E;AAC/E,MAAM,UAAU,oBAAoB,CAAC,KAAqB,EAAE,KAAqB;IAC/E,+BAA+B,CAAC,KAAK,CAAC,CAAC;IACvC,MAAM,EAAE,GAAG,KAAK,CAAC,MAAM,CAAC,OAAO,CAAC,KAAK,CAAC,CAAC;IACvC,IAAI,EAAE,GAAG,CAAC;QAAE,OAAO,KAAK,CAAC;IACzB,IAAI,uBAAuB,CAAC,KAAK,EAAE,KAAK,CAAC,IAAI,CAAC,KAAK,IAAI;QAAE,eAAe,CAAC,KAAK,EAAE,KAAK,CAAC,CAAC;IACvF,KAAK,CAAC,MAAM,CAAC,MAAM,CAAC,EAAE,EAAE,CAAC,CAAC,CAAC;IAC3B,oBAAoB,CAAC,MAAM,CAAC,KAAK,CAAC,CAAC;IACnC,0CAA0C,CAAC,KAAK,CAAC,CAAC;IAClD,OAAO,IAAI,CAAC;AACd,CAAC;AAED,0FAA0F;AAC1F,EAAE;AACF,yGAAyG;AACzG,0GAA0G;AAC1G,uGAAuG;AACvG,yFAAyF;AACzF,SAAS,qBAAqB,CAAC,KAA+B,EAAE,KAAqB;IACnF,MAAM,MAAM,GAAG,uBAAuB,CAAC,KAAK,EAAE,KAAK,CAAC,IAAI,CAAC,CAAC;IAC1D,IAAI,MAAM,EAAE,SAAS,KAAK,KAAK;QAAE,OAAO;IACxC,IAAI,sBAAsB,CAAC,KAAK,CAAC,KAAK,EAAE,KAAK,CAAC,KAAK,CAAC;QAAE,OAAO;IAC7D,IAAI,CAAC,CAAC,MAAM,EAAE,QAAQ,EAAE,CAAC,KAAK,CAAC,IAAI,IAAI,CAAC;QAAE,OAAO;IAEjD,MAAM,KAAK,GAAG,KAAK,CAAC,KAAK,CAAC;IAC1B,KAAK,CAAC,KAAK,GAAG,KAAK,CAAC,KAAK,CAAC;IAC1B,KAAK,CAAC,KAAK,GAAG,KAAK,CAAC;IAEpB,MAAM,OAAO,GAAG,KAAK,CAAC,aAAa,CAAC;IACpC,MAAM,OAAO,GAAG,KAAK,CAAC,aAAa,CAAC;IACpC,MAAM,OAAO,GAAG,KAAK,CAAC,aAAa,CAAC;IACpC,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,aAAa,CAAC;IAC1C,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,aAAa,CAAC;IAC1C,KAAK,CAAC,aAAa,GAAG,KAAK,CAAC,aAAa,CAAC;IAC1C,KAAK,CAAC,aAAa,GAAG,OAAO,CAAC;IAC9B,KAAK,CAAC,aAAa,GAAG,OAAO,CAAC;IAC9B,KAAK,CAAC,aAAa,GAAG,OAAO,CAAC;AAChC,CAAC;AAED,SAAS,eAAe,CAAC,KAA+B,EAAE,KAA+B;IACvF,MAAM,MAAM,GAAG,uBAAuB,CAAC,KAAK,EAAE,KAAK,CAAC,IAAI,CAAC,CAAC;IAC1D,IAAI,MAAM,KAAK,IAAI;QAAE,OAAO;IAC5B,MAAM,KAAK,GAAG,MAAM,CAAC,SAAS,KAAK,KAAK,CAAC,CAAC,CAAC,IAAI,CAAC,CAAC,CAAC,iBAAiB,CAAC,KAAK,EAAE,KAAK,CAAC,KAAK,CAAC,CAAC;IACxF,MAAM,KAAK,GAAG,iBAAiB,CAAC,KAAK,EAAE,KAAK,CAAC,KAAK,CAAC,CAAC;IACpD,IAAI,KAAK,KAAK,IAAI;QAAE,iBAAiB,CAAC,KAAK,CAAC,CAAC;IAC7C,IAAI,KAAK,KAAK,IAAI;QAAE,iBAAiB,CAAC,KAAK,CAAC,CAAC;AAC/C,CAAC"}

package/dist/jointRows.d.ts

@@ -0,0 +1,32 @@
+import type { Physics3DJoint, Physics3DJointFrames, RigidBody3D } from '@flighthq/types/contract';
+export declare const ROW_LENGTH = 9;
+export declare const POINT_MASS = 0;
+export declare const POINT_BIAS = 6;
+export declare const POINT_LENGTH = 9;
+export declare function applyRow(bodyA: RigidBody3D, bodyB: RigidBody3D, state: readonly number[], offset: number, impulse: number): void;
+export declare function beginJointSolve(joint: Physics3DJoint, length: number): number[];
+export declare function clearJointSolve(joint: Physics3DJoint): void;
+export declare function getJointSolveState(joint: Readonly<Physics3DJoint>): number[] | undefined;
+export declare function getRowMass(bodyA: Readonly<RigidBody3D>, bodyB: Readonly<RigidBody3D>, state: readonly number[], offset: number): number;
+export declare function getRowVelocity(bodyA: Readonly<RigidBody3D>, bodyB: Readonly<RigidBody3D>, state: readonly number[], offset: number): number;
+export declare function prepareAngularBlock(bodyA: Readonly<RigidBody3D>, bodyB: Readonly<RigidBody3D>, state: number[], massOffset: number, biasOffset: number, dt: number): void;
+export declare function preparePointBlock(bodyA: Readonly<RigidBody3D>, bodyB: Readonly<RigidBody3D>, joint: Physics3DJoint, state: number[], dt: number): void;
+export declare function readFrameBases(bodyA: Readonly<RigidBody3D>, bodyB: Readonly<RigidBody3D>, frames: Physics3DJointFrames): void;
+export declare function readFrameRotations(bodyA: Readonly<RigidBody3D>, bodyB: Readonly<RigidBody3D>, frames: Physics3DJointFrames): void;
+export declare function readJointImpulse(joint: Readonly<Physics3DJoint>, slot: number): number;
+export declare function solveAngularBlock(bodyA: RigidBody3D, bodyB: RigidBody3D, joint: Physics3DJoint, state: readonly number[], massOffset: number, biasOffset: number): void;
+export declare function solveEqualityRow(bodyA: RigidBody3D, bodyB: RigidBody3D, joint: Physics3DJoint, slot: number, state: readonly number[], offset: number, mass: number, error: number, biasFactor: number): void;
+export declare function solveLowerLimitRow(bodyA: RigidBody3D, bodyB: RigidBody3D, state: number[], offset: number, mass: number, error: number, biasFactor: number, accumulatorSlot: number): void;
+export declare function solveMotorRow(bodyA: RigidBody3D, bodyB: RigidBody3D, state: readonly number[], offset: number, mass: number, speed: number, maxImpulse: number, previous: number): number;
+export declare function solvePointBlock(bodyA: RigidBody3D, bodyB: RigidBody3D, joint: Physics3DJoint, state: readonly number[]): void;
+export declare function solveUpperLimitRow(bodyA: RigidBody3D, bodyB: RigidBody3D, state: number[], offset: number, mass: number, error: number, biasFactor: number, accumulatorSlot: number): void;
+export declare function warmStartAngularBlock(bodyA: RigidBody3D, bodyB: RigidBody3D, joint: Readonly<Physics3DJoint>): void;
+export declare function warmStartPointBlock(bodyA: RigidBody3D, bodyB: RigidBody3D, joint: Readonly<Physics3DJoint>): void;
+export declare function writeAngularRow(state: number[], offset: number, axisX: number, axisY: number, axisZ: number): void;
+export declare function writeJointImpulse(joint: Physics3DJoint, slot: number, value: number): void;
+export declare function writeRow(state: number[], offset: number, directionX: number, directionY: number, directionZ: number, armAX: number, armAY: number, armAZ: number, armBX: number, armBY: number, armBZ: number): void;
+export declare const frameABasis: number[];
+export declare const frameBBasis: number[];
+export declare const frameARotation: number[];
+export declare const frameBRotation: number[];
+//# sourceMappingURL=jointRows.d.ts.map

package/dist/jointRows.d.ts.map

@@ -0,0 +1 @@
+{"version":3,"file":"jointRows.d.ts","sourceRoot":"","sources":["../src/jointRows.ts"],"names":[],"mappings":"AAAA,OAAO,KAAK,EAAE,cAAc,EAAE,oBAAoB,EAAE,WAAW,EAAE,MAAM,0BAA0B,CAAC;AAiClG,eAAO,MAAM,UAAU,IAAI,CAAC;AAI5B,eAAO,MAAM,UAAU,IAAI,CAAC;AAC5B,eAAO,MAAM,UAAU,IAAI,CAAC;AAC5B,eAAO,MAAM,YAAY,IAAI,CAAC;AAG9B,wBAAgB,QAAQ,CACtB,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,SAAS,MAAM,EAAE,EACxB,MAAM,EAAE,MAAM,EACd,OAAO,EAAE,MAAM,GACd,IAAI,CAgBN;AAaD,wBAAgB,eAAe,CAAC,KAAK,EAAE,cAAc,EAAE,MAAM,EAAE,MAAM,GAAG,MAAM,EAAE,CAc/E;AAMD,wBAAgB,eAAe,CAAC,KAAK,EAAE,cAAc,GAAG,IAAI,CAE3D;AAID,wBAAgB,kBAAkB,CAAC,KAAK,EAAE,QAAQ,CAAC,cAAc,CAAC,GAAG,MAAM,EAAE,GAAG,SAAS,CAExF;AAGD,wBAAgB,UAAU,CACxB,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,SAAS,MAAM,EAAE,EACxB,MAAM,EAAE,MAAM,GACb,MAAM,CAcR;AAGD,wBAAgB,cAAc,CAC5B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,SAAS,MAAM,EAAE,EACxB,MAAM,EAAE,MAAM,GACb,MAAM,CAcR;AAID,wBAAgB,mBAAmB,CACjC,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,MAAM,EAAE,EACf,UAAU,EAAE,MAAM,EAClB,UAAU,EAAE,MAAM,EAClB,EAAE,EAAE,MAAM,GACT,IAAI,CAoBN;AAID,wBAAgB,iBAAiB,CAC/B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,cAAc,EACrB,KAAK,EAAE,MAAM,EAAE,EACf,EAAE,EAAE,MAAM,GACT,IAAI,CAqBN;AAID,wBAAgB,cAAc,CAC5B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,MAAM,EAAE,oBAAoB,GAC3B,IAAI,CAkBN;AAGD,wBAAgB,kBAAkB,CAChC,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,KAAK,EAAE,QAAQ,CAAC,WAAW,CAAC,EAC5B,MAAM,EAAE,oBAAoB,GAC3B,IAAI,CAkBN;AAGD,wBAAgB,gBAAgB,CAAC,KAAK,EAAE,QAAQ,CAAC,cAAc,CAAC,EAAE,IAAI,EAAE,MAAM,GAAG,MAAM,CAetF;AAGD,wBAAgB,iBAAiB,CAC/B,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,cAAc,EACrB,KAAK,EAAE,SAAS,MAAM,EAAE,EACxB,UAAU,EAAE,MAAM,EAClB,UAAU,EAAE,MAAM,GACjB,IAAI,CAiBN;AAGD,wBAAgB,gBAAgB,CAC9B,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,cAAc,EACrB,IAAI,EAAE,MAAM,EACZ,KAAK,EAAE,SAAS,MAAM,EAAE,EACxB,MAAM,EAAE,MAAM,EACd,IAAI,EAAE,MAAM,EACZ,KAAK,EAAE,MAAM,EACb,UAAU,EAAE,MAAM,GACjB,IAAI,CAKN;AAaD,wBAAgB,kBAAkB,CAChC,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,MAAM,EAAE,EACf,MAAM,EAAE,MAAM,EACd,IAAI,EAAE,MAAM,EACZ,KAAK,EAAE,MAAM,EACb,UAAU,EAAE,MAAM,EAClB,eAAe,EAAE,MAAM,GACtB,IAAI,CAMN;AAQD,wBAAgB,aAAa,CAC3B,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,SAAS,MAAM,EAAE,EACxB,MAAM,EAAE,MAAM,EACd,IAAI,EAAE,MAAM,EACZ,KAAK,EAAE,MAAM,EACb,UAAU,EAAE,MAAM,EAClB,QAAQ,EAAE,MAAM,GACf,MAAM,CAKR;AAOD,wBAAgB,eAAe,CAC7B,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,cAAc,EACrB,KAAK,EAAE,SAAS,MAAM,EAAE,GACvB,IAAI,CA8BN;AAOD,wBAAgB,kBAAkB,CAChC,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,WAAW,EAClB,KAAK,EAAE,MAAM,EAAE,EACf,MAAM,EAAE,MAAM,EACd,IAAI,EAAE,MAAM,EACZ,KAAK,EAAE,MAAM,EACb,UAAU,EAAE,MAAM,EAClB,eAAe,EAAE,MAAM,GACtB,IAAI,CAMN;AAGD,wBAAgB,qBAAqB,CAAC,KAAK,EAAE,WAAW,EAAE,KAAK,EAAE,WAAW,EAAE,KAAK,EAAE,QAAQ,CAAC,cAAc,CAAC,GAAG,IAAI,CAEnH;AAGD,wBAAgB,mBAAmB,CAAC,KAAK,EAAE,WAAW,EAAE,KAAK,EAAE,WAAW,EAAE,KAAK,EAAE,QAAQ,CAAC,cAAc,CAAC,GAAG,IAAI,CAcjH;AAID,wBAAgB,eAAe,CAAC,KAAK,EAAE,MAAM,EAAE,EAAE,MAAM,EAAE,MAAM,EAAE,KAAK,EAAE,MAAM,EAAE,KAAK,EAAE,MAAM,EAAE,KAAK,EAAE,MAAM,GAAG,IAAI,CAElH;AAGD,wBAAgB,iBAAiB,CAAC,KAAK,EAAE,cAAc,EAAE,IAAI,EAAE,MAAM,EAAE,KAAK,EAAE,MAAM,GAAG,IAAI,CAqB1F;AAGD,wBAAgB,QAAQ,CACtB,KAAK,EAAE,MAAM,EAAE,EACf,MAAM,EAAE,MAAM,EACd,UAAU,EAAE,MAAM,EAClB,UAAU,EAAE,MAAM,EAClB,UAAU,EAAE,MAAM,EAClB,KAAK,EAAE,MAAM,EACb,KAAK,EAAE,MAAM,EACb,KAAK,EAAE,MAAM,EACb,KAAK,EAAE,MAAM,EACb,KAAK,EAAE,MAAM,EACb,KAAK,EAAE,MAAM,GACZ,IAAI,CAUN;AAwCD,eAAO,MAAM,WAAW,UAA+B,CAAC;AACxD,eAAO,MAAM,WAAW,UAA+B,CAAC;AACxD,eAAO,MAAM,cAAc,UAAe,CAAC;AAC3C,eAAO,MAAM,cAAc,UAAe,CAAC"}