@zephyr3d/scene 0.9.5 → 0.9.7

package/dist/animation/spring2/solver.js

@@ -1,624 +0,0 @@
-import { Vector3, Quaternion, degree2radian, Matrix4x4, radian2degree } from '@zephyr3d/base';
-import { clamp01, smoothStep } from './math.js';
-import { EPSILON, ConstraintType } from './types.js';
-import { checkSurfaceCollision, pushInFromCapsule, pushoutFromCapsule, pushInFromSphere, pushoutFromSphere, collisionDetection } from './collision.js';
-
-// Core physics simulation 閳?direct port of JobExecuteSimulation from SPCRJointDynamicsJob.cs
-const AXIS_Y = new Vector3(0, 1, 0);
-const VEC3_ONE = new Vector3(1, 1, 1);
-const _computeCapsuleAxis = new Vector3();
-const _computeCapsuleHalfDir = new Vector3();
-const _applySystemTransformOffset = new Vector3();
-const _applySystemTransformRotated = new Vector3();
-const _broadPhaseSegmentDir = new Vector3();
-const _broadPhaseToCenter = new Vector3();
-const _broadPhaseClosestPoint = new Vector3();
-const _broadPhaseDelta = new Vector3();
-/**
- * Run the full simulation step. Mutates pointsRW and collidersRW in place.
- * Returns { positionsToTransform, fakeWaveCounter }.
- */ function simulate(params, pointsR, pointsRW, constraints, collidersR, collidersRW, grabbersR, grabbersRW, movableLimitTargets, flatPlanes) {
-    const pointCount = pointsR.length;
-    const positionsToTransform = new Array(pointCount);
-    let subSteps = params.subSteps;
-    if (params.isPaused) {
-        subSteps = 1;
-    }
-    let fakeWaveFreq = params.fakeWaveCounter;
-    // Root slide offset
-    let rootSlideOffset = Vector3.zero();
-    const rootDeltaSlide = Vector3.sub(params.rootPosition, params.previousRootPosition);
-    const rootDeltaSlideLen = rootDeltaSlide.magnitude;
-    if (params.rootSlideLimit >= 0 && rootDeltaSlideLen > params.rootSlideLimit) {
-        rootSlideOffset = Vector3.scale(rootDeltaSlide, (1.0 - params.rootSlideLimit / rootDeltaSlideLen) / subSteps);
-    }
-    // Root rotation offset
-    let rootRotationOffset = Quaternion.identity();
-    const rootDeltaRot = Quaternion.multiply(params.rootRotation, Quaternion.inverse(params.previousRootRotation));
-    let rotateAngle = Math.acos(Math.max(-1, Math.min(1, rootDeltaRot.w))) * 2.0 * (180 / Math.PI);
-    if (rotateAngle > 180) {
-        rotateAngle -= 360;
-    }
-    if (params.rootRotateLimit >= 0 && Math.abs(rotateAngle) > params.rootRotateLimit) {
-        let rotateAxis = new Vector3();
-        if (!isFinite(rotateAxis.x) || !isFinite(rotateAxis.y) || !isFinite(rotateAxis.z)) {
-            rotateAxis = Vector3.axisPY();
-        }
-        let angle = rotateAngle > 0 ? rotateAngle - params.rootRotateLimit : rotateAngle + params.rootRotateLimit;
-        angle /= subSteps;
-        rootRotationOffset = Quaternion.fromAxisAngle(rotateAxis, degree2radian(angle));
-    }
-    if (params.isPaused) {
-        rootSlideOffset = rootDeltaSlide;
-        rootRotationOffset = rootDeltaRot;
-    }
-    const stepTime = params.stepTime / subSteps;
-    for(let iSubStep = 1; iSubStep <= subSteps; iSubStep++){
-        const stepDelta = iSubStep / subSteps;
-        const stepTime_x2_half = stepTime * stepTime * 0.5;
-        colliderUpdate(collidersR, collidersRW, stepDelta, params.collisionScale);
-        pointUpdatePass1(pointsR, pointsRW, stepDelta, stepTime_x2_half, rootSlideOffset, rootRotationOffset, params.rootPosition, params.windForce, params.isPaused, grabbersR, grabbersRW, movableLimitTargets, flatPlanes);
-        if (!params.isPaused) {
-            fakeWaveFreq += params.fakeWaveSpeed * stepTime;
-            if (params.enableSurfaceCollision) {
-                surfaceCollision(pointsRW, collidersR, collidersRW, params.surfaceConstraints);
-            }
-            for(let iRelax = params.relaxation - 1; iRelax >= 0; --iRelax){
-                constraintUpdate(pointsR, pointsRW, constraints, collidersR, collidersRW, params.constraintShrinkLimit, params.enableBroadPhase);
-            }
-        }
-        pointUpdatePass2(pointsR, pointsRW, positionsToTransform, stepDelta, fakeWaveFreq, params.blendRatio, params.isFakeWave, params.fakeWavePower);
-    }
-    return {
-        positionsToTransform,
-        fakeWaveCounter: fakeWaveFreq
-    };
-}
-// 閳光偓閳光偓 Collider interpolation 閳光偓閳光偓
-function computeCapsule(pos, rot, height, head, direction) {
-    rot.transform(Vector3.scale(AXIS_Y, height, _computeCapsuleAxis), direction);
-    Vector3.scale(direction, 0.5, _computeCapsuleHalfDir);
-    Vector3.sub(pos, _computeCapsuleHalfDir, head);
-}
-function colliderUpdate(collidersR, collidersRW, stepDelta, collisionScale) {
-    const curPos = new Vector3();
-    const curDir = new Quaternion();
-    const corner = new Vector3();
-    const center = new Vector3();
-    const tailCorner = new Vector3();
-    const tailCenter = new Vector3();
-    for(let i = 0; i < collidersR.length; i++){
-        const colR = collidersR[i];
-        const colRW = collidersRW[i];
-        colRW.radius = colR.radius * collisionScale;
-        Vector3.lerp(colRW.positionPreviousTransform, colRW.positionCurrentTransform, stepDelta, curPos);
-        Quaternion.slerp(colRW.directionPreviousTransform, colRW.directionCurrentTransform, stepDelta, curDir);
-        computeCapsule(curPos, curDir, colR.height, colRW.positionCurrent, colRW.directionCurrent);
-        if (colR.height > EPSILON) {
-            Vector3.scale(colRW.directionCurrent, 0.5, _computeCapsuleHalfDir);
-            Vector3.add(colRW.positionCurrent, _computeCapsuleHalfDir, colRW.boundsCenter);
-            colRW.boundsRadius = Math.sqrt(colRW.directionCurrent.magnitudeSq) * 0.5 + Math.max(colRW.radius, colRW.radius * colR.radiusTailScale);
-        } else {
-            colRW.boundsCenter.set(colRW.positionCurrent);
-            colRW.boundsRadius = colRW.radius;
-        }
-        // Update local bounds
-        Vector3.scale(VEC3_ONE, colR.radius, corner);
-        colRW.worldToLocal.transformPointAffine(colRW.positionCurrent, center);
-        Vector3.sub(center, corner, colRW.localBoundsMin);
-        Vector3.add(center, corner, colRW.localBoundsMax);
-        if (colR.height > EPSILON) {
-            Vector3.scale(VEC3_ONE, colR.radius * colR.radiusTailScale, tailCorner);
-            Vector3.add(colRW.positionCurrent, colRW.directionCurrent, tailCenter);
-            colRW.worldToLocal.transformPointAffine(tailCenter, tailCenter);
-            colRW.localBoundsMin.setXYZ(Math.min(colRW.localBoundsMin.x, tailCenter.x - tailCorner.x), Math.min(colRW.localBoundsMin.y, tailCenter.y - tailCorner.y), Math.min(colRW.localBoundsMin.z, tailCenter.z - tailCorner.z));
-            colRW.localBoundsMax.setXYZ(Math.max(colRW.localBoundsMax.x, tailCenter.x + tailCorner.x), Math.max(colRW.localBoundsMax.y, tailCenter.y + tailCorner.y), Math.max(colRW.localBoundsMax.z, tailCenter.z + tailCorner.z));
-        }
-    }
-}
-// 閳光偓閳光偓 Apply root motion transform 閳光偓閳光偓
-function applySystemTransform(point, pivot, slideOffset, rotOffset, result) {
-    const rotated = rotOffset.transform(Vector3.sub(point, pivot, _applySystemTransformOffset), result || _applySystemTransformRotated);
-    Vector3.add(rotated, pivot, rotated);
-    return Vector3.add(rotated, slideOffset, rotated);
-}
-function pointMayCollideBroadPhase(point, colRW, padding = 0) {
-    const radius = colRW.boundsRadius + padding;
-    const delta = Vector3.sub(point, colRW.boundsCenter, _broadPhaseDelta);
-    return delta.magnitudeSq <= radius * radius;
-}
-function segmentMayCollideBroadPhase(point1, point2, colRW) {
-    const segmentDir = Vector3.sub(point2, point1, _broadPhaseSegmentDir);
-    const lenSq = segmentDir.magnitudeSq;
-    if (lenSq <= EPSILON) {
-        return pointMayCollideBroadPhase(point1, colRW);
-    }
-    const toCenter = Vector3.sub(colRW.boundsCenter, point1, _broadPhaseToCenter);
-    const t = clamp01(Vector3.dot(toCenter, segmentDir) / lenSq);
-    const closestPoint = Vector3.scale(segmentDir, t, _broadPhaseClosestPoint);
-    Vector3.add(point1, closestPoint, closestPoint);
-    const delta = Vector3.sub(colRW.boundsCenter, closestPoint, _broadPhaseDelta);
-    return delta.magnitudeSq <= colRW.boundsRadius * colRW.boundsRadius;
-}
-// 閳光偓閳光偓 Pass 1: Verlet integration + forces 閳光偓閳光偓
-function pointUpdatePass1(pointsR, pointsRW, stepDelta, stepTime_x2_half, rootSlideOffset, rootRotationOffset, rootPosition, windForce, isPaused, grabbersR, grabbersRW, movableLimitTargets, flatPlanes) {
-    const currentTransformPos = new Vector3();
-    const moveDir = new Vector3();
-    const extForce = new Vector3();
-    const displacement = new Vector3();
-    const restore = new Vector3();
-    const tempVec0 = new Vector3();
-    const tempVec1 = new Vector3();
-    const planeOffset = new Vector3();
-    for(let index = 0; index < pointsR.length; index++){
-        const ptR = pointsR[index];
-        const ptRW = pointsRW[index];
-        Vector3.lerp(ptRW.positionPreviousTransform, ptRW.positionCurrentTransform, stepDelta, currentTransformPos);
-        if (ptR.weight <= EPSILON) {
-            ptRW.positionPrevious.set(ptRW.positionCurrent);
-            ptRW.positionCurrent.set(currentTransformPos);
-        } else {
-            applySystemTransform(ptRW.positionPrevious, rootPosition, rootSlideOffset, rootRotationOffset, ptRW.positionPrevious);
-            applySystemTransform(ptRW.positionCurrent, rootPosition, rootSlideOffset, rootRotationOffset, ptRW.positionCurrent);
-            displacement.setXYZ(0, 0, 0);
-            if (!isPaused) {
-                Vector3.sub(ptRW.positionCurrent, ptRW.positionPrevious, moveDir);
-                Vector3.scale(windForce, ptR.windForceScale / ptR.mass, extForce);
-                Vector3.add(ptR.gravity, extForce, extForce);
-                Vector3.scale(extForce, stepTime_x2_half, extForce);
-                Vector3.add(moveDir, extForce, displacement);
-                Vector3.scale(displacement, ptR.resistance, displacement);
-                Vector3.scale(displacement, 1.0 - clamp01(ptRW.friction * ptR.frictionScale), displacement);
-            }
-            ptRW.positionPrevious.set(ptRW.positionCurrent);
-            Vector3.add(ptRW.positionCurrent, displacement, ptRW.positionCurrent);
-            ptRW.friction = 0;
-            if (!isPaused) {
-                // Hardness restore
-                if (ptR.hardness > 0) {
-                    Vector3.sub(currentTransformPos, ptRW.positionCurrent, restore);
-                    Vector3.scale(restore, ptR.hardness, restore);
-                    Vector3.add(ptRW.positionCurrent, restore, ptRW.positionCurrent);
-                }
-                // Force fade ratio
-                if (ptR.forceFadeRatio > 0) {
-                    Vector3.lerp(ptRW.positionCurrent, currentTransformPos, ptR.forceFadeRatio, ptRW.positionCurrent);
-                }
-                // Grabber
-                if (ptRW.grabberIndex !== -1) {
-                    const grR = grabbersR[ptRW.grabberIndex];
-                    const grRW = grabbersRW[ptRW.grabberIndex];
-                    if (grRW.enabled === 0) {
-                        ptRW.grabberIndex = -1;
-                    } else {
-                        Vector3.sub(ptRW.positionCurrent, grRW.position, tempVec0);
-                        Vector3.normalize(tempVec0, tempVec0);
-                        Vector3.scale(tempVec0, ptRW.grabberDistance, tempVec1);
-                        Vector3.add(grRW.position, tempVec1, tempVec1);
-                        Vector3.sub(tempVec1, ptRW.positionCurrent, tempVec0);
-                        Vector3.scale(tempVec0, grR.force, tempVec0);
-                        Vector3.add(ptRW.positionCurrent, tempVec0, ptRW.positionCurrent);
-                    }
-                } else {
-                    let nearIndex = -1;
-                    let sqrNearRange = 1000 * 1000;
-                    for(let ig = 0; ig < grabbersR.length; ig++){
-                        const grRW = grabbersRW[ig];
-                        if (grRW.enabled !== 0) {
-                            const sqrLen = Vector3.sub(grRW.position, ptRW.positionCurrent, tempVec0).magnitudeSq;
-                            if (sqrLen < grabbersR[ig].radius * grabbersR[ig].radius && sqrLen < sqrNearRange) {
-                                sqrNearRange = sqrLen;
-                                nearIndex = ig;
-                            }
-                        }
-                    }
-                    if (nearIndex !== -1) {
-                        ptRW.grabberIndex = nearIndex;
-                        ptRW.grabberDistance = Math.sqrt(sqrNearRange) / 2.0;
-                    }
-                }
-                // Movable limit
-                if (ptR.movableLimitIndex !== -1) {
-                    const target = movableLimitTargets[ptR.movableLimitIndex];
-                    const move = Vector3.sub(ptRW.positionCurrent, target, tempVec0);
-                    const moveLen = move.magnitude;
-                    if (moveLen > ptR.movableLimitRadius) {
-                        Vector3.scale(move, ptR.movableLimitRadius / moveLen, move);
-                        Vector3.add(target, move, ptRW.positionCurrent);
-                    }
-                }
-            }
-            // Flat plane collision
-            for(let i = 0; i < flatPlanes.length; i++){
-                const fp = flatPlanes[i];
-                const dist = Vector3.dot(fp.normal, ptRW.positionCurrent) + fp.distance;
-                if (dist < 0) {
-                    Vector3.scale(fp.normal, dist, planeOffset);
-                    Vector3.sub(ptRW.positionCurrent, planeOffset, ptRW.positionCurrent);
-                    ptRW.friction = 0.3;
-                }
-            }
-        }
-    }
-}
-// 閳光偓閳光偓 Surface collision (triangle-based cloth collision) 閳光偓閳光偓
-function surfaceCollision(pointsRW, collidersR, collidersRW, surfaceConstraints) {
-    const surfaceResult = {
-        hit: false,
-        intersectionPoint: new Vector3(),
-        pushOut: new Vector3(),
-        pointOnCollider: new Vector3(),
-        radius: 0
-    };
-    const triCenter = new Vector3();
-    const pushDir = new Vector3();
-    const centerToPt = new Vector3();
-    const intersectToPt = new Vector3();
-    const pushVec = new Vector3();
-    for(let index = 0; index < surfaceConstraints.length; index += 6){
-        for(let i = 0; i < collidersR.length; i++){
-            const colR = collidersR[i];
-            const colRW = collidersRW[i];
-            if (colRW.enabled === 0) {
-                continue;
-            }
-            const colliderPos = colRW.positionCurrent;
-            for(let j = 0; j < 6; j += 3){
-                const idxA = surfaceConstraints[index + j + 0];
-                const idxB = surfaceConstraints[index + j + 1];
-                const idxC = surfaceConstraints[index + j + 2];
-                const rwA = pointsRW[idxA];
-                const rwB = pointsRW[idxB];
-                const rwC = pointsRW[idxC];
-                const result = checkSurfaceCollision(rwA.positionCurrent, rwB.positionCurrent, rwC.positionCurrent, colliderPos, colR, colRW, surfaceResult);
-                if (result.hit) {
-                    triCenter.setXYZ((rwA.positionCurrent.x + rwB.positionCurrent.x + rwC.positionCurrent.x) / 3, (rwA.positionCurrent.y + rwB.positionCurrent.y + rwC.positionCurrent.y) / 3, (rwA.positionCurrent.z + rwB.positionCurrent.z + rwC.positionCurrent.z) / 3);
-                    const pushMag = result.pushOut.magnitude;
-                    if (pushMag < EPSILON) {
-                        continue;
-                    }
-                    Vector3.scale(result.pushOut, 1 / pushMag, pushDir);
-                    for(let k = 0; k < 3; k++){
-                        const idxR = surfaceConstraints[index + j + k];
-                        const rwPt = pointsRW[idxR];
-                        Vector3.sub(rwPt.positionCurrent, triCenter, centerToPt);
-                        Vector3.sub(rwPt.positionCurrent, result.intersectionPoint, intersectToPt);
-                        const intersectLen = intersectToPt.magnitude;
-                        let rate = intersectLen > EPSILON ? centerToPt.magnitude / intersectLen : 0;
-                        rate = clamp01(Math.abs(rate));
-                        Vector3.scale(pushDir, (result.radius - pushMag) * rate, pushVec);
-                        Vector3.add(rwPt.positionCurrent, pushVec, rwPt.positionCurrent);
-                    }
-                }
-            }
-        }
-    }
-}
-// 閳光偓閳光偓 Constraint relaxation 閳光偓閳光偓
-function constraintUpdate(pointsR, pointsRW, constraints, collidersR, collidersRW, constraintShrinkLimit, enableBroadPhase) {
-    const direction = new Vector3();
-    const dirN = new Vector3();
-    const disp = new Vector3();
-    const scaledDisp = new Vector3();
-    const pointResultA = {
-        hit: false,
-        point: new Vector3()
-    };
-    const pointResultB = {
-        hit: false,
-        point: new Vector3()
-    };
-    const lineResult = {
-        hit: false,
-        pointOnLine: new Vector3(),
-        pointOnCollider: new Vector3(),
-        radius: 0
-    };
-    const pushout = new Vector3();
-    const segment = new Vector3();
-    const pointToA = new Vector3();
-    const pointToB = new Vector3();
-    const pushN = new Vector3();
-    const pushVec = new Vector3();
-    for(let index = 0; index < constraints.length; index++){
-        const c = constraints[index];
-        const ptRA = pointsR[c.indexA];
-        const ptRB = pointsR[c.indexB];
-        const weightA = ptRA.weight;
-        const weightB = ptRB.weight;
-        if (weightA <= EPSILON && weightB <= EPSILON) {
-            continue;
-        }
-        const rwA = pointsRW[c.indexA];
-        const rwB = pointsRW[c.indexB];
-        Vector3.sub(rwB.positionCurrent, rwA.positionCurrent, direction);
-        const distance = direction.magnitude;
-        let shrinkLen = c.length;
-        let stretchLen = shrinkLen;
-        if (c.type === ConstraintType.Structural_Horizontal || c.type === ConstraintType.Bending_Horizontal || c.type === ConstraintType.Shear) {
-            stretchLen += ptRA.sliderJointLength + ptRB.sliderJointLength;
-        }
-        let force = 0;
-        if (distance <= shrinkLen) {
-            force = distance - shrinkLen;
-        } else if (distance >= stretchLen) {
-            force = distance - stretchLen;
-        }
-        const isShrink = force >= 0;
-        let power = 0;
-        switch(c.type){
-            case ConstraintType.Structural_Vertical:
-                power = isShrink ? ptRA.structuralShrinkVertical + ptRB.structuralShrinkVertical : ptRA.structuralStretchVertical + ptRB.structuralStretchVertical;
-                break;
-            case ConstraintType.Structural_Horizontal:
-                power = isShrink ? Math.min(constraintShrinkLimit, ptRA.structuralShrinkHorizontal + ptRB.structuralShrinkHorizontal) : ptRA.structuralStretchHorizontal + ptRB.structuralStretchHorizontal;
-                break;
-            case ConstraintType.Shear:
-                power = isShrink ? Math.min(constraintShrinkLimit, ptRA.shearShrink + ptRB.shearShrink) : ptRA.shearStretch + ptRB.shearStretch;
-                break;
-            case ConstraintType.Bending_Vertical:
-                power = isShrink ? ptRA.bendingShrinkVertical + ptRB.bendingShrinkVertical : ptRA.bendingStretchVertical + ptRB.bendingStretchVertical;
-                break;
-            case ConstraintType.Bending_Horizontal:
-                power = isShrink ? Math.min(constraintShrinkLimit, ptRA.bendingShrinkHorizontal + ptRB.bendingShrinkHorizontal) : ptRA.bendingStretchHorizontal + ptRB.bendingStretchHorizontal;
-                break;
-        }
-        if (power > 0) {
-            if (distance > EPSILON) {
-                Vector3.scale(direction, 1 / distance, dirN);
-            } else {
-                dirN.setXYZ(0, 0, 0);
-            }
-            Vector3.scale(dirN, force * power, disp);
-            const wAB = weightA + weightB;
-            Vector3.scale(disp, weightA / wAB, scaledDisp);
-            Vector3.add(rwA.positionCurrent, scaledDisp, rwA.positionCurrent);
-            Vector3.scale(disp, weightB / wAB, scaledDisp);
-            Vector3.sub(rwB.positionCurrent, scaledDisp, rwB.positionCurrent);
-        }
-        // Per-constraint collision
-        if (c.isCollision !== 0) {
-            let friction = 0;
-            for(let i = 0; i < collidersR.length; i++){
-                const colRW = collidersRW[i];
-                if (colRW.enabled === 0) {
-                    continue;
-                }
-                const colR = collidersR[i];
-                const canPointA = !enableBroadPhase || colR.isInverseCollider || pointMayCollideBroadPhase(rwA.positionCurrent, colRW, ptRA.pointRadius);
-                const canPointB = !enableBroadPhase || colR.isInverseCollider || pointMayCollideBroadPhase(rwB.positionCurrent, colRW, ptRB.pointRadius);
-                const canLine = !colR.isInverseCollider && (!enableBroadPhase || segmentMayCollideBroadPhase(rwA.positionCurrent, rwB.positionCurrent, colRW));
-                if (!canPointA && !canPointB && !canLine) {
-                    continue;
-                }
-                if (colR.height > EPSILON) {
-                    if (colR.isInverseCollider) {
-                        if (ptRA.applyInvertCollision === 1 && canPointA) {
-                            const res = pushInFromCapsule(colR, colRW, rwA.positionCurrent, pointResultA);
-                            if (res.hit) {
-                                rwA.positionCurrent.set(res.point);
-                                friction = Math.max(friction, colR.friction * 0.25);
-                            }
-                        }
-                        if (ptRB.applyInvertCollision === 1 && canPointB) {
-                            const res = pushInFromCapsule(colR, colRW, rwB.positionCurrent, pointResultB);
-                            if (res.hit) {
-                                rwB.positionCurrent.set(res.point);
-                                friction = Math.max(friction, colR.friction * 0.25);
-                            }
-                        }
-                    } else {
-                        if (canPointA) {
-                            const res = pushoutFromCapsule(colR, colRW, rwA.positionCurrent, ptRA, pointResultA);
-                            if (res.hit) {
-                                rwA.positionCurrent.set(res.point);
-                                friction = Math.max(friction, colR.friction * 0.25);
-                            }
-                        }
-                        if (canPointB) {
-                            const res = pushoutFromCapsule(colR, colRW, rwB.positionCurrent, ptRB, pointResultB);
-                            if (res.hit) {
-                                rwB.positionCurrent.set(res.point);
-                                friction = Math.max(friction, colR.friction * 0.25);
-                            }
-                        }
-                    }
-                } else {
-                    if (colR.isInverseCollider) {
-                        if (ptRA.applyInvertCollision === 1 && canPointA) {
-                            const res = pushInFromSphere(colRW.positionCurrent, colRW.radius, rwA.positionCurrent, pointResultA);
-                            if (res.hit) {
-                                rwA.positionCurrent.set(res.point);
-                                friction = Math.max(friction, colR.friction * 0.25);
-                            }
-                        }
-                        if (ptRB.applyInvertCollision === 1 && canPointB) {
-                            const res = pushInFromSphere(colRW.positionCurrent, colRW.radius, rwB.positionCurrent, pointResultB);
-                            if (res.hit) {
-                                rwB.positionCurrent.set(res.point);
-                                friction = Math.max(friction, colR.friction * 0.25);
-                            }
-                        }
-                    } else {
-                        if (canPointA) {
-                            const res = pushoutFromSphere(colRW.positionCurrent, colRW.radius, ptRA.pointRadius, rwA.positionCurrent, pointResultA);
-                            if (res.hit) {
-                                rwA.positionCurrent.set(res.point);
-                                friction = Math.max(friction, colR.friction * 0.25);
-                            }
-                        }
-                        if (canPointB) {
-                            const res = pushoutFromSphere(colRW.positionCurrent, colRW.radius, ptRB.pointRadius, rwB.positionCurrent, pointResultB);
-                            if (res.hit) {
-                                rwB.positionCurrent.set(res.point);
-                                friction = Math.max(friction, colR.friction * 0.25);
-                            }
-                        }
-                    }
-                }
-                // Line segment collision
-                if (!colR.isInverseCollider && canLine) {
-                    const lineRes = collisionDetection(colR, colRW, rwA.positionCurrent, rwB.positionCurrent, lineResult);
-                    if (lineRes.hit) {
-                        Vector3.sub(lineRes.pointOnLine, lineRes.pointOnCollider, pushout);
-                        const pushDist = pushout.magnitude;
-                        if (pushDist > EPSILON) {
-                            const ptDist = Vector3.sub(rwB.positionCurrent, rwA.positionCurrent, segment).magnitude * 0.5;
-                            const rateP1 = ptDist > EPSILON ? clamp01(Vector3.sub(lineRes.pointOnLine, rwA.positionCurrent, pointToA).magnitude / ptDist) : 0;
-                            const rateP2 = ptDist > EPSILON ? clamp01(Vector3.sub(lineRes.pointOnLine, rwB.positionCurrent, pointToB).magnitude / ptDist) : 0;
-                            Vector3.scale(pushout, 1 / pushDist, pushN);
-                            Vector3.scale(pushN, Math.max(lineRes.radius - pushDist, 0), pushVec);
-                            if (weightA > EPSILON) {
-                                Vector3.scale(pushVec, rateP2, scaledDisp);
-                                Vector3.add(rwA.positionCurrent, scaledDisp, rwA.positionCurrent);
-                            }
-                            if (weightB > EPSILON) {
-                                Vector3.scale(pushVec, rateP1, scaledDisp);
-                                Vector3.add(rwB.positionCurrent, scaledDisp, rwB.positionCurrent);
-                            }
-                            const dotUp = Vector3.dot(AXIS_Y, Vector3.normalize(pushout, pushN));
-                            friction = Math.max(friction, colR.friction * clamp01(dotUp));
-                        }
-                    }
-                }
-            }
-            rwA.friction = Math.max(friction, rwA.friction);
-            rwB.friction = Math.max(friction, rwB.friction);
-        }
-    }
-}
-// 閳光偓閳光偓 Pass 2: blend + fake wave 閳光偓閳光偓
-function pointUpdatePass2(pointsR, pointsRW, positionsToTransform, stepDelta, fakeWaveFreq, blendRatio, isFakeWave, fakeWavePower) {
-    let freq = fakeWaveFreq;
-    const curTransformPos = new Vector3();
-    const fakeWindOffset = new Vector3();
-    for(let index = 0; index < pointsR.length; index++){
-        const ptR = pointsR[index];
-        const ptRW = pointsRW[index];
-        Vector3.lerp(ptRW.positionPreviousTransform, ptRW.positionCurrentTransform, stepDelta, curTransformPos);
-        const blend = smoothStep(0, 1, Math.max(ptR.forceFadeRatio, blendRatio));
-        Vector3.lerp(ptRW.positionCurrent, curTransformPos, blend, ptRW.positionToTransform);
-        if (isFakeWave && ptR.child === -1 && ptR.parent !== -1) {
-            const A = pointsRW[ptR.parent].positionToTransform;
-            const B = ptRW.positionToTransform;
-            const mAxis = Matrix4x4.lookAt(A, B, AXIS_Y);
-            // Column 1 = up axis of the look-at matrix
-            const col1 = mAxis.getCol(1).xyz();
-            Vector3.lerp(ptRW.fakeWindDirection, col1, 0.5, ptRW.fakeWindDirection);
-            freq += ptR.fakeWaveFreq;
-            const power = Math.sin(freq) * fakeWavePower * ptR.fakeWavePower;
-            Vector3.scale(ptRW.fakeWindDirection, power, fakeWindOffset);
-            Vector3.add(ptRW.positionToTransform, fakeWindOffset, ptRW.positionToTransform);
-        }
-        positionsToTransform[index] = ptRW.positionToTransform.clone();
-    }
-}
-function applyResult(pointsR, pointsRW, positionsToTransform, blendRatio, // Current transform rotations (world and local) read from engine
-transformRotations, transformLocalRotations) {
-    const results = new Array(pointsR.length);
-    for(let index = 0; index < pointsR.length; index++){
-        const ptR = pointsR[index];
-        const ptRW = pointsRW[index];
-        let worldRot = transformRotations[index];
-        let localRot = transformLocalRotations[index];
-        if (ptR.weight >= EPSILON) {
-            // Dynamic point
-            if (ptR.parent !== -1) {
-                const direction = Vector3.sub(ptRW.positionToTransform, positionsToTransform[ptR.parent]);
-                const realLen = direction.magnitude;
-                if (realLen > EPSILON) {
-                    ptRW.directionPrevious = direction;
-                } else {
-                    ptRW.positionToTransform = Vector3.add(positionsToTransform[ptR.parent], ptRW.directionPrevious);
-                }
-            }
-            const pos = ptRW.positionToTransform;
-            // SetRotation with blendRatio=0 for dynamic points
-            // Step 1: Reset localRotation 閳?initialLocalRotation (blendRatio=0 閳?fully initial)
-            localRot = ptR.initialLocalRotation.clone();
-            // Step 2: Recompute worldRot from the new localRot
-            // In C#, setting localRotation immediately updates the world rotation.
-            // worldRot = parentWorldRot * localRot
-            // We approximate: the parent's current world rotation is in transformRotations[ptR.parent]
-            if (ptR.parent !== -1) {
-                // Use the parent's OUTPUT rotation (already computed if parent index < current index)
-                const parentRot = results[ptR.parent] ? results[ptR.parent].rotation : transformRotations[ptR.parent];
-                worldRot = Quaternion.multiply(parentRot, localRot);
-            } else {
-                worldRot = localRot.clone();
-            }
-            // Step 3: Aim toward child using updated worldRot
-            if (ptR.child !== -1) {
-                const childDir = Vector3.sub(positionsToTransform[ptR.child], ptRW.positionToTransform);
-                if (childDir.magnitudeSq > EPSILON) {
-                    const aimVec = worldRot.transform(ptR.boneAxis);
-                    const aimRot = Quaternion.unitVectorToUnitVector(aimVec, childDir);
-                    worldRot = Quaternion.multiply(aimRot, worldRot);
-                }
-            }
-            results[index] = {
-                position: pos,
-                rotation: worldRot,
-                localRotation: localRot
-            };
-        } else {
-            // Fixed point 閳?follow transform, blend rotation
-            const childBlend = ptR.child !== -1 ? Math.max(pointsR[ptR.child].forceFadeRatio, blendRatio) : blendRatio;
-            // Step 1: Blend localRotation
-            localRot = Quaternion.slerp(ptR.initialLocalRotation, localRot, childBlend);
-            // Step 2: Recompute worldRot from blended localRot
-            if (ptR.parent !== -1) {
-                const parentRot = results[ptR.parent] ? results[ptR.parent].rotation : transformRotations[ptR.parent];
-                worldRot = Quaternion.multiply(parentRot, localRot);
-            } else {
-                worldRot = localRot.clone();
-            }
-            // Step 3: Aim toward child with blend
-            if (ptR.child !== -1) {
-                const childDir = Vector3.sub(positionsToTransform[ptR.child], ptRW.positionToTransform);
-                if (childDir.magnitudeSq > EPSILON) {
-                    const aimVec = worldRot.transform(ptR.boneAxis);
-                    const aimRot = Quaternion.unitVectorToUnitVector(aimVec, childDir);
-                    worldRot = Quaternion.slerp(Quaternion.multiply(aimRot, worldRot), worldRot, childBlend);
-                }
-            }
-            results[index] = {
-                position: ptRW.positionCurrentTransform,
-                rotation: worldRot,
-                localRotation: localRot
-            };
-        }
-    }
-    return results;
-}
-// 閳光偓閳光偓 Angle limiting (post-simulation) 閳光偓閳光偓
-function applyAngleLimits(pointsR, pointsRW, config) {
-    if (config.angleLimit < 0) {
-        return;
-    }
-    for(let index = 0; index < pointsR.length; index++){
-        const ptR = pointsR[index];
-        if (ptR.parent === -1) {
-            continue;
-        }
-        const ptRW = pointsRW[index];
-        const ptRp = pointsR[ptR.parent];
-        const ptRWp = pointsRW[ptR.parent];
-        const superParentPos = ptRp.parent !== -1 ? pointsRW[ptRp.parent].positionCurrent : ptRWp.positionCurrent;
-        const boneDir = Vector3.sub(ptRW.positionCurrent, ptRWp.positionCurrent);
-        let parentBoneDir = Vector3.sub(ptRWp.positionCurrent, superParentPos);
-        if (parentBoneDir.magnitude === 0 || config.limitFromRoot) {
-            parentBoneDir = Vector3.sub(ptRW.positionCurrentTransform, ptRWp.positionCurrentTransform);
-        }
-        const angle = Vector3.angleBetween(parentBoneDir, boneDir);
-        const remaining = radian2degree(angle) - config.angleLimit;
-        if (remaining > 0) {
-            const axis = Vector3.cross(parentBoneDir, boneDir);
-            const rotated = Quaternion.fromAxisAngle(axis, degree2radian(-remaining)).transform(boneDir);
-            ptRW.positionCurrent = Vector3.add(ptRWp.positionCurrent, rotated);
-        }
-    }
-}
-
-export { applyAngleLimits, applyResult, simulate };
-//# sourceMappingURL=solver.js.map