@zephyr3d/scene 0.9.1 → 0.9.3

package/dist/animation/ik/two_bone_ik_solver.js.map

@@ -1 +1 @@
-{"version":3,"file":"two_bone_ik_solver.js","sources":["../../../src/animation/ik/two_bone_ik_solver.ts"],"sourcesContent":["import { Vector3, Quaternion } from '@zephyr3d/base';\r\nimport { IKSolver } from './ik_solver';\r\nimport type { IKChain } from './ik_chain';\r\nimport { IKUtils } from './ik_utils';\r\nimport type { TwistConstraint } from './ik_constraint';\r\n\r\n/**\r\n * Two Bone IK solver for chains with exactly 3 joints (2 bones).\r\n *\r\n * @remarks\r\n * This solver uses an analytical solution specifically optimized for\r\n * two-bone chains like arms (shoulder-elbow-wrist) or legs (hip-knee-ankle).\r\n * It's faster and more stable than iterative methods like FABRIK for this case.\r\n *\r\n * The solver supports an optional pole vector to control the bending direction\r\n * of the middle joint (elbow/knee).\r\n *\r\n * @public\r\n */\r\nexport class TwoBoneIKSolver extends IKSolver {\r\n  /** Optional pole vector position in world space */\r\n  private _poleVector: Vector3 | null;\r\n  /** Weight of the pole vector constraint (0-1) */\r\n  private _poleWeight: number;\r\n  /** Twist constraints for each joint (indexed by joint index) */\r\n  private _twistConstraints: Map<number, TwistConstraint>;\r\n\r\n  /**\r\n   * Create a Two Bone IK solver.\r\n   *\r\n   * @param chain - The IK chain to solve (must have exactly 3 joints)\r\n   * @param poleVector - Optional pole vector position in world space\r\n   * @param poleWeight - Weight of the pole vector constraint (0-1, default: 1)\r\n   */\r\n  constructor(chain: IKChain, poleVector: Vector3 | null = null, poleWeight = 1) {\r\n    super(chain, 1, 0.001); // Two bone IK doesn't need iterations\r\n\r\n    if (chain.joints.length !== 3) {\r\n      throw new Error('Two Bone IK requires exactly 3 joints (2 bones)');\r\n    }\r\n\r\n    this._poleVector = poleVector ? poleVector.clone() : null;\r\n    this._poleWeight = Math.max(0, Math.min(1, poleWeight));\r\n    this._twistConstraints = new Map();\r\n\r\n    // Set default twist constraints\r\n    // Root joint (shoulder/hip) - moderate twist\r\n    this._twistConstraints.set(0, {\r\n      minTwist: -Math.PI * 0.25, // -45 degrees\r\n      maxTwist: Math.PI * 0.25, // +45 degrees\r\n      smoothFactor: 0.3\r\n    });\r\n\r\n    // Middle joint (elbow/knee) - very limited twist\r\n    this._twistConstraints.set(1, {\r\n      minTwist: -Math.PI * 0.15, // -27 degrees\r\n      maxTwist: Math.PI * 0.15, // +27 degrees\r\n      smoothFactor: 0.3\r\n    });\r\n  }\r\n\r\n  /**\r\n   * Set twist constraint for a specific joint.\r\n   *\r\n   * @param jointIndex - Index of the joint (0 = root, 1 = middle)\r\n   * @param minTwist - Minimum twist angle in radians\r\n   * @param maxTwist - Maximum twist angle in radians\r\n   * @param smoothFactor - Smoothing factor [0-1] (default: 0.3)\r\n   */\r\n  setTwistConstraint(\r\n    jointIndex: number,\r\n    minTwist: number,\r\n    maxTwist: number,\r\n    smoothFactor: number = 0.3\r\n  ): void {\r\n    if (jointIndex < 0 || jointIndex >= this._chain.joints.length - 1) {\r\n      throw new Error(`Invalid joint index: ${jointIndex}`);\r\n    }\r\n\r\n    this._twistConstraints.set(jointIndex, {\r\n      minTwist,\r\n      maxTwist,\r\n      smoothFactor: Math.max(0, Math.min(1, smoothFactor))\r\n    });\r\n  }\r\n\r\n  /**\r\n   * Get twist constraint for a specific joint.\r\n   *\r\n   * @param jointIndex - Index of the joint\r\n   * @returns Twist constraint or undefined if not set\r\n   */\r\n  getTwistConstraint(jointIndex: number): TwistConstraint | undefined {\r\n    return this._twistConstraints.get(jointIndex);\r\n  }\r\n\r\n  /**\r\n   * Remove twist constraint for a specific joint.\r\n   *\r\n   * @param jointIndex - Index of the joint\r\n   * @returns True if a constraint was removed\r\n   */\r\n  removeTwistConstraint(jointIndex: number): boolean {\r\n    return this._twistConstraints.delete(jointIndex);\r\n  }\r\n\r\n  /**\r\n   * Clear all twist constraints.\r\n   */\r\n  clearTwistConstraints(): void {\r\n    this._twistConstraints.clear();\r\n  }\r\n\r\n  /**\r\n   * Get the pole vector position.\r\n   */\r\n  get poleVector(): Vector3 | null {\r\n    return this._poleVector;\r\n  }\r\n\r\n  /**\r\n   * Set the pole vector position.\r\n   */\r\n  set poleVector(value: Vector3 | null) {\r\n    if (value) {\r\n      if (!this._poleVector) {\r\n        this._poleVector = value.clone();\r\n      } else {\r\n        this._poleVector.set(value);\r\n      }\r\n    } else {\r\n      this._poleVector = null;\r\n    }\r\n  }\r\n\r\n  /**\r\n   * Get the pole vector weight.\r\n   */\r\n  get poleWeight(): number {\r\n    return this._poleWeight;\r\n  }\r\n\r\n  /**\r\n   * Set the pole vector weight (0-1).\r\n   */\r\n  set poleWeight(value: number) {\r\n    this._poleWeight = Math.max(0, Math.min(1, value));\r\n  }\r\n\r\n  /**\r\n   * Solve the IK chain to reach the target position using Two Bone IK algorithm.\r\n   *\r\n   * @param target - Target position for the end effector\r\n   * @returns True if the target is reachable, false if stretched to maximum\r\n   */\r\n  solve(target: Vector3): boolean {\r\n    const joints = this._chain.joints;\r\n\r\n    // Update joint positions from scene nodes before solving\r\n    this._chain.updateFromNodes();\r\n\r\n    // Store original positions\r\n    this._chain.storeOriginalPositions();\r\n\r\n    const root = joints[0];\r\n    const middle = joints[1];\r\n    const end = joints[2];\r\n\r\n    const rootPos = root.position;\r\n    const upperLength = root.boneLength; // Length from root to middle\r\n    const lowerLength = middle.boneLength; // Length from middle to end\r\n    const totalLength = upperLength + lowerLength;\r\n\r\n    // Calculate direction and distance from root to target\r\n    const rootToTarget = Vector3.sub(target, rootPos, new Vector3());\r\n    const targetDistance = rootToTarget.magnitude;\r\n\r\n    // Check if target is reachable\r\n    if (targetDistance < 0.000001) {\r\n      // Target is at root position, keep original pose\r\n      return true;\r\n    }\r\n\r\n    let reachable = true;\r\n\r\n    // If target is unreachable, clamp to maximum distance\r\n    let effectiveTarget = target;\r\n    if (targetDistance >= totalLength - 0.0001) {\r\n      // Stretch to maximum length\r\n      const direction = Vector3.scale(rootToTarget, 1 / targetDistance, new Vector3());\r\n      effectiveTarget = Vector3.add(\r\n        rootPos,\r\n        Vector3.scale(direction, totalLength - 0.0001, new Vector3()),\r\n        new Vector3()\r\n      );\r\n      reachable = false;\r\n    }\r\n\r\n    // Calculate the distance from root to effective target\r\n    const rootToEffectiveTarget = Vector3.sub(effectiveTarget, rootPos, new Vector3());\r\n    const distance = rootToEffectiveTarget.magnitude;\r\n\r\n    // Use law of cosines to find the angle at the root joint\r\n    // cos(rootAngle) = (a² + c² - b²) / (2ac)\r\n    const cosRootAngle =\r\n      (upperLength * upperLength + distance * distance - lowerLength * lowerLength) /\r\n      (2 * upperLength * distance);\r\n    const clampedCosRootAngle = Math.max(-1, Math.min(1, cosRootAngle));\r\n    const rootAngle = Math.acos(clampedCosRootAngle);\r\n\r\n    // Determine the plane of bending\r\n    let bendNormal: Vector3;\r\n\r\n    if (this._poleVector && this._poleWeight > 0.001) {\r\n      // Use pole vector to determine bend direction\r\n      const rootToTargetDir = Vector3.normalize(rootToEffectiveTarget, new Vector3());\r\n      const rootToPole = Vector3.sub(this._poleVector, rootPos, new Vector3());\r\n\r\n      // Project pole vector onto plane perpendicular to root-target direction\r\n      const projectionLength = Vector3.dot(rootToPole, rootToTargetDir);\r\n      const projection = Vector3.scale(rootToTargetDir, projectionLength, new Vector3());\r\n      const perpendicular = Vector3.sub(rootToPole, projection, new Vector3());\r\n\r\n      const perpLength = perpendicular.magnitude;\r\n      if (perpLength > 0.000001) {\r\n        // Bend normal is perpendicular to both root-target and pole direction\r\n        bendNormal = Vector3.cross(rootToTargetDir, perpendicular, new Vector3()).inplaceNormalize();\r\n      } else {\r\n        // Pole is on the line, use default bend direction\r\n        bendNormal = this._getDefaultBendNormal(rootToEffectiveTarget);\r\n      }\r\n\r\n      // Apply pole weight\r\n      if (this._poleWeight < 0.999) {\r\n        const defaultNormal = this._getDefaultBendNormal(rootToEffectiveTarget);\r\n        // Slerp between default and pole-based normal\r\n        const angle = Math.acos(Math.max(-1, Math.min(1, Vector3.dot(defaultNormal, bendNormal))));\r\n        if (angle > 0.001) {\r\n          const axis = Vector3.cross(defaultNormal, bendNormal, new Vector3()).inplaceNormalize();\r\n          const rotation = new Quaternion().fromAxisAngle(axis, angle * this._poleWeight);\r\n          bendNormal = rotation.transform(defaultNormal, new Vector3());\r\n        }\r\n      }\r\n    } else {\r\n      // No pole vector, use default bend direction\r\n      bendNormal = this._getDefaultBendNormal(rootToEffectiveTarget);\r\n    }\r\n\r\n    // Calculate middle joint position\r\n    const rootToTargetDir = Vector3.normalize(rootToEffectiveTarget, new Vector3());\r\n\r\n    // Rotate root-to-target direction by rootAngle around bendNormal\r\n    const rotationToMiddle = new Quaternion().fromAxisAngle(bendNormal, rootAngle);\r\n    const rootToMiddleDir = rotationToMiddle.transform(rootToTargetDir, new Vector3());\r\n\r\n    // Place middle joint\r\n    middle.position.set(\r\n      Vector3.add(rootPos, Vector3.scale(rootToMiddleDir, upperLength, new Vector3()), new Vector3())\r\n    );\r\n\r\n    // Place end joint at target\r\n    end.position.set(effectiveTarget);\r\n\r\n    // Apply constraints after solving\r\n    // Note: Constraints may modify joint positions, which could affect bone lengths\r\n    // For Two Bone IK, we apply constraints and then restore bone lengths\r\n    this._applyConstraints();\r\n\r\n    return reachable;\r\n  }\r\n\r\n  /**\r\n   * Apply all constraints to the joint chain.\r\n   * After applying constraints, we need to restore bone lengths.\r\n   */\r\n  private _applyConstraints(): void {\r\n    const constraints = this._chain.constraints;\r\n    if (constraints.length === 0) {\r\n      return;\r\n    }\r\n\r\n    const joints = this._chain.joints;\r\n\r\n    // Apply each constraint\r\n    for (const constraint of constraints) {\r\n      constraint.apply(joints);\r\n    }\r\n\r\n    // After constraints are applied, we need to restore bone lengths\r\n    // because constraints may have moved joints in ways that change bone lengths\r\n    // For Two Bone IK, we fix this by adjusting positions while maintaining the constraint\r\n    this._restoreBoneLengths();\r\n  }\r\n\r\n  /**\r\n   * Restore bone lengths after constraints have been applied.\r\n   * This ensures that the chain maintains correct bone lengths.\r\n   */\r\n  private _restoreBoneLengths(): void {\r\n    const joints = this._chain.joints;\r\n    const root = joints[0];\r\n    const middle = joints[1];\r\n    const end = joints[2];\r\n\r\n    const upperLength = root.boneLength;\r\n    const lowerLength = middle.boneLength;\r\n\r\n    // Fix middle joint position to maintain upper bone length\r\n    const rootToMiddle = Vector3.sub(middle.position, root.position, new Vector3());\r\n    const rootToMiddleDist = rootToMiddle.magnitude;\r\n\r\n    if (rootToMiddleDist > 0.000001 && Math.abs(rootToMiddleDist - upperLength) > 0.0001) {\r\n      const rootToMiddleDir = Vector3.scale(rootToMiddle, 1 / rootToMiddleDist, new Vector3());\r\n      middle.position.set(\r\n        Vector3.add(root.position, Vector3.scale(rootToMiddleDir, upperLength, new Vector3()), new Vector3())\r\n      );\r\n    }\r\n\r\n    // Fix end joint position to maintain lower bone length\r\n    const middleToEnd = Vector3.sub(end.position, middle.position, new Vector3());\r\n    const middleToEndDist = middleToEnd.magnitude;\r\n\r\n    if (middleToEndDist > 0.000001 && Math.abs(middleToEndDist - lowerLength) > 0.0001) {\r\n      const middleToEndDir = Vector3.scale(middleToEnd, 1 / middleToEndDist, new Vector3());\r\n      end.position.set(\r\n        Vector3.add(middle.position, Vector3.scale(middleToEndDir, lowerLength, new Vector3()), new Vector3())\r\n      );\r\n    }\r\n  }\r\n\r\n  /**\r\n   * Apply the solved joint positions to scene nodes as rotations.\r\n   *\r\n   * @param weight - Blend weight (0 = original, 1 = full IK, default: 1)\r\n   */\r\n  applyToNodes(weight = 1): void {\r\n    const joints = this._chain.joints;\r\n\r\n    // Apply rotation for root and middle joints (end joint doesn't need rotation)\r\n    for (let i = 0; i < joints.length - 1; i++) {\r\n      const joint = joints[i];\r\n      const nextJoint = joints[i + 1];\r\n\r\n      // Calculate direction from current joint to next joint in world space\r\n      const originalDir = Vector3.sub(nextJoint.originalPosition, joint.originalPosition, new Vector3());\r\n      const newDir = Vector3.sub(nextJoint.position, joint.position, new Vector3());\r\n\r\n      const originalDirNorm = Vector3.normalize(originalDir, new Vector3());\r\n      const newDirNorm = Vector3.normalize(newDir, new Vector3());\r\n\r\n      // Calculate basic rotation\r\n      const deltaRotation = new Quaternion();\r\n      IKUtils.fromToRotation(originalDirNorm, newDirNorm, deltaRotation);\r\n\r\n      // Calculate new world rotation\r\n      let worldRotation = Quaternion.multiply(deltaRotation, joint.originalRotation, new Quaternion());\r\n\r\n      // Apply swing-twist constraint to prevent over-rotation\r\n      // Decompose rotation around bone axis\r\n      const swing = new Quaternion();\r\n      const twist = new Quaternion();\r\n      worldRotation.decomposeSwingTwist(newDirNorm, swing, twist);\r\n\r\n      // Get twist angle\r\n      let twistAngle = twist.getTwistAngle(newDirNorm);\r\n\r\n      // Get twist constraint for this joint\r\n      const constraint = this._twistConstraints.get(i);\r\n      if (constraint) {\r\n        // Clamp and smooth twist\r\n        twistAngle = IKUtils.clampAndSmoothTwist(\r\n          twistAngle,\r\n          joint.previousTwist,\r\n          constraint.minTwist,\r\n          constraint.maxTwist,\r\n          constraint.smoothFactor\r\n        );\r\n      }\r\n\r\n      // Store for next frame\r\n      joint.previousTwist = twistAngle;\r\n\r\n      // Reconstruct rotation from clamped twist: Q = Twist * Swing\r\n      const clampedTwist = Quaternion.fromAxisAngle(newDirNorm, twistAngle);\r\n      worldRotation = Quaternion.multiply(clampedTwist, swing, worldRotation);\r\n\r\n      // Blend with original rotation based on weight\r\n      if (weight < 1) {\r\n        Quaternion.slerp(joint.originalRotation, worldRotation, weight, worldRotation);\r\n      }\r\n\r\n      // Store this frame's world rotation for next frame's twist continuity\r\n      if (!joint.previousIKRotation) {\r\n        joint.previousIKRotation = worldRotation.clone();\r\n      } else {\r\n        joint.previousIKRotation.set(worldRotation);\r\n      }\r\n\r\n      // Convert world rotation to local rotation (relative to parent)\r\n      if (joint.node.parent) {\r\n        const parentWorldRotation = new Quaternion();\r\n        joint.node.parent.worldMatrix.decompose(null, parentWorldRotation, null);\r\n\r\n        // localRotation = conjugate(parentWorldRotation) * worldRotation\r\n        const parentInvRotation = Quaternion.conjugate(parentWorldRotation, new Quaternion());\r\n        const localRotation = Quaternion.multiply(parentInvRotation, worldRotation, new Quaternion());\r\n\r\n        joint.node.rotation = localRotation;\r\n      } else {\r\n        // Root node has no parent, world rotation is local rotation\r\n        joint.node.rotation = worldRotation;\r\n      }\r\n    }\r\n  }\r\n\r\n  /**\r\n   * Get a default bend normal when no pole vector is specified.\r\n   * This tries to find a reasonable perpendicular direction.\r\n   *\r\n   * @param rootToTarget - Direction from root to target\r\n   * @returns A normalized perpendicular vector\r\n   */\r\n  private _getDefaultBendNormal(rootToTarget: Vector3): Vector3 {\r\n    const rootToTargetDir = Vector3.normalize(rootToTarget, new Vector3());\r\n\r\n    // Try to use world up (Y axis) as reference\r\n    let bendNormal = Vector3.cross(rootToTargetDir, Vector3.axisPY(), new Vector3());\r\n    const lenSq = bendNormal.x * bendNormal.x + bendNormal.y * bendNormal.y + bendNormal.z * bendNormal.z;\r\n\r\n    // If root-to-target is parallel to Y axis, use X axis instead\r\n    if (lenSq < 0.000001) {\r\n      bendNormal = Vector3.cross(rootToTargetDir, Vector3.axisPX(), new Vector3());\r\n    }\r\n\r\n    return bendNormal.inplaceNormalize();\r\n  }\r\n}\r\n"],"names":["TwoBoneIKSolver","IKSolver","chain","poleVector","poleWeight","joints","length","Error","_poleVector","clone","_poleWeight","Math","max","min","_twistConstraints","Map","set","minTwist","PI","maxTwist","smoothFactor","setTwistConstraint","jointIndex","_chain","getTwistConstraint","get","removeTwistConstraint","delete","clearTwistConstraints","clear","value","solve","target","updateFromNodes","storeOriginalPositions","root","middle","end","rootPos","position","upperLength","boneLength","lowerLength","totalLength","rootToTarget","Vector3","sub","targetDistance","magnitude","reachable","effectiveTarget","direction","scale","add","rootToEffectiveTarget","distance","cosRootAngle","clampedCosRootAngle","rootAngle","acos","bendNormal","rootToTargetDir","normalize","rootToPole","projectionLength","dot","projection","perpendicular","perpLength","cross","inplaceNormalize","_getDefaultBendNormal","defaultNormal","angle","axis","rotation","Quaternion","fromAxisAngle","transform","rotationToMiddle","rootToMiddleDir","_applyConstraints","constraints","constraint","apply","_restoreBoneLengths","rootToMiddle","rootToMiddleDist","abs","middleToEnd","middleToEndDist","middleToEndDir","applyToNodes","weight","i","joint","nextJoint","originalDir","originalPosition","newDir","originalDirNorm","newDirNorm","deltaRotation","IKUtils","fromToRotation","worldRotation","multiply","originalRotation","swing","twist","decomposeSwingTwist","twistAngle","getTwistAngle","clampAndSmoothTwist","previousTwist","clampedTwist","slerp","previousIKRotation","node","parent","parentWorldRotation","worldMatrix","decompose","parentInvRotation","conjugate","localRotation","axisPY","lenSq","x","y","z","axisPX"],"mappings":";;;;AAMA;;;;;;;;;;;;IAaO,MAAMA,eAAwBC,SAAAA,QAAAA,CAAAA;wDAEnC,WAAoC;sDAEpC,WAA4B;qEAE5B,iBAAwD;AAExD;;;;;;MAOA,WAAA,CAAYC,KAAc,EAAEC,UAAAA,GAA6B,IAAI,EAAEC,UAAAA,GAAa,CAAC,CAAE;AAC7E,QAAA,KAAK,CAACF,KAAAA,EAAO,CAAG,EAAA,KAAA,CAAA,CAAA;AAEhB,QAAA,IAAIA,KAAMG,CAAAA,MAAM,CAACC,MAAM,KAAK,CAAG,EAAA;AAC7B,YAAA,MAAM,IAAIC,KAAM,CAAA,iDAAA,CAAA;AAClB;AAEA,QAAA,IAAI,CAACC,WAAW,GAAGL,UAAaA,GAAAA,UAAAA,CAAWM,KAAK,EAAK,GAAA,IAAA;QACrD,IAAI,CAACC,WAAW,GAAGC,IAAKC,CAAAA,GAAG,CAAC,CAAGD,EAAAA,IAAAA,CAAKE,GAAG,CAAC,CAAGT,EAAAA,UAAAA,CAAAA,CAAAA;QAC3C,IAAI,CAACU,iBAAiB,GAAG,IAAIC,GAAAA,EAAAA;;;AAI7B,QAAA,IAAI,CAACD,iBAAiB,CAACE,GAAG,CAAC,CAAG,EAAA;YAC5BC,QAAU,EAAA,CAACN,IAAKO,CAAAA,EAAE,GAAG,IAAA;YACrBC,QAAUR,EAAAA,IAAAA,CAAKO,EAAE,GAAG,IAAA;YACpBE,YAAc,EAAA;AAChB,SAAA,CAAA;;AAGA,QAAA,IAAI,CAACN,iBAAiB,CAACE,GAAG,CAAC,CAAG,EAAA;YAC5BC,QAAU,EAAA,CAACN,IAAKO,CAAAA,EAAE,GAAG,IAAA;YACrBC,QAAUR,EAAAA,IAAAA,CAAKO,EAAE,GAAG,IAAA;YACpBE,YAAc,EAAA;AAChB,SAAA,CAAA;AACF;AAEA;;;;;;;MAQAC,kBAAAA,CACEC,UAAkB,EAClBL,QAAgB,EAChBE,QAAgB,EAChBC,YAAuB,GAAA,GAAG,EACpB;QACN,IAAIE,UAAAA,GAAa,CAAKA,IAAAA,UAAAA,IAAc,IAAI,CAACC,MAAM,CAAClB,MAAM,CAACC,MAAM,GAAG,CAAG,EAAA;AACjE,YAAA,MAAM,IAAIC,KAAAA,CAAM,CAAC,qBAAqB,EAAEe,UAAY,CAAA,CAAA,CAAA;AACtD;AAEA,QAAA,IAAI,CAACR,iBAAiB,CAACE,GAAG,CAACM,UAAY,EAAA;AACrCL,YAAAA,QAAAA;AACAE,YAAAA,QAAAA;AACAC,YAAAA,YAAAA,EAAcT,KAAKC,GAAG,CAAC,GAAGD,IAAKE,CAAAA,GAAG,CAAC,CAAGO,EAAAA,YAAAA,CAAAA;AACxC,SAAA,CAAA;AACF;AAEA;;;;;MAMAI,kBAAAA,CAAmBF,UAAkB,EAA+B;AAClE,QAAA,OAAO,IAAI,CAACR,iBAAiB,CAACW,GAAG,CAACH,UAAAA,CAAAA;AACpC;AAEA;;;;;MAMAI,qBAAAA,CAAsBJ,UAAkB,EAAW;AACjD,QAAA,OAAO,IAAI,CAACR,iBAAiB,CAACa,MAAM,CAACL,UAAAA,CAAAA;AACvC;AAEA;;AAEC,MACDM,qBAA8B,GAAA;QAC5B,IAAI,CAACd,iBAAiB,CAACe,KAAK,EAAA;AAC9B;AAEA;;AAEC,MACD,IAAI1B,UAA6B,GAAA;QAC/B,OAAO,IAAI,CAACK,WAAW;AACzB;AAEA;;MAGA,IAAIL,UAAW2B,CAAAA,KAAqB,EAAE;AACpC,QAAA,IAAIA,KAAO,EAAA;AACT,YAAA,IAAI,CAAC,IAAI,CAACtB,WAAW,EAAE;AACrB,gBAAA,IAAI,CAACA,WAAW,GAAGsB,KAAAA,CAAMrB,KAAK,EAAA;aACzB,MAAA;AACL,gBAAA,IAAI,CAACD,WAAW,CAACQ,GAAG,CAACc,KAAAA,CAAAA;AACvB;SACK,MAAA;YACL,IAAI,CAACtB,WAAW,GAAG,IAAA;AACrB;AACF;AAEA;;AAEC,MACD,IAAIJ,UAAqB,GAAA;QACvB,OAAO,IAAI,CAACM,WAAW;AACzB;AAEA;;MAGA,IAAIN,UAAW0B,CAAAA,KAAa,EAAE;QAC5B,IAAI,CAACpB,WAAW,GAAGC,IAAKC,CAAAA,GAAG,CAAC,CAAGD,EAAAA,IAAAA,CAAKE,GAAG,CAAC,CAAGiB,EAAAA,KAAAA,CAAAA,CAAAA;AAC7C;AAEA;;;;;MAMAC,KAAAA,CAAMC,MAAe,EAAW;AAC9B,QAAA,MAAM3B,MAAS,GAAA,IAAI,CAACkB,MAAM,CAAClB,MAAM;;QAGjC,IAAI,CAACkB,MAAM,CAACU,eAAe,EAAA;;QAG3B,IAAI,CAACV,MAAM,CAACW,sBAAsB,EAAA;QAElC,MAAMC,IAAAA,GAAO9B,MAAM,CAAC,CAAE,CAAA;QACtB,MAAM+B,MAAAA,GAAS/B,MAAM,CAAC,CAAE,CAAA;QACxB,MAAMgC,GAAAA,GAAMhC,MAAM,CAAC,CAAE,CAAA;QAErB,MAAMiC,OAAAA,GAAUH,KAAKI,QAAQ;AAC7B,QAAA,MAAMC,WAAcL,GAAAA,IAAAA,CAAKM,UAAU,CAAA;AACnC,QAAA,MAAMC,WAAcN,GAAAA,MAAAA,CAAOK,UAAU,CAAA;AACrC,QAAA,MAAME,cAAcH,WAAcE,GAAAA,WAAAA;;AAGlC,QAAA,MAAME,eAAeC,OAAQC,CAAAA,GAAG,CAACd,MAAAA,EAAQM,SAAS,IAAIO,OAAAA,EAAAA,CAAAA;QACtD,MAAME,cAAAA,GAAiBH,aAAaI,SAAS;;AAG7C,QAAA,IAAID,iBAAiB,QAAU,EAAA;;YAE7B,OAAO,IAAA;AACT;AAEA,QAAA,IAAIE,SAAY,GAAA,IAAA;;AAGhB,QAAA,IAAIC,eAAkBlB,GAAAA,MAAAA;QACtB,IAAIe,cAAAA,IAAkBJ,cAAc,MAAQ,EAAA;;AAE1C,YAAA,MAAMQ,YAAYN,OAAQO,CAAAA,KAAK,CAACR,YAAc,EAAA,CAAA,GAAIG,gBAAgB,IAAIF,OAAAA,EAAAA,CAAAA;AACtEK,YAAAA,eAAAA,GAAkBL,OAAQQ,CAAAA,GAAG,CAC3Bf,OAAAA,EACAO,OAAQO,CAAAA,KAAK,CAACD,SAAAA,EAAWR,WAAc,GAAA,MAAA,EAAQ,IAAIE,OAAAA,EAAAA,CAAAA,EACnD,IAAIA,OAAAA,EAAAA,CAAAA;YAENI,SAAY,GAAA,KAAA;AACd;;AAGA,QAAA,MAAMK,wBAAwBT,OAAQC,CAAAA,GAAG,CAACI,eAAAA,EAAiBZ,SAAS,IAAIO,OAAAA,EAAAA,CAAAA;QACxE,MAAMU,QAAAA,GAAWD,sBAAsBN,SAAS;;;AAIhD,QAAA,MAAMQ,YACJ,GAAChB,CAAAA,WAAAA,GAAcA,WAAce,GAAAA,QAAAA,GAAWA,QAAWb,GAAAA,WAAAA,GAAcA,WAAU,KAC1E,CAAA,GAAIF,cAAce,QAAO,CAAA;QAC5B,MAAME,mBAAAA,GAAsB9C,KAAKC,GAAG,CAAC,EAAID,EAAAA,IAAAA,CAAKE,GAAG,CAAC,CAAG2C,EAAAA,YAAAA,CAAAA,CAAAA;QACrD,MAAME,SAAAA,GAAY/C,IAAKgD,CAAAA,IAAI,CAACF,mBAAAA,CAAAA;;QAG5B,IAAIG,UAAAA;QAEJ,IAAI,IAAI,CAACpD,WAAW,IAAI,IAAI,CAACE,WAAW,GAAG,KAAO,EAAA;;AAEhD,YAAA,MAAMmD,eAAkBhB,GAAAA,OAAAA,CAAQiB,SAAS,CAACR,uBAAuB,IAAIT,OAAAA,EAAAA,CAAAA;YACrE,MAAMkB,UAAAA,GAAalB,QAAQC,GAAG,CAAC,IAAI,CAACtC,WAAW,EAAE8B,OAAAA,EAAS,IAAIO,OAAAA,EAAAA,CAAAA;;AAG9D,YAAA,MAAMmB,gBAAmBnB,GAAAA,OAAAA,CAAQoB,GAAG,CAACF,UAAYF,EAAAA,eAAAA,CAAAA;AACjD,YAAA,MAAMK,aAAarB,OAAQO,CAAAA,KAAK,CAACS,eAAAA,EAAiBG,kBAAkB,IAAInB,OAAAA,EAAAA,CAAAA;AACxE,YAAA,MAAMsB,gBAAgBtB,OAAQC,CAAAA,GAAG,CAACiB,UAAAA,EAAYG,YAAY,IAAIrB,OAAAA,EAAAA,CAAAA;YAE9D,MAAMuB,UAAAA,GAAaD,cAAcnB,SAAS;AAC1C,YAAA,IAAIoB,aAAa,QAAU,EAAA;;AAEzBR,gBAAAA,UAAAA,GAAaf,QAAQwB,KAAK,CAACR,iBAAiBM,aAAe,EAAA,IAAItB,WAAWyB,gBAAgB,EAAA;aACrF,MAAA;;gBAELV,UAAa,GAAA,IAAI,CAACW,qBAAqB,CAACjB,qBAAAA,CAAAA;AAC1C;;AAGA,YAAA,IAAI,IAAI,CAAC5C,WAAW,GAAG,KAAO,EAAA;AAC5B,gBAAA,MAAM8D,aAAgB,GAAA,IAAI,CAACD,qBAAqB,CAACjB,qBAAAA,CAAAA;;AAEjD,gBAAA,MAAMmB,QAAQ9D,IAAKgD,CAAAA,IAAI,CAAChD,IAAAA,CAAKC,GAAG,CAAC,EAAID,EAAAA,IAAAA,CAAKE,GAAG,CAAC,CAAA,EAAGgC,OAAQoB,CAAAA,GAAG,CAACO,aAAeZ,EAAAA,UAAAA,CAAAA,CAAAA,CAAAA,CAAAA;AAC5E,gBAAA,IAAIa,QAAQ,KAAO,EAAA;oBACjB,MAAMC,IAAAA,GAAO7B,QAAQwB,KAAK,CAACG,eAAeZ,UAAY,EAAA,IAAIf,WAAWyB,gBAAgB,EAAA;oBACrF,MAAMK,QAAAA,GAAW,IAAIC,UAAaC,EAAAA,CAAAA,aAAa,CAACH,IAAMD,EAAAA,KAAAA,GAAQ,IAAI,CAAC/D,WAAW,CAAA;AAC9EkD,oBAAAA,UAAAA,GAAae,QAASG,CAAAA,SAAS,CAACN,aAAAA,EAAe,IAAI3B,OAAAA,EAAAA,CAAAA;AACrD;AACF;SACK,MAAA;;YAELe,UAAa,GAAA,IAAI,CAACW,qBAAqB,CAACjB,qBAAAA,CAAAA;AAC1C;;AAGA,QAAA,MAAMO,eAAkBhB,GAAAA,OAAAA,CAAQiB,SAAS,CAACR,uBAAuB,IAAIT,OAAAA,EAAAA,CAAAA;;AAGrE,QAAA,MAAMkC,gBAAmB,GAAA,IAAIH,UAAaC,EAAAA,CAAAA,aAAa,CAACjB,UAAYF,EAAAA,SAAAA,CAAAA;AACpE,QAAA,MAAMsB,eAAkBD,GAAAA,gBAAAA,CAAiBD,SAAS,CAACjB,iBAAiB,IAAIhB,OAAAA,EAAAA,CAAAA;;AAGxET,QAAAA,MAAAA,CAAOG,QAAQ,CAACvB,GAAG,CACjB6B,QAAQQ,GAAG,CAACf,OAASO,EAAAA,OAAAA,CAAQO,KAAK,CAAC4B,eAAAA,EAAiBxC,WAAa,EAAA,IAAIK,YAAY,IAAIA,OAAAA,EAAAA,CAAAA,CAAAA;;QAIvFR,GAAIE,CAAAA,QAAQ,CAACvB,GAAG,CAACkC,eAAAA,CAAAA;;;;AAKjB,QAAA,IAAI,CAAC+B,iBAAiB,EAAA;QAEtB,OAAOhC,SAAAA;AACT;AAEA;;;AAGC,MACD,iBAAkC,GAAA;AAChC,QAAA,MAAMiC,WAAc,GAAA,IAAI,CAAC3D,MAAM,CAAC2D,WAAW;QAC3C,IAAIA,WAAAA,CAAY5E,MAAM,KAAK,CAAG,EAAA;AAC5B,YAAA;AACF;AAEA,QAAA,MAAMD,MAAS,GAAA,IAAI,CAACkB,MAAM,CAAClB,MAAM;;QAGjC,KAAK,MAAM8E,cAAcD,WAAa,CAAA;AACpCC,YAAAA,UAAAA,CAAWC,KAAK,CAAC/E,MAAAA,CAAAA;AACnB;;;;AAKA,QAAA,IAAI,CAACgF,mBAAmB,EAAA;AAC1B;AAEA;;;AAGC,MACD,mBAAoC,GAAA;AAClC,QAAA,MAAMhF,MAAS,GAAA,IAAI,CAACkB,MAAM,CAAClB,MAAM;QACjC,MAAM8B,IAAAA,GAAO9B,MAAM,CAAC,CAAE,CAAA;QACtB,MAAM+B,MAAAA,GAAS/B,MAAM,CAAC,CAAE,CAAA;QACxB,MAAMgC,GAAAA,GAAMhC,MAAM,CAAC,CAAE,CAAA;QAErB,MAAMmC,WAAAA,GAAcL,KAAKM,UAAU;QACnC,MAAMC,WAAAA,GAAcN,OAAOK,UAAU;;QAGrC,MAAM6C,YAAAA,GAAezC,OAAQC,CAAAA,GAAG,CAACV,MAAAA,CAAOG,QAAQ,EAAEJ,IAAAA,CAAKI,QAAQ,EAAE,IAAIM,OAAAA,EAAAA,CAAAA;QACrE,MAAM0C,gBAAAA,GAAmBD,aAAatC,SAAS;AAE/C,QAAA,IAAIuC,mBAAmB,QAAY5E,IAAAA,IAAAA,CAAK6E,GAAG,CAACD,gBAAAA,GAAmB/C,eAAe,MAAQ,EAAA;AACpF,YAAA,MAAMwC,kBAAkBnC,OAAQO,CAAAA,KAAK,CAACkC,YAAc,EAAA,CAAA,GAAIC,kBAAkB,IAAI1C,OAAAA,EAAAA,CAAAA;AAC9ET,YAAAA,MAAAA,CAAOG,QAAQ,CAACvB,GAAG,CACjB6B,OAAAA,CAAQQ,GAAG,CAAClB,IAAAA,CAAKI,QAAQ,EAAEM,QAAQO,KAAK,CAAC4B,iBAAiBxC,WAAa,EAAA,IAAIK,YAAY,IAAIA,OAAAA,EAAAA,CAAAA,CAAAA;AAE/F;;QAGA,MAAM4C,WAAAA,GAAc5C,OAAQC,CAAAA,GAAG,CAACT,GAAAA,CAAIE,QAAQ,EAAEH,MAAAA,CAAOG,QAAQ,EAAE,IAAIM,OAAAA,EAAAA,CAAAA;QACnE,MAAM6C,eAAAA,GAAkBD,YAAYzC,SAAS;AAE7C,QAAA,IAAI0C,kBAAkB,QAAY/E,IAAAA,IAAAA,CAAK6E,GAAG,CAACE,eAAAA,GAAkBhD,eAAe,MAAQ,EAAA;AAClF,YAAA,MAAMiD,iBAAiB9C,OAAQO,CAAAA,KAAK,CAACqC,WAAa,EAAA,CAAA,GAAIC,iBAAiB,IAAI7C,OAAAA,EAAAA,CAAAA;AAC3ER,YAAAA,GAAAA,CAAIE,QAAQ,CAACvB,GAAG,CACd6B,OAAAA,CAAQQ,GAAG,CAACjB,MAAAA,CAAOG,QAAQ,EAAEM,QAAQO,KAAK,CAACuC,gBAAgBjD,WAAa,EAAA,IAAIG,YAAY,IAAIA,OAAAA,EAAAA,CAAAA,CAAAA;AAEhG;AACF;AAEA;;;;MAKA+C,YAAAA,CAAaC,MAAS,GAAA,CAAC,EAAQ;AAC7B,QAAA,MAAMxF,MAAS,GAAA,IAAI,CAACkB,MAAM,CAAClB,MAAM;;QAGjC,IAAK,IAAIyF,IAAI,CAAGA,EAAAA,CAAAA,GAAIzF,OAAOC,MAAM,GAAG,GAAGwF,CAAK,EAAA,CAAA;YAC1C,MAAMC,KAAAA,GAAQ1F,MAAM,CAACyF,CAAE,CAAA;AACvB,YAAA,MAAME,SAAY3F,GAAAA,MAAM,CAACyF,CAAAA,GAAI,CAAE,CAAA;;YAG/B,MAAMG,WAAAA,GAAcpD,OAAQC,CAAAA,GAAG,CAACkD,SAAAA,CAAUE,gBAAgB,EAAEH,KAAAA,CAAMG,gBAAgB,EAAE,IAAIrD,OAAAA,EAAAA,CAAAA;YACxF,MAAMsD,MAAAA,GAAStD,OAAQC,CAAAA,GAAG,CAACkD,SAAAA,CAAUzD,QAAQ,EAAEwD,KAAAA,CAAMxD,QAAQ,EAAE,IAAIM,OAAAA,EAAAA,CAAAA;AAEnE,YAAA,MAAMuD,eAAkBvD,GAAAA,OAAAA,CAAQiB,SAAS,CAACmC,aAAa,IAAIpD,OAAAA,EAAAA,CAAAA;AAC3D,YAAA,MAAMwD,UAAaxD,GAAAA,OAAAA,CAAQiB,SAAS,CAACqC,QAAQ,IAAItD,OAAAA,EAAAA,CAAAA;;AAGjD,YAAA,MAAMyD,gBAAgB,IAAI1B,UAAAA,EAAAA;YAC1B2B,OAAQC,CAAAA,cAAc,CAACJ,eAAAA,EAAiBC,UAAYC,EAAAA,aAAAA,CAAAA;;YAGpD,IAAIG,aAAAA,GAAgB7B,WAAW8B,QAAQ,CAACJ,eAAeP,KAAMY,CAAAA,gBAAgB,EAAE,IAAI/B,UAAAA,EAAAA,CAAAA;;;AAInF,YAAA,MAAMgC,QAAQ,IAAIhC,UAAAA,EAAAA;AAClB,YAAA,MAAMiC,QAAQ,IAAIjC,UAAAA,EAAAA;YAClB6B,aAAcK,CAAAA,mBAAmB,CAACT,UAAAA,EAAYO,KAAOC,EAAAA,KAAAA,CAAAA;;YAGrD,IAAIE,UAAAA,GAAaF,KAAMG,CAAAA,aAAa,CAACX,UAAAA,CAAAA;;AAGrC,YAAA,MAAMlB,aAAa,IAAI,CAACrE,iBAAiB,CAACW,GAAG,CAACqE,CAAAA,CAAAA;AAC9C,YAAA,IAAIX,UAAY,EAAA;;AAEd4B,gBAAAA,UAAAA,GAAaR,OAAQU,CAAAA,mBAAmB,CACtCF,UAAAA,EACAhB,MAAMmB,aAAa,EACnB/B,UAAWlE,CAAAA,QAAQ,EACnBkE,UAAAA,CAAWhE,QAAQ,EACnBgE,WAAW/D,YAAY,CAAA;AAE3B;;AAGA2E,YAAAA,KAAAA,CAAMmB,aAAa,GAAGH,UAAAA;;AAGtB,YAAA,MAAMI,YAAevC,GAAAA,UAAAA,CAAWC,aAAa,CAACwB,UAAYU,EAAAA,UAAAA,CAAAA;AAC1DN,YAAAA,aAAAA,GAAgB7B,UAAW8B,CAAAA,QAAQ,CAACS,YAAAA,EAAcP,KAAOH,EAAAA,aAAAA,CAAAA;;AAGzD,YAAA,IAAIZ,SAAS,CAAG,EAAA;AACdjB,gBAAAA,UAAAA,CAAWwC,KAAK,CAACrB,KAAAA,CAAMY,gBAAgB,EAAEF,eAAeZ,MAAQY,EAAAA,aAAAA,CAAAA;AAClE;;YAGA,IAAI,CAACV,KAAMsB,CAAAA,kBAAkB,EAAE;gBAC7BtB,KAAMsB,CAAAA,kBAAkB,GAAGZ,aAAAA,CAAchG,KAAK,EAAA;aACzC,MAAA;gBACLsF,KAAMsB,CAAAA,kBAAkB,CAACrG,GAAG,CAACyF,aAAAA,CAAAA;AAC/B;;AAGA,YAAA,IAAIV,KAAMuB,CAAAA,IAAI,CAACC,MAAM,EAAE;AACrB,gBAAA,MAAMC,sBAAsB,IAAI5C,UAAAA,EAAAA;gBAChCmB,KAAMuB,CAAAA,IAAI,CAACC,MAAM,CAACE,WAAW,CAACC,SAAS,CAAC,IAAA,EAAMF,mBAAqB,EAAA,IAAA,CAAA;;AAGnE,gBAAA,MAAMG,iBAAoB/C,GAAAA,UAAAA,CAAWgD,SAAS,CAACJ,qBAAqB,IAAI5C,UAAAA,EAAAA,CAAAA;AACxE,gBAAA,MAAMiD,gBAAgBjD,UAAW8B,CAAAA,QAAQ,CAACiB,iBAAAA,EAAmBlB,eAAe,IAAI7B,UAAAA,EAAAA,CAAAA;gBAEhFmB,KAAMuB,CAAAA,IAAI,CAAC3C,QAAQ,GAAGkD,aAAAA;aACjB,MAAA;;gBAEL9B,KAAMuB,CAAAA,IAAI,CAAC3C,QAAQ,GAAG8B,aAAAA;AACxB;AACF;AACF;AAEA;;;;;;MAOQlC,qBAAsB3B,CAAAA,YAAqB,EAAW;AAC5D,QAAA,MAAMiB,eAAkBhB,GAAAA,OAAAA,CAAQiB,SAAS,CAAClB,cAAc,IAAIC,OAAAA,EAAAA,CAAAA;;QAG5D,IAAIe,UAAAA,GAAaf,QAAQwB,KAAK,CAACR,iBAAiBhB,OAAQiF,CAAAA,MAAM,IAAI,IAAIjF,OAAAA,EAAAA,CAAAA;AACtE,QAAA,MAAMkF,QAAQnE,UAAWoE,CAAAA,CAAC,GAAGpE,UAAAA,CAAWoE,CAAC,GAAGpE,UAAAA,CAAWqE,CAAC,GAAGrE,WAAWqE,CAAC,GAAGrE,WAAWsE,CAAC,GAAGtE,WAAWsE,CAAC;;AAGrG,QAAA,IAAIH,QAAQ,QAAU,EAAA;AACpBnE,YAAAA,UAAAA,GAAaf,QAAQwB,KAAK,CAACR,iBAAiBhB,OAAQsF,CAAAA,MAAM,IAAI,IAAItF,OAAAA,EAAAA,CAAAA;AACpE;AAEA,QAAA,OAAOe,WAAWU,gBAAgB,EAAA;AACpC;AACF;;;;"}
+{"version":3,"file":"two_bone_ik_solver.js","sources":["../../../src/animation/ik/two_bone_ik_solver.ts"],"sourcesContent":["import { Vector3, Quaternion } from '@zephyr3d/base';\r\nimport { IKSolver } from './ik_solver';\r\nimport type { IKChain } from './ik_chain';\r\nimport { IKUtils } from './ik_utils';\r\nimport type { TwistConstraint } from './ik_constraint';\r\n\r\n/**\r\n * Two Bone IK solver for chains with exactly 3 joints (2 bones).\r\n *\r\n * @remarks\r\n * This solver uses an analytical solution specifically optimized for\r\n * two-bone chains like arms (shoulder-elbow-wrist) or legs (hip-knee-ankle).\r\n * It's faster and more stable than iterative methods like FABRIK for this case.\r\n *\r\n * The solver supports an optional pole vector to control the bending direction\r\n * of the middle joint (elbow/knee).\r\n *\r\n * @public\r\n */\r\nexport class TwoBoneIKSolver extends IKSolver {\r\n  /** Optional pole vector position in world space */\r\n  private _poleVector: Vector3 | null;\r\n  /** Weight of the pole vector constraint (0-1) */\r\n  private _poleWeight: number;\r\n  /** Twist constraints for each joint (indexed by joint index) */\r\n  private _twistConstraints: Map<number, TwistConstraint>;\r\n\r\n  /**\r\n   * Create a Two Bone IK solver.\r\n   *\r\n   * @param chain - The IK chain to solve (must have exactly 3 joints)\r\n   * @param poleVector - Optional pole vector position in world space\r\n   * @param poleWeight - Weight of the pole vector constraint (0-1, default: 1)\r\n   */\r\n  constructor(chain: IKChain, poleVector: Vector3 | null = null, poleWeight = 1) {\r\n    super(chain, 1, 0.001); // Two bone IK doesn't need iterations\r\n\r\n    if (chain.joints.length !== 3) {\r\n      throw new Error('Two Bone IK requires exactly 3 joints (2 bones)');\r\n    }\r\n\r\n    this._poleVector = poleVector ? poleVector.clone() : null;\r\n    this._poleWeight = Math.max(0, Math.min(1, poleWeight));\r\n    this._twistConstraints = new Map();\r\n\r\n    // Set default twist constraints\r\n    // Root joint (shoulder/hip) - moderate twist\r\n    this._twistConstraints.set(0, {\r\n      minTwist: -Math.PI * 0.25, // -45 degrees\r\n      maxTwist: Math.PI * 0.25, // +45 degrees\r\n      smoothFactor: 0.3\r\n    });\r\n\r\n    // Middle joint (elbow/knee) - very limited twist\r\n    this._twistConstraints.set(1, {\r\n      minTwist: -Math.PI * 0.15, // -27 degrees\r\n      maxTwist: Math.PI * 0.15, // +27 degrees\r\n      smoothFactor: 0.3\r\n    });\r\n  }\r\n\r\n  /**\r\n   * Set twist constraint for a specific joint.\r\n   *\r\n   * @param jointIndex - Index of the joint (0 = root, 1 = middle)\r\n   * @param minTwist - Minimum twist angle in radians\r\n   * @param maxTwist - Maximum twist angle in radians\r\n   * @param smoothFactor - Smoothing factor [0-1] (default: 0.3)\r\n   */\r\n  setTwistConstraint(\r\n    jointIndex: number,\r\n    minTwist: number,\r\n    maxTwist: number,\r\n    smoothFactor: number = 0.3\r\n  ): void {\r\n    if (jointIndex < 0 || jointIndex >= this._chain.joints.length - 1) {\r\n      throw new Error(`Invalid joint index: ${jointIndex}`);\r\n    }\r\n\r\n    this._twistConstraints.set(jointIndex, {\r\n      minTwist,\r\n      maxTwist,\r\n      smoothFactor: Math.max(0, Math.min(1, smoothFactor))\r\n    });\r\n  }\r\n\r\n  /**\r\n   * Get twist constraint for a specific joint.\r\n   *\r\n   * @param jointIndex - Index of the joint\r\n   * @returns Twist constraint or undefined if not set\r\n   */\r\n  getTwistConstraint(jointIndex: number): TwistConstraint | undefined {\r\n    return this._twistConstraints.get(jointIndex);\r\n  }\r\n\r\n  /**\r\n   * Remove twist constraint for a specific joint.\r\n   *\r\n   * @param jointIndex - Index of the joint\r\n   * @returns True if a constraint was removed\r\n   */\r\n  removeTwistConstraint(jointIndex: number): boolean {\r\n    return this._twistConstraints.delete(jointIndex);\r\n  }\r\n\r\n  /**\r\n   * Clear all twist constraints.\r\n   */\r\n  clearTwistConstraints(): void {\r\n    this._twistConstraints.clear();\r\n  }\r\n\r\n  /**\r\n   * Get the pole vector position.\r\n   */\r\n  get poleVector(): Vector3 | null {\r\n    return this._poleVector;\r\n  }\r\n\r\n  set poleVector(value: Vector3 | null) {\r\n    if (value) {\r\n      if (!this._poleVector) {\r\n        this._poleVector = value.clone();\r\n      } else {\r\n        this._poleVector.set(value);\r\n      }\r\n    } else {\r\n      this._poleVector = null;\r\n    }\r\n  }\r\n\r\n  /**\r\n   * Get the pole vector weight.\r\n   */\r\n  get poleWeight(): number {\r\n    return this._poleWeight;\r\n  }\r\n\r\n  set poleWeight(value: number) {\r\n    this._poleWeight = Math.max(0, Math.min(1, value));\r\n  }\r\n\r\n  /**\r\n   * Solve the IK chain to reach the target position using Two Bone IK algorithm.\r\n   *\r\n   * @param target - Target position for the end effector\r\n   * @returns True if the target is reachable, false if stretched to maximum\r\n   */\r\n  solve(target: Vector3): boolean {\r\n    const joints = this._chain.joints;\r\n\r\n    // Update joint positions from scene nodes before solving\r\n    this._chain.updateFromNodes();\r\n\r\n    // Store original positions\r\n    this._chain.storeOriginalPositions();\r\n\r\n    const root = joints[0];\r\n    const middle = joints[1];\r\n    const end = joints[2];\r\n\r\n    const rootPos = root.position;\r\n    const upperLength = root.boneLength; // Length from root to middle\r\n    const lowerLength = middle.boneLength; // Length from middle to end\r\n    const totalLength = upperLength + lowerLength;\r\n\r\n    // Calculate direction and distance from root to target\r\n    const rootToTarget = Vector3.sub(target, rootPos, new Vector3());\r\n    const targetDistance = rootToTarget.magnitude;\r\n\r\n    // Check if target is reachable\r\n    if (targetDistance < 0.000001) {\r\n      // Target is at root position, keep original pose\r\n      return true;\r\n    }\r\n\r\n    let reachable = true;\r\n\r\n    // If target is unreachable, clamp to maximum distance\r\n    let effectiveTarget = target;\r\n    if (targetDistance >= totalLength - 0.0001) {\r\n      // Stretch to maximum length\r\n      const direction = Vector3.scale(rootToTarget, 1 / targetDistance, new Vector3());\r\n      effectiveTarget = Vector3.add(\r\n        rootPos,\r\n        Vector3.scale(direction, totalLength - 0.0001, new Vector3()),\r\n        new Vector3()\r\n      );\r\n      reachable = false;\r\n    }\r\n\r\n    // Calculate the distance from root to effective target\r\n    const rootToEffectiveTarget = Vector3.sub(effectiveTarget, rootPos, new Vector3());\r\n    const distance = rootToEffectiveTarget.magnitude;\r\n\r\n    // Use law of cosines to find the angle at the root joint\r\n    // cos(rootAngle) = (a² + c² - b²) / (2ac)\r\n    const cosRootAngle =\r\n      (upperLength * upperLength + distance * distance - lowerLength * lowerLength) /\r\n      (2 * upperLength * distance);\r\n    const clampedCosRootAngle = Math.max(-1, Math.min(1, cosRootAngle));\r\n    const rootAngle = Math.acos(clampedCosRootAngle);\r\n\r\n    // Determine the plane of bending\r\n    let bendNormal: Vector3;\r\n\r\n    if (this._poleVector && this._poleWeight > 0.001) {\r\n      // Use pole vector to determine bend direction\r\n      const rootToTargetDir = Vector3.normalize(rootToEffectiveTarget, new Vector3());\r\n      const rootToPole = Vector3.sub(this._poleVector, rootPos, new Vector3());\r\n\r\n      // Project pole vector onto plane perpendicular to root-target direction\r\n      const projectionLength = Vector3.dot(rootToPole, rootToTargetDir);\r\n      const projection = Vector3.scale(rootToTargetDir, projectionLength, new Vector3());\r\n      const perpendicular = Vector3.sub(rootToPole, projection, new Vector3());\r\n\r\n      const perpLength = perpendicular.magnitude;\r\n      if (perpLength > 0.000001) {\r\n        // Bend normal is perpendicular to both root-target and pole direction\r\n        bendNormal = Vector3.cross(rootToTargetDir, perpendicular, new Vector3()).inplaceNormalize();\r\n      } else {\r\n        // Pole is on the line, use default bend direction\r\n        bendNormal = this._getDefaultBendNormal(rootToEffectiveTarget);\r\n      }\r\n\r\n      // Apply pole weight\r\n      if (this._poleWeight < 0.999) {\r\n        const defaultNormal = this._getDefaultBendNormal(rootToEffectiveTarget);\r\n        // Slerp between default and pole-based normal\r\n        const angle = Math.acos(Math.max(-1, Math.min(1, Vector3.dot(defaultNormal, bendNormal))));\r\n        if (angle > 0.001) {\r\n          const axis = Vector3.cross(defaultNormal, bendNormal, new Vector3()).inplaceNormalize();\r\n          const rotation = new Quaternion().fromAxisAngle(axis, angle * this._poleWeight);\r\n          bendNormal = rotation.transform(defaultNormal, new Vector3());\r\n        }\r\n      }\r\n    } else {\r\n      // No pole vector, use default bend direction\r\n      bendNormal = this._getDefaultBendNormal(rootToEffectiveTarget);\r\n    }\r\n\r\n    // Calculate middle joint position\r\n    const rootToTargetDir = Vector3.normalize(rootToEffectiveTarget, new Vector3());\r\n\r\n    // Rotate root-to-target direction by rootAngle around bendNormal\r\n    const rotationToMiddle = new Quaternion().fromAxisAngle(bendNormal, rootAngle);\r\n    const rootToMiddleDir = rotationToMiddle.transform(rootToTargetDir, new Vector3());\r\n\r\n    // Place middle joint\r\n    middle.position.set(\r\n      Vector3.add(rootPos, Vector3.scale(rootToMiddleDir, upperLength, new Vector3()), new Vector3())\r\n    );\r\n\r\n    // Place end joint at target\r\n    end.position.set(effectiveTarget);\r\n\r\n    // Apply constraints after solving\r\n    // Note: Constraints may modify joint positions, which could affect bone lengths\r\n    // For Two Bone IK, we apply constraints and then restore bone lengths\r\n    this._applyConstraints();\r\n\r\n    return reachable;\r\n  }\r\n\r\n  /**\r\n   * Apply all constraints to the joint chain.\r\n   * After applying constraints, we need to restore bone lengths.\r\n   */\r\n  private _applyConstraints(): void {\r\n    const constraints = this._chain.constraints;\r\n    if (constraints.length === 0) {\r\n      return;\r\n    }\r\n\r\n    const joints = this._chain.joints;\r\n\r\n    // Apply each constraint\r\n    for (const constraint of constraints) {\r\n      constraint.apply(joints);\r\n    }\r\n\r\n    // After constraints are applied, we need to restore bone lengths\r\n    // because constraints may have moved joints in ways that change bone lengths\r\n    // For Two Bone IK, we fix this by adjusting positions while maintaining the constraint\r\n    this._restoreBoneLengths();\r\n  }\r\n\r\n  /**\r\n   * Restore bone lengths after constraints have been applied.\r\n   * This ensures that the chain maintains correct bone lengths.\r\n   */\r\n  private _restoreBoneLengths(): void {\r\n    const joints = this._chain.joints;\r\n    const root = joints[0];\r\n    const middle = joints[1];\r\n    const end = joints[2];\r\n\r\n    const upperLength = root.boneLength;\r\n    const lowerLength = middle.boneLength;\r\n\r\n    // Fix middle joint position to maintain upper bone length\r\n    const rootToMiddle = Vector3.sub(middle.position, root.position, new Vector3());\r\n    const rootToMiddleDist = rootToMiddle.magnitude;\r\n\r\n    if (rootToMiddleDist > 0.000001 && Math.abs(rootToMiddleDist - upperLength) > 0.0001) {\r\n      const rootToMiddleDir = Vector3.scale(rootToMiddle, 1 / rootToMiddleDist, new Vector3());\r\n      middle.position.set(\r\n        Vector3.add(root.position, Vector3.scale(rootToMiddleDir, upperLength, new Vector3()), new Vector3())\r\n      );\r\n    }\r\n\r\n    // Fix end joint position to maintain lower bone length\r\n    const middleToEnd = Vector3.sub(end.position, middle.position, new Vector3());\r\n    const middleToEndDist = middleToEnd.magnitude;\r\n\r\n    if (middleToEndDist > 0.000001 && Math.abs(middleToEndDist - lowerLength) > 0.0001) {\r\n      const middleToEndDir = Vector3.scale(middleToEnd, 1 / middleToEndDist, new Vector3());\r\n      end.position.set(\r\n        Vector3.add(middle.position, Vector3.scale(middleToEndDir, lowerLength, new Vector3()), new Vector3())\r\n      );\r\n    }\r\n  }\r\n\r\n  /**\r\n   * Apply the solved joint positions to scene nodes as rotations.\r\n   *\r\n   * @param weight - Blend weight (0 = original, 1 = full IK, default: 1)\r\n   */\r\n  applyToNodes(weight = 1): void {\r\n    const joints = this._chain.joints;\r\n\r\n    // Apply rotation for root and middle joints (end joint doesn't need rotation)\r\n    for (let i = 0; i < joints.length - 1; i++) {\r\n      const joint = joints[i];\r\n      const nextJoint = joints[i + 1];\r\n\r\n      // Calculate direction from current joint to next joint in world space\r\n      const originalDir = Vector3.sub(nextJoint.originalPosition, joint.originalPosition, new Vector3());\r\n      const newDir = Vector3.sub(nextJoint.position, joint.position, new Vector3());\r\n\r\n      const originalDirNorm = Vector3.normalize(originalDir, new Vector3());\r\n      const newDirNorm = Vector3.normalize(newDir, new Vector3());\r\n\r\n      // Calculate basic rotation\r\n      const deltaRotation = new Quaternion();\r\n      IKUtils.fromToRotation(originalDirNorm, newDirNorm, deltaRotation);\r\n\r\n      // Calculate new world rotation\r\n      let worldRotation = Quaternion.multiply(deltaRotation, joint.originalRotation, new Quaternion());\r\n\r\n      // Apply swing-twist constraint to prevent over-rotation\r\n      // Decompose rotation around bone axis\r\n      const swing = new Quaternion();\r\n      const twist = new Quaternion();\r\n      worldRotation.decomposeSwingTwist(newDirNorm, swing, twist);\r\n\r\n      // Get twist angle\r\n      let twistAngle = twist.getTwistAngle(newDirNorm);\r\n\r\n      // Get twist constraint for this joint\r\n      const constraint = this._twistConstraints.get(i);\r\n      if (constraint) {\r\n        // Clamp and smooth twist\r\n        twistAngle = IKUtils.clampAndSmoothTwist(\r\n          twistAngle,\r\n          joint.previousTwist,\r\n          constraint.minTwist,\r\n          constraint.maxTwist,\r\n          constraint.smoothFactor\r\n        );\r\n      }\r\n\r\n      // Store for next frame\r\n      joint.previousTwist = twistAngle;\r\n\r\n      // Reconstruct rotation from clamped twist: Q = Twist * Swing\r\n      const clampedTwist = Quaternion.fromAxisAngle(newDirNorm, twistAngle);\r\n      worldRotation = Quaternion.multiply(clampedTwist, swing, worldRotation);\r\n\r\n      // Blend with original rotation based on weight\r\n      if (weight < 1) {\r\n        Quaternion.slerp(joint.originalRotation, worldRotation, weight, worldRotation);\r\n      }\r\n\r\n      // Store this frame's world rotation for next frame's twist continuity\r\n      if (!joint.previousIKRotation) {\r\n        joint.previousIKRotation = worldRotation.clone();\r\n      } else {\r\n        joint.previousIKRotation.set(worldRotation);\r\n      }\r\n\r\n      // Convert world rotation to local rotation (relative to parent)\r\n      if (joint.node.parent) {\r\n        const parentWorldRotation = new Quaternion();\r\n        joint.node.parent.worldMatrix.decompose(null, parentWorldRotation, null);\r\n\r\n        // localRotation = conjugate(parentWorldRotation) * worldRotation\r\n        const parentInvRotation = Quaternion.conjugate(parentWorldRotation, new Quaternion());\r\n        const localRotation = Quaternion.multiply(parentInvRotation, worldRotation, new Quaternion());\r\n\r\n        joint.node.rotation = localRotation;\r\n      } else {\r\n        // Root node has no parent, world rotation is local rotation\r\n        joint.node.rotation = worldRotation;\r\n      }\r\n    }\r\n  }\r\n\r\n  /**\r\n   * Get a default bend normal when no pole vector is specified.\r\n   * This tries to find a reasonable perpendicular direction.\r\n   *\r\n   * @param rootToTarget - Direction from root to target\r\n   * @returns A normalized perpendicular vector\r\n   */\r\n  private _getDefaultBendNormal(rootToTarget: Vector3): Vector3 {\r\n    const rootToTargetDir = Vector3.normalize(rootToTarget, new Vector3());\r\n\r\n    // Try to use world up (Y axis) as reference\r\n    let bendNormal = Vector3.cross(rootToTargetDir, Vector3.axisPY(), new Vector3());\r\n    const lenSq = bendNormal.x * bendNormal.x + bendNormal.y * bendNormal.y + bendNormal.z * bendNormal.z;\r\n\r\n    // If root-to-target is parallel to Y axis, use X axis instead\r\n    if (lenSq < 0.000001) {\r\n      bendNormal = Vector3.cross(rootToTargetDir, Vector3.axisPX(), new Vector3());\r\n    }\r\n\r\n    return bendNormal.inplaceNormalize();\r\n  }\r\n}\r\n"],"names":["TwoBoneIKSolver","IKSolver","chain","poleVector","poleWeight","joints","length","Error","_poleVector","clone","_poleWeight","Math","max","min","_twistConstraints","Map","set","minTwist","PI","maxTwist","smoothFactor","setTwistConstraint","jointIndex","_chain","getTwistConstraint","get","removeTwistConstraint","delete","clearTwistConstraints","clear","value","solve","target","updateFromNodes","storeOriginalPositions","root","middle","end","rootPos","position","upperLength","boneLength","lowerLength","totalLength","rootToTarget","Vector3","sub","targetDistance","magnitude","reachable","effectiveTarget","direction","scale","add","rootToEffectiveTarget","distance","cosRootAngle","clampedCosRootAngle","rootAngle","acos","bendNormal","rootToTargetDir","normalize","rootToPole","projectionLength","dot","projection","perpendicular","perpLength","cross","inplaceNormalize","_getDefaultBendNormal","defaultNormal","angle","axis","rotation","Quaternion","fromAxisAngle","transform","rotationToMiddle","rootToMiddleDir","_applyConstraints","constraints","constraint","apply","_restoreBoneLengths","rootToMiddle","rootToMiddleDist","abs","middleToEnd","middleToEndDist","middleToEndDir","applyToNodes","weight","i","joint","nextJoint","originalDir","originalPosition","newDir","originalDirNorm","newDirNorm","deltaRotation","IKUtils","fromToRotation","worldRotation","multiply","originalRotation","swing","twist","decomposeSwingTwist","twistAngle","getTwistAngle","clampAndSmoothTwist","previousTwist","clampedTwist","slerp","previousIKRotation","node","parent","parentWorldRotation","worldMatrix","decompose","parentInvRotation","conjugate","localRotation","axisPY","lenSq","x","y","z","axisPX"],"mappings":";;;;AAMA;;;;;;;;;;;;IAaO,MAAMA,eAAwBC,SAAAA,QAAAA,CAAAA;wDAEnC,WAAoC;sDAEpC,WAA4B;qEAE5B,iBAAwD;AAExD;;;;;;MAOA,WAAA,CAAYC,KAAc,EAAEC,UAAAA,GAA6B,IAAI,EAAEC,UAAAA,GAAa,CAAC,CAAE;AAC7E,QAAA,KAAK,CAACF,KAAAA,EAAO,CAAG,EAAA,KAAA,CAAA,CAAA;AAEhB,QAAA,IAAIA,KAAMG,CAAAA,MAAM,CAACC,MAAM,KAAK,CAAG,EAAA;AAC7B,YAAA,MAAM,IAAIC,KAAM,CAAA,iDAAA,CAAA;AAClB;AAEA,QAAA,IAAI,CAACC,WAAW,GAAGL,UAAaA,GAAAA,UAAAA,CAAWM,KAAK,EAAK,GAAA,IAAA;QACrD,IAAI,CAACC,WAAW,GAAGC,IAAKC,CAAAA,GAAG,CAAC,CAAGD,EAAAA,IAAAA,CAAKE,GAAG,CAAC,CAAGT,EAAAA,UAAAA,CAAAA,CAAAA;QAC3C,IAAI,CAACU,iBAAiB,GAAG,IAAIC,GAAAA,EAAAA;;;AAI7B,QAAA,IAAI,CAACD,iBAAiB,CAACE,GAAG,CAAC,CAAG,EAAA;YAC5BC,QAAU,EAAA,CAACN,IAAKO,CAAAA,EAAE,GAAG,IAAA;YACrBC,QAAUR,EAAAA,IAAAA,CAAKO,EAAE,GAAG,IAAA;YACpBE,YAAc,EAAA;AAChB,SAAA,CAAA;;AAGA,QAAA,IAAI,CAACN,iBAAiB,CAACE,GAAG,CAAC,CAAG,EAAA;YAC5BC,QAAU,EAAA,CAACN,IAAKO,CAAAA,EAAE,GAAG,IAAA;YACrBC,QAAUR,EAAAA,IAAAA,CAAKO,EAAE,GAAG,IAAA;YACpBE,YAAc,EAAA;AAChB,SAAA,CAAA;AACF;AAEA;;;;;;;MAQAC,kBAAAA,CACEC,UAAkB,EAClBL,QAAgB,EAChBE,QAAgB,EAChBC,YAAuB,GAAA,GAAG,EACpB;QACN,IAAIE,UAAAA,GAAa,CAAKA,IAAAA,UAAAA,IAAc,IAAI,CAACC,MAAM,CAAClB,MAAM,CAACC,MAAM,GAAG,CAAG,EAAA;AACjE,YAAA,MAAM,IAAIC,KAAAA,CAAM,CAAC,qBAAqB,EAAEe,UAAY,CAAA,CAAA,CAAA;AACtD;AAEA,QAAA,IAAI,CAACR,iBAAiB,CAACE,GAAG,CAACM,UAAY,EAAA;AACrCL,YAAAA,QAAAA;AACAE,YAAAA,QAAAA;AACAC,YAAAA,YAAAA,EAAcT,KAAKC,GAAG,CAAC,GAAGD,IAAKE,CAAAA,GAAG,CAAC,CAAGO,EAAAA,YAAAA,CAAAA;AACxC,SAAA,CAAA;AACF;AAEA;;;;;MAMAI,kBAAAA,CAAmBF,UAAkB,EAA+B;AAClE,QAAA,OAAO,IAAI,CAACR,iBAAiB,CAACW,GAAG,CAACH,UAAAA,CAAAA;AACpC;AAEA;;;;;MAMAI,qBAAAA,CAAsBJ,UAAkB,EAAW;AACjD,QAAA,OAAO,IAAI,CAACR,iBAAiB,CAACa,MAAM,CAACL,UAAAA,CAAAA;AACvC;AAEA;;AAEC,MACDM,qBAA8B,GAAA;QAC5B,IAAI,CAACd,iBAAiB,CAACe,KAAK,EAAA;AAC9B;AAEA;;AAEC,MACD,IAAI1B,UAA6B,GAAA;QAC/B,OAAO,IAAI,CAACK,WAAW;AACzB;IAEA,IAAIL,UAAAA,CAAW2B,KAAqB,EAAE;AACpC,QAAA,IAAIA,KAAO,EAAA;AACT,YAAA,IAAI,CAAC,IAAI,CAACtB,WAAW,EAAE;AACrB,gBAAA,IAAI,CAACA,WAAW,GAAGsB,KAAAA,CAAMrB,KAAK,EAAA;aACzB,MAAA;AACL,gBAAA,IAAI,CAACD,WAAW,CAACQ,GAAG,CAACc,KAAAA,CAAAA;AACvB;SACK,MAAA;YACL,IAAI,CAACtB,WAAW,GAAG,IAAA;AACrB;AACF;AAEA;;AAEC,MACD,IAAIJ,UAAqB,GAAA;QACvB,OAAO,IAAI,CAACM,WAAW;AACzB;IAEA,IAAIN,UAAAA,CAAW0B,KAAa,EAAE;QAC5B,IAAI,CAACpB,WAAW,GAAGC,IAAKC,CAAAA,GAAG,CAAC,CAAGD,EAAAA,IAAAA,CAAKE,GAAG,CAAC,CAAGiB,EAAAA,KAAAA,CAAAA,CAAAA;AAC7C;AAEA;;;;;MAMAC,KAAAA,CAAMC,MAAe,EAAW;AAC9B,QAAA,MAAM3B,MAAS,GAAA,IAAI,CAACkB,MAAM,CAAClB,MAAM;;QAGjC,IAAI,CAACkB,MAAM,CAACU,eAAe,EAAA;;QAG3B,IAAI,CAACV,MAAM,CAACW,sBAAsB,EAAA;QAElC,MAAMC,IAAAA,GAAO9B,MAAM,CAAC,CAAE,CAAA;QACtB,MAAM+B,MAAAA,GAAS/B,MAAM,CAAC,CAAE,CAAA;QACxB,MAAMgC,GAAAA,GAAMhC,MAAM,CAAC,CAAE,CAAA;QAErB,MAAMiC,OAAAA,GAAUH,KAAKI,QAAQ;AAC7B,QAAA,MAAMC,WAAcL,GAAAA,IAAAA,CAAKM,UAAU,CAAA;AACnC,QAAA,MAAMC,WAAcN,GAAAA,MAAAA,CAAOK,UAAU,CAAA;AACrC,QAAA,MAAME,cAAcH,WAAcE,GAAAA,WAAAA;;AAGlC,QAAA,MAAME,eAAeC,OAAQC,CAAAA,GAAG,CAACd,MAAAA,EAAQM,SAAS,IAAIO,OAAAA,EAAAA,CAAAA;QACtD,MAAME,cAAAA,GAAiBH,aAAaI,SAAS;;AAG7C,QAAA,IAAID,iBAAiB,QAAU,EAAA;;YAE7B,OAAO,IAAA;AACT;AAEA,QAAA,IAAIE,SAAY,GAAA,IAAA;;AAGhB,QAAA,IAAIC,eAAkBlB,GAAAA,MAAAA;QACtB,IAAIe,cAAAA,IAAkBJ,cAAc,MAAQ,EAAA;;AAE1C,YAAA,MAAMQ,YAAYN,OAAQO,CAAAA,KAAK,CAACR,YAAc,EAAA,CAAA,GAAIG,gBAAgB,IAAIF,OAAAA,EAAAA,CAAAA;AACtEK,YAAAA,eAAAA,GAAkBL,OAAQQ,CAAAA,GAAG,CAC3Bf,OAAAA,EACAO,OAAQO,CAAAA,KAAK,CAACD,SAAAA,EAAWR,WAAc,GAAA,MAAA,EAAQ,IAAIE,OAAAA,EAAAA,CAAAA,EACnD,IAAIA,OAAAA,EAAAA,CAAAA;YAENI,SAAY,GAAA,KAAA;AACd;;AAGA,QAAA,MAAMK,wBAAwBT,OAAQC,CAAAA,GAAG,CAACI,eAAAA,EAAiBZ,SAAS,IAAIO,OAAAA,EAAAA,CAAAA;QACxE,MAAMU,QAAAA,GAAWD,sBAAsBN,SAAS;;;AAIhD,QAAA,MAAMQ,YACJ,GAAChB,CAAAA,WAAAA,GAAcA,WAAce,GAAAA,QAAAA,GAAWA,QAAWb,GAAAA,WAAAA,GAAcA,WAAU,KAC1E,CAAA,GAAIF,cAAce,QAAO,CAAA;QAC5B,MAAME,mBAAAA,GAAsB9C,KAAKC,GAAG,CAAC,EAAID,EAAAA,IAAAA,CAAKE,GAAG,CAAC,CAAG2C,EAAAA,YAAAA,CAAAA,CAAAA;QACrD,MAAME,SAAAA,GAAY/C,IAAKgD,CAAAA,IAAI,CAACF,mBAAAA,CAAAA;;QAG5B,IAAIG,UAAAA;QAEJ,IAAI,IAAI,CAACpD,WAAW,IAAI,IAAI,CAACE,WAAW,GAAG,KAAO,EAAA;;AAEhD,YAAA,MAAMmD,eAAkBhB,GAAAA,OAAAA,CAAQiB,SAAS,CAACR,uBAAuB,IAAIT,OAAAA,EAAAA,CAAAA;YACrE,MAAMkB,UAAAA,GAAalB,QAAQC,GAAG,CAAC,IAAI,CAACtC,WAAW,EAAE8B,OAAAA,EAAS,IAAIO,OAAAA,EAAAA,CAAAA;;AAG9D,YAAA,MAAMmB,gBAAmBnB,GAAAA,OAAAA,CAAQoB,GAAG,CAACF,UAAYF,EAAAA,eAAAA,CAAAA;AACjD,YAAA,MAAMK,aAAarB,OAAQO,CAAAA,KAAK,CAACS,eAAAA,EAAiBG,kBAAkB,IAAInB,OAAAA,EAAAA,CAAAA;AACxE,YAAA,MAAMsB,gBAAgBtB,OAAQC,CAAAA,GAAG,CAACiB,UAAAA,EAAYG,YAAY,IAAIrB,OAAAA,EAAAA,CAAAA;YAE9D,MAAMuB,UAAAA,GAAaD,cAAcnB,SAAS;AAC1C,YAAA,IAAIoB,aAAa,QAAU,EAAA;;AAEzBR,gBAAAA,UAAAA,GAAaf,QAAQwB,KAAK,CAACR,iBAAiBM,aAAe,EAAA,IAAItB,WAAWyB,gBAAgB,EAAA;aACrF,MAAA;;gBAELV,UAAa,GAAA,IAAI,CAACW,qBAAqB,CAACjB,qBAAAA,CAAAA;AAC1C;;AAGA,YAAA,IAAI,IAAI,CAAC5C,WAAW,GAAG,KAAO,EAAA;AAC5B,gBAAA,MAAM8D,aAAgB,GAAA,IAAI,CAACD,qBAAqB,CAACjB,qBAAAA,CAAAA;;AAEjD,gBAAA,MAAMmB,QAAQ9D,IAAKgD,CAAAA,IAAI,CAAChD,IAAAA,CAAKC,GAAG,CAAC,EAAID,EAAAA,IAAAA,CAAKE,GAAG,CAAC,CAAA,EAAGgC,OAAQoB,CAAAA,GAAG,CAACO,aAAeZ,EAAAA,UAAAA,CAAAA,CAAAA,CAAAA,CAAAA;AAC5E,gBAAA,IAAIa,QAAQ,KAAO,EAAA;oBACjB,MAAMC,IAAAA,GAAO7B,QAAQwB,KAAK,CAACG,eAAeZ,UAAY,EAAA,IAAIf,WAAWyB,gBAAgB,EAAA;oBACrF,MAAMK,QAAAA,GAAW,IAAIC,UAAaC,EAAAA,CAAAA,aAAa,CAACH,IAAMD,EAAAA,KAAAA,GAAQ,IAAI,CAAC/D,WAAW,CAAA;AAC9EkD,oBAAAA,UAAAA,GAAae,QAASG,CAAAA,SAAS,CAACN,aAAAA,EAAe,IAAI3B,OAAAA,EAAAA,CAAAA;AACrD;AACF;SACK,MAAA;;YAELe,UAAa,GAAA,IAAI,CAACW,qBAAqB,CAACjB,qBAAAA,CAAAA;AAC1C;;AAGA,QAAA,MAAMO,eAAkBhB,GAAAA,OAAAA,CAAQiB,SAAS,CAACR,uBAAuB,IAAIT,OAAAA,EAAAA,CAAAA;;AAGrE,QAAA,MAAMkC,gBAAmB,GAAA,IAAIH,UAAaC,EAAAA,CAAAA,aAAa,CAACjB,UAAYF,EAAAA,SAAAA,CAAAA;AACpE,QAAA,MAAMsB,eAAkBD,GAAAA,gBAAAA,CAAiBD,SAAS,CAACjB,iBAAiB,IAAIhB,OAAAA,EAAAA,CAAAA;;AAGxET,QAAAA,MAAAA,CAAOG,QAAQ,CAACvB,GAAG,CACjB6B,QAAQQ,GAAG,CAACf,OAASO,EAAAA,OAAAA,CAAQO,KAAK,CAAC4B,eAAAA,EAAiBxC,WAAa,EAAA,IAAIK,YAAY,IAAIA,OAAAA,EAAAA,CAAAA,CAAAA;;QAIvFR,GAAIE,CAAAA,QAAQ,CAACvB,GAAG,CAACkC,eAAAA,CAAAA;;;;AAKjB,QAAA,IAAI,CAAC+B,iBAAiB,EAAA;QAEtB,OAAOhC,SAAAA;AACT;AAEA;;;AAGC,MACD,iBAAkC,GAAA;AAChC,QAAA,MAAMiC,WAAc,GAAA,IAAI,CAAC3D,MAAM,CAAC2D,WAAW;QAC3C,IAAIA,WAAAA,CAAY5E,MAAM,KAAK,CAAG,EAAA;AAC5B,YAAA;AACF;AAEA,QAAA,MAAMD,MAAS,GAAA,IAAI,CAACkB,MAAM,CAAClB,MAAM;;QAGjC,KAAK,MAAM8E,cAAcD,WAAa,CAAA;AACpCC,YAAAA,UAAAA,CAAWC,KAAK,CAAC/E,MAAAA,CAAAA;AACnB;;;;AAKA,QAAA,IAAI,CAACgF,mBAAmB,EAAA;AAC1B;AAEA;;;AAGC,MACD,mBAAoC,GAAA;AAClC,QAAA,MAAMhF,MAAS,GAAA,IAAI,CAACkB,MAAM,CAAClB,MAAM;QACjC,MAAM8B,IAAAA,GAAO9B,MAAM,CAAC,CAAE,CAAA;QACtB,MAAM+B,MAAAA,GAAS/B,MAAM,CAAC,CAAE,CAAA;QACxB,MAAMgC,GAAAA,GAAMhC,MAAM,CAAC,CAAE,CAAA;QAErB,MAAMmC,WAAAA,GAAcL,KAAKM,UAAU;QACnC,MAAMC,WAAAA,GAAcN,OAAOK,UAAU;;QAGrC,MAAM6C,YAAAA,GAAezC,OAAQC,CAAAA,GAAG,CAACV,MAAAA,CAAOG,QAAQ,EAAEJ,IAAAA,CAAKI,QAAQ,EAAE,IAAIM,OAAAA,EAAAA,CAAAA;QACrE,MAAM0C,gBAAAA,GAAmBD,aAAatC,SAAS;AAE/C,QAAA,IAAIuC,mBAAmB,QAAY5E,IAAAA,IAAAA,CAAK6E,GAAG,CAACD,gBAAAA,GAAmB/C,eAAe,MAAQ,EAAA;AACpF,YAAA,MAAMwC,kBAAkBnC,OAAQO,CAAAA,KAAK,CAACkC,YAAc,EAAA,CAAA,GAAIC,kBAAkB,IAAI1C,OAAAA,EAAAA,CAAAA;AAC9ET,YAAAA,MAAAA,CAAOG,QAAQ,CAACvB,GAAG,CACjB6B,OAAAA,CAAQQ,GAAG,CAAClB,IAAAA,CAAKI,QAAQ,EAAEM,QAAQO,KAAK,CAAC4B,iBAAiBxC,WAAa,EAAA,IAAIK,YAAY,IAAIA,OAAAA,EAAAA,CAAAA,CAAAA;AAE/F;;QAGA,MAAM4C,WAAAA,GAAc5C,OAAQC,CAAAA,GAAG,CAACT,GAAAA,CAAIE,QAAQ,EAAEH,MAAAA,CAAOG,QAAQ,EAAE,IAAIM,OAAAA,EAAAA,CAAAA;QACnE,MAAM6C,eAAAA,GAAkBD,YAAYzC,SAAS;AAE7C,QAAA,IAAI0C,kBAAkB,QAAY/E,IAAAA,IAAAA,CAAK6E,GAAG,CAACE,eAAAA,GAAkBhD,eAAe,MAAQ,EAAA;AAClF,YAAA,MAAMiD,iBAAiB9C,OAAQO,CAAAA,KAAK,CAACqC,WAAa,EAAA,CAAA,GAAIC,iBAAiB,IAAI7C,OAAAA,EAAAA,CAAAA;AAC3ER,YAAAA,GAAAA,CAAIE,QAAQ,CAACvB,GAAG,CACd6B,OAAAA,CAAQQ,GAAG,CAACjB,MAAAA,CAAOG,QAAQ,EAAEM,QAAQO,KAAK,CAACuC,gBAAgBjD,WAAa,EAAA,IAAIG,YAAY,IAAIA,OAAAA,EAAAA,CAAAA,CAAAA;AAEhG;AACF;AAEA;;;;MAKA+C,YAAAA,CAAaC,MAAS,GAAA,CAAC,EAAQ;AAC7B,QAAA,MAAMxF,MAAS,GAAA,IAAI,CAACkB,MAAM,CAAClB,MAAM;;QAGjC,IAAK,IAAIyF,IAAI,CAAGA,EAAAA,CAAAA,GAAIzF,OAAOC,MAAM,GAAG,GAAGwF,CAAK,EAAA,CAAA;YAC1C,MAAMC,KAAAA,GAAQ1F,MAAM,CAACyF,CAAE,CAAA;AACvB,YAAA,MAAME,SAAY3F,GAAAA,MAAM,CAACyF,CAAAA,GAAI,CAAE,CAAA;;YAG/B,MAAMG,WAAAA,GAAcpD,OAAQC,CAAAA,GAAG,CAACkD,SAAAA,CAAUE,gBAAgB,EAAEH,KAAAA,CAAMG,gBAAgB,EAAE,IAAIrD,OAAAA,EAAAA,CAAAA;YACxF,MAAMsD,MAAAA,GAAStD,OAAQC,CAAAA,GAAG,CAACkD,SAAAA,CAAUzD,QAAQ,EAAEwD,KAAAA,CAAMxD,QAAQ,EAAE,IAAIM,OAAAA,EAAAA,CAAAA;AAEnE,YAAA,MAAMuD,eAAkBvD,GAAAA,OAAAA,CAAQiB,SAAS,CAACmC,aAAa,IAAIpD,OAAAA,EAAAA,CAAAA;AAC3D,YAAA,MAAMwD,UAAaxD,GAAAA,OAAAA,CAAQiB,SAAS,CAACqC,QAAQ,IAAItD,OAAAA,EAAAA,CAAAA;;AAGjD,YAAA,MAAMyD,gBAAgB,IAAI1B,UAAAA,EAAAA;YAC1B2B,OAAQC,CAAAA,cAAc,CAACJ,eAAAA,EAAiBC,UAAYC,EAAAA,aAAAA,CAAAA;;YAGpD,IAAIG,aAAAA,GAAgB7B,WAAW8B,QAAQ,CAACJ,eAAeP,KAAMY,CAAAA,gBAAgB,EAAE,IAAI/B,UAAAA,EAAAA,CAAAA;;;AAInF,YAAA,MAAMgC,QAAQ,IAAIhC,UAAAA,EAAAA;AAClB,YAAA,MAAMiC,QAAQ,IAAIjC,UAAAA,EAAAA;YAClB6B,aAAcK,CAAAA,mBAAmB,CAACT,UAAAA,EAAYO,KAAOC,EAAAA,KAAAA,CAAAA;;YAGrD,IAAIE,UAAAA,GAAaF,KAAMG,CAAAA,aAAa,CAACX,UAAAA,CAAAA;;AAGrC,YAAA,MAAMlB,aAAa,IAAI,CAACrE,iBAAiB,CAACW,GAAG,CAACqE,CAAAA,CAAAA;AAC9C,YAAA,IAAIX,UAAY,EAAA;;AAEd4B,gBAAAA,UAAAA,GAAaR,OAAQU,CAAAA,mBAAmB,CACtCF,UAAAA,EACAhB,MAAMmB,aAAa,EACnB/B,UAAWlE,CAAAA,QAAQ,EACnBkE,UAAAA,CAAWhE,QAAQ,EACnBgE,WAAW/D,YAAY,CAAA;AAE3B;;AAGA2E,YAAAA,KAAAA,CAAMmB,aAAa,GAAGH,UAAAA;;AAGtB,YAAA,MAAMI,YAAevC,GAAAA,UAAAA,CAAWC,aAAa,CAACwB,UAAYU,EAAAA,UAAAA,CAAAA;AAC1DN,YAAAA,aAAAA,GAAgB7B,UAAW8B,CAAAA,QAAQ,CAACS,YAAAA,EAAcP,KAAOH,EAAAA,aAAAA,CAAAA;;AAGzD,YAAA,IAAIZ,SAAS,CAAG,EAAA;AACdjB,gBAAAA,UAAAA,CAAWwC,KAAK,CAACrB,KAAAA,CAAMY,gBAAgB,EAAEF,eAAeZ,MAAQY,EAAAA,aAAAA,CAAAA;AAClE;;YAGA,IAAI,CAACV,KAAMsB,CAAAA,kBAAkB,EAAE;gBAC7BtB,KAAMsB,CAAAA,kBAAkB,GAAGZ,aAAAA,CAAchG,KAAK,EAAA;aACzC,MAAA;gBACLsF,KAAMsB,CAAAA,kBAAkB,CAACrG,GAAG,CAACyF,aAAAA,CAAAA;AAC/B;;AAGA,YAAA,IAAIV,KAAMuB,CAAAA,IAAI,CAACC,MAAM,EAAE;AACrB,gBAAA,MAAMC,sBAAsB,IAAI5C,UAAAA,EAAAA;gBAChCmB,KAAMuB,CAAAA,IAAI,CAACC,MAAM,CAACE,WAAW,CAACC,SAAS,CAAC,IAAA,EAAMF,mBAAqB,EAAA,IAAA,CAAA;;AAGnE,gBAAA,MAAMG,iBAAoB/C,GAAAA,UAAAA,CAAWgD,SAAS,CAACJ,qBAAqB,IAAI5C,UAAAA,EAAAA,CAAAA;AACxE,gBAAA,MAAMiD,gBAAgBjD,UAAW8B,CAAAA,QAAQ,CAACiB,iBAAAA,EAAmBlB,eAAe,IAAI7B,UAAAA,EAAAA,CAAAA;gBAEhFmB,KAAMuB,CAAAA,IAAI,CAAC3C,QAAQ,GAAGkD,aAAAA;aACjB,MAAA;;gBAEL9B,KAAMuB,CAAAA,IAAI,CAAC3C,QAAQ,GAAG8B,aAAAA;AACxB;AACF;AACF;AAEA;;;;;;MAOQlC,qBAAsB3B,CAAAA,YAAqB,EAAW;AAC5D,QAAA,MAAMiB,eAAkBhB,GAAAA,OAAAA,CAAQiB,SAAS,CAAClB,cAAc,IAAIC,OAAAA,EAAAA,CAAAA;;QAG5D,IAAIe,UAAAA,GAAaf,QAAQwB,KAAK,CAACR,iBAAiBhB,OAAQiF,CAAAA,MAAM,IAAI,IAAIjF,OAAAA,EAAAA,CAAAA;AACtE,QAAA,MAAMkF,QAAQnE,UAAWoE,CAAAA,CAAC,GAAGpE,UAAAA,CAAWoE,CAAC,GAAGpE,UAAAA,CAAWqE,CAAC,GAAGrE,WAAWqE,CAAC,GAAGrE,WAAWsE,CAAC,GAAGtE,WAAWsE,CAAC;;AAGrG,QAAA,IAAIH,QAAQ,QAAU,EAAA;AACpBnE,YAAAA,UAAAA,GAAaf,QAAQwB,KAAK,CAACR,iBAAiBhB,OAAQsF,CAAAA,MAAM,IAAI,IAAItF,OAAAA,EAAAA,CAAAA;AACpE;AAEA,QAAA,OAAOe,WAAWU,gBAAgB,EAAA;AACpC;AACF;;;;"}

package/dist/animation/joint_dynamics/collision.js

@@ -162,7 +162,11 @@ function writeNearestPointsResult(out, tP, tQ, pointOnP, pointOnQ, sqrDistance,
     return out;
 }
 // Pushout (keep point outside collider)
-function pushoutFromSphere(center, radius, pointRadius, point, out) {
+/**
+ * Pushes a point out of a sphere collider.
+ *
+ * @public
+ */ function pushoutFromSphere(center, radius, pointRadius, point, out) {
     const direction = Vector3.sub(point, center, _pushoutSphereDirection);
     const sqrLen = direction.magnitudeSq;
     if (sqrLen > EPSILON) {
@@ -175,13 +179,21 @@ function pushoutFromSphere(center, radius, pointRadius, point, out) {
     }
     return writeCollisionResult(out, false, point, !out);
 }
-function pushoutFromCollider(colR, colRW, point, ptR, out) {
+/**
+ * Pushes a point out of a collider.
+ *
+ * @public
+ */ function pushoutFromCollider(colR, colRW, point, ptR, out) {
     if (colR.height <= EPSILON) {
         return pushoutFromSphere(colRW.positionCurrent, colRW.radius, ptR.pointRadius, point, out);
     }
     return pushoutFromCapsule(colR, colRW, point, ptR, out);
 }
-function pushoutFromCapsule(colR, colRW, point, ptR, out) {
+/**
+ * Pushes a point out of a capsule collider.
+ *
+ * @public
+ */ function pushoutFromCapsule(colR, colRW, point, ptR, out) {
     const capsuleVec = colRW.directionCurrent;
     const capsuleVecN = Vector3.normalize(capsuleVec, _pushoutCapsuleVecN);
     const capsulePos = colRW.positionCurrent;
@@ -210,7 +222,11 @@ function pushoutFromCapsule(colR, colRW, point, ptR, out) {
     return writeCollisionResult(out, false, point, !out);
 }
 // PushIn (keep point inside collider - inverse mode)
-function pushInFromSphere(center, radius, point, out) {
+/**
+ * Pulls a point inside a sphere collider.
+ *
+ * @public
+ */ function pushInFromSphere(center, radius, point, out) {
     const direction = Vector3.sub(center, point, _pushInSphereDirection);
     const sqrLen = direction.magnitudeSq;
     if (sqrLen > EPSILON && sqrLen > radius * radius) {
@@ -222,13 +238,21 @@ function pushInFromSphere(center, radius, point, out) {
     }
     return writeCollisionResult(out, false, point, !out);
 }
-function pushInFromCollider(colR, colRW, point, out) {
+/**
+ * Pulls a point inside a collider.
+ *
+ * @public
+ */ function pushInFromCollider(colR, colRW, point, out) {
     if (colR.height <= EPSILON) {
         return pushInFromSphere(colRW.positionCurrent, colRW.radius, point, out);
     }
     return pushInFromCapsule(colR, colRW, point, out);
 }
-function pushInFromCapsule(colR, colRW, point, out) {
+/**
+ * Pulls a point inside a capsule collider.
+ *
+ * @public
+ */ function pushInFromCapsule(colR, colRW, point, out) {
     const capsuleVec = colRW.directionCurrent;
     const capsuleVecN = Vector3.normalize(capsuleVec, _pushInCapsuleVecN);
     const capsulePos = colRW.positionCurrent;
@@ -258,7 +282,11 @@ function pushInFromCapsule(colR, colRW, point, out) {
     return writeCollisionResult(out, false, point, !out);
 }
 // Line segment vs collider detection
-function collisionDetectionSphere(center, radius, point1, point2, out) {
+/**
+ * Performs sphere collision detection.
+ *
+ * @public
+ */ function collisionDetectionSphere(center, radius, point1, point2, out) {
     const dir = Vector3.sub(point2, point1, _collisionSphereDir);
     const dirLen = dir.magnitude;
     if (dirLen < EPSILON) {
@@ -274,7 +302,11 @@ function collisionDetectionSphere(center, radius, point1, point2, out) {
     const hit = diff.magnitudeSq <= radius * radius;
     return writeLineCollisionResult(out, hit, ptOnLine, center, radius, !out);
 }
-function collisionDetectionCapsule(colR, colRW, point1, point2, out) {
+/**
+ * Performs capsule collision detection.
+ *
+ * @public
+ */ function collisionDetectionCapsule(colR, colRW, point1, point2, out) {
     const capsuleDir = colRW.directionCurrent;
     const capsulePos = colRW.positionCurrent;
     let res = collisionDetectionSphere(capsulePos, colRW.radius, point1, point2, out);
@@ -302,13 +334,21 @@ function collisionDetectionCapsule(colR, colRW, point1, point2, out) {
     const hit = diff.magnitudeSq <= r * r;
     return writeLineCollisionResult(out, hit, ptOnLine, ptOnCol, r, !out);
 }
-function collisionDetection(colR, colRW, point1, point2, out) {
+/**
+ * Performs collision detection against the specified collider.
+ *
+ * @public
+ */ function collisionDetection(colR, colRW, point1, point2, out) {
     if (colR.height <= EPSILON) {
         return collisionDetectionSphere(colRW.positionCurrent, colRW.radius, point1, point2, out);
     }
     return collisionDetectionCapsule(colR, colRW, point1, point2, out);
 }
-function pushInCollisionDetection(colR, colRW, point1, point2, out) {
+/**
+ * Performs inward collision detection.
+ *
+ * @public
+ */ function pushInCollisionDetection(colR, colRW, point1, point2, out) {
     if (colR.height <= EPSILON) {
         return collisionDetectionSphere(colRW.positionCurrent, colRW.radius, point1, point2, out);
     }
@@ -317,7 +357,11 @@ function pushInCollisionDetection(colR, colRW, point1, point2, out) {
     return res;
 }
 // Nearest points between two line segments
-function computeNearestPoints(posP, dirP, posQ, dirQ, out) {
+/**
+ * Computes the nearest points between two segments.
+ *
+ * @public
+ */ function computeNearestPoints(posP, dirP, posQ, dirQ, out) {
     const cross0 = Vector3.cross(dirQ, dirP, _nearestCross0);
     const n1 = Vector3.cross(dirP, cross0, _nearestN1);
     const cross1 = Vector3.cross(dirP, dirQ, _nearestCross1);
@@ -335,7 +379,11 @@ function computeNearestPoints(posP, dirP, posQ, dirQ, out) {
     return writeNearestPointsResult(out, tP, tQ, pointOnP, pointOnQ, diff.magnitudeSq, !out);
 }
 // Surface collision (triangle-based)
-function checkSurfaceCollision(ptA, ptB, ptC, colliderPos, colR, colRW, out) {
+/**
+ * Checks triangle-surface collision against a collider.
+ *
+ * @public
+ */ function checkSurfaceCollision(ptA, ptB, ptC, colliderPos, colR, colRW, out) {
     _surfaceNoHit.hit = false;
     _surfaceNoHit.intersectionPoint.setXYZ(0, 0, 0);
     _surfaceNoHit.pushOut.setXYZ(0, 0, 0);

package/dist/animation/joint_dynamics/collision.js.map

@@ -1 +1 @@
-{"version":3,"file":"collision.js","sources":["../../../src/animation/joint_dynamics/collision.ts"],"sourcesContent":["// Collision detection & response - direct port of SPCRJointDynamicsJob.cs Collision class\r\n\r\nimport { Vector3 } from '@zephyr3d/base';\r\nimport type { ColliderR, ColliderRW, PointR } from './types';\r\nimport { EPSILON, ColliderForce } from './types';\r\n\r\nexport interface CollisionResult {\r\n  hit: boolean;\r\n  point: Vector3;\r\n}\r\n\r\nexport interface LineCollisionResult {\r\n  hit: boolean;\r\n  pointOnLine: Vector3;\r\n  pointOnCollider: Vector3;\r\n  radius: number;\r\n}\r\n\r\nexport interface SurfaceCheckResult {\r\n  hit: boolean;\r\n  intersectionPoint: Vector3;\r\n  pushOut: Vector3;\r\n  pointOnCollider: Vector3;\r\n  radius: number;\r\n}\r\n\r\nexport interface NearestPointsResult {\r\n  tP: number;\r\n  tQ: number;\r\n  pointOnP: Vector3;\r\n  pointOnQ: Vector3;\r\n  sqrDistance: number;\r\n}\r\n\r\nconst _pushoutSphereDirection = new Vector3();\r\nconst _pushoutSphereScaled = new Vector3();\r\nconst _pushoutCapsuleVecN = new Vector3();\r\nconst _pushoutCapsuleTargetVec = new Vector3();\r\nconst _pushoutCapsuleTail = new Vector3();\r\nconst _pushoutCapsulePosOnVec = new Vector3();\r\nconst _pushoutCapsulePushVec = new Vector3();\r\nconst _pushoutCapsuleScaled = new Vector3();\r\nconst _pushInSphereDirection = new Vector3();\r\nconst _pushInSphereDirectionN = new Vector3();\r\nconst _pushInSphereScaled = new Vector3();\r\nconst _pushInCapsuleVecN = new Vector3();\r\nconst _pushInCapsuleTargetVec = new Vector3();\r\nconst _pushInCapsuleTail = new Vector3();\r\nconst _pushInCapsulePosOnVec = new Vector3();\r\nconst _pushInCapsulePullVec = new Vector3();\r\nconst _pushInCapsulePullVecN = new Vector3();\r\nconst _pushInCapsuleScaled = new Vector3();\r\nconst _collisionSphereDir = new Vector3();\r\nconst _collisionSphereDirN = new Vector3();\r\nconst _collisionSphereToCenter = new Vector3();\r\nconst _collisionSphereScaled = new Vector3();\r\nconst _collisionSphereDiff = new Vector3();\r\nconst _collisionCapsuleTail = new Vector3();\r\nconst _collisionCapsulePointDir = new Vector3();\r\nconst _collisionCapsulePtOnCol = new Vector3();\r\nconst _collisionCapsulePtOnLine = new Vector3();\r\nconst _collisionCapsuleDiff = new Vector3();\r\nconst _collisionCapsuleTempLineResult: LineCollisionResult = {\r\n  hit: false,\r\n  pointOnLine: new Vector3(),\r\n  pointOnCollider: new Vector3(),\r\n  radius: 0\r\n};\r\nconst _nearestCross0 = new Vector3();\r\nconst _nearestCross1 = new Vector3();\r\nconst _nearestN1 = new Vector3();\r\nconst _nearestN2 = new Vector3();\r\nconst _nearestPosDiff = new Vector3();\r\nconst _nearestPointOnP = new Vector3();\r\nconst _nearestPointOnQ = new Vector3();\r\nconst _nearestPointDiff = new Vector3();\r\nconst _nearestResult: NearestPointsResult = {\r\n  tP: 0,\r\n  tQ: 0,\r\n  pointOnP: new Vector3(),\r\n  pointOnQ: new Vector3(),\r\n  sqrDistance: 0\r\n};\r\nconst _surfaceNoHit: SurfaceCheckResult = {\r\n  hit: false,\r\n  intersectionPoint: new Vector3(),\r\n  pushOut: new Vector3(),\r\n  pointOnCollider: new Vector3(),\r\n  radius: 0\r\n};\r\nconst _surfaceTriCenter = new Vector3();\r\nconst _surfaceEdgeAB = new Vector3();\r\nconst _surfaceEdgeAC = new Vector3();\r\nconst _surfacePlaneNormal = new Vector3();\r\nconst _surfacePlaneNormalNeg = new Vector3();\r\nconst _surfaceColliderDir = new Vector3();\r\nconst _surfaceRayDir = new Vector3();\r\nconst _surfaceRayDirN = new Vector3();\r\nconst _surfaceTail = new Vector3();\r\nconst _surfaceIntersection = new Vector3();\r\nconst _surfacePushOut = new Vector3();\r\nconst _surfaceToCol = new Vector3();\r\nconst _surfaceEndVec = new Vector3();\r\nconst _surfaceColDirVec = new Vector3();\r\nconst _surfaceIntersecToEnd = new Vector3();\r\nconst _surfaceColToEnd = new Vector3();\r\nconst _surfaceColToIntersect = new Vector3();\r\nconst _surfaceEVec = new Vector3();\r\nconst _surfacePoc2 = new Vector3();\r\nconst _triangleAp = new Vector3();\r\nconst _triangleBp = new Vector3();\r\nconst _triangleCp = new Vector3();\r\nconst _triangleU = new Vector3();\r\nconst _triangleV = new Vector3();\r\nconst _triangleW = new Vector3();\r\n\r\nfunction writeCollisionResult(\r\n  out: CollisionResult | undefined,\r\n  hit: boolean,\r\n  point: Vector3,\r\n  copyPoint: boolean\r\n) {\r\n  if (!out) {\r\n    return { hit, point: copyPoint ? point.clone() : point };\r\n  }\r\n  if (!out.point) {\r\n    out.point = new Vector3();\r\n  }\r\n  out.hit = hit;\r\n  out.point.set(point);\r\n  return out;\r\n}\r\n\r\nfunction writeLineCollisionResult(\r\n  out: LineCollisionResult | undefined,\r\n  hit: boolean,\r\n  pointOnLine: Vector3,\r\n  pointOnCollider: Vector3,\r\n  radius: number,\r\n  copyVectors: boolean\r\n) {\r\n  if (!out) {\r\n    return {\r\n      hit,\r\n      pointOnLine: copyVectors ? pointOnLine.clone() : pointOnLine,\r\n      pointOnCollider: copyVectors ? pointOnCollider.clone() : pointOnCollider,\r\n      radius\r\n    };\r\n  }\r\n  if (!out.pointOnLine) {\r\n    out.pointOnLine = new Vector3();\r\n  }\r\n  if (!out.pointOnCollider) {\r\n    out.pointOnCollider = new Vector3();\r\n  }\r\n  out.hit = hit;\r\n  out.pointOnLine.set(pointOnLine);\r\n  out.pointOnCollider.set(pointOnCollider);\r\n  out.radius = radius;\r\n  return out;\r\n}\r\n\r\nfunction writeSurfaceCheckResult(\r\n  out: SurfaceCheckResult | undefined,\r\n  hit: boolean,\r\n  intersectionPoint: Vector3,\r\n  pushOut: Vector3,\r\n  pointOnCollider: Vector3,\r\n  radius: number,\r\n  copyVectors: boolean\r\n) {\r\n  if (!out) {\r\n    return {\r\n      hit,\r\n      intersectionPoint: copyVectors ? intersectionPoint.clone() : intersectionPoint,\r\n      pushOut: copyVectors ? pushOut.clone() : pushOut,\r\n      pointOnCollider: copyVectors ? pointOnCollider.clone() : pointOnCollider,\r\n      radius\r\n    };\r\n  }\r\n  if (!out.intersectionPoint) {\r\n    out.intersectionPoint = new Vector3();\r\n  }\r\n  if (!out.pushOut) {\r\n    out.pushOut = new Vector3();\r\n  }\r\n  if (!out.pointOnCollider) {\r\n    out.pointOnCollider = new Vector3();\r\n  }\r\n  out.hit = hit;\r\n  out.intersectionPoint.set(intersectionPoint);\r\n  out.pushOut.set(pushOut);\r\n  out.pointOnCollider.set(pointOnCollider);\r\n  out.radius = radius;\r\n  return out;\r\n}\r\n\r\nfunction writeNearestPointsResult(\r\n  out: NearestPointsResult | undefined,\r\n  tP: number,\r\n  tQ: number,\r\n  pointOnP: Vector3,\r\n  pointOnQ: Vector3,\r\n  sqrDistance: number,\r\n  copyVectors: boolean\r\n) {\r\n  if (!out) {\r\n    return {\r\n      tP,\r\n      tQ,\r\n      pointOnP: copyVectors ? pointOnP.clone() : pointOnP,\r\n      pointOnQ: copyVectors ? pointOnQ.clone() : pointOnQ,\r\n      sqrDistance\r\n    };\r\n  }\r\n  out.tP = tP;\r\n  out.tQ = tQ;\r\n  out.pointOnP.set(pointOnP);\r\n  out.pointOnQ.set(pointOnQ);\r\n  out.sqrDistance = sqrDistance;\r\n  return out;\r\n}\r\n\r\n// Pushout (keep point outside collider)\r\n\r\nexport function pushoutFromSphere(\r\n  center: Vector3,\r\n  radius: number,\r\n  pointRadius: number,\r\n  point: Vector3,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  const direction = Vector3.sub(point, center, _pushoutSphereDirection);\r\n  const sqrLen = direction.magnitudeSq;\r\n  if (sqrLen > EPSILON) {\r\n    const dirLen = Math.sqrt(sqrLen) - pointRadius;\r\n    if (dirLen < radius) {\r\n      const scaled = Vector3.scale(direction, radius / dirLen, _pushoutSphereScaled);\r\n      Vector3.add(center, scaled, scaled);\r\n      return writeCollisionResult(out, true, scaled, !out);\r\n    }\r\n  }\r\n  return writeCollisionResult(out, false, point, !out);\r\n}\r\n\r\nexport function pushoutFromCollider(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point: Vector3,\r\n  ptR: PointR,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  if (colR.height <= EPSILON) {\r\n    return pushoutFromSphere(colRW.positionCurrent, colRW.radius, ptR.pointRadius, point, out);\r\n  }\r\n  return pushoutFromCapsule(colR, colRW, point, ptR, out);\r\n}\r\n\r\nexport function pushoutFromCapsule(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point: Vector3,\r\n  ptR: PointR,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  const capsuleVec = colRW.directionCurrent;\r\n  const capsuleVecN = Vector3.normalize(capsuleVec, _pushoutCapsuleVecN);\r\n  const capsulePos = colRW.positionCurrent;\r\n  const targetVec = Vector3.sub(point, capsulePos, _pushoutCapsuleTargetVec);\r\n  const distOnVec = Vector3.dot(capsuleVecN, targetVec);\r\n\r\n  if (distOnVec <= EPSILON) {\r\n    return pushoutFromSphere(capsulePos, colRW.radius, ptR.pointRadius, point, out);\r\n  }\r\n  if (distOnVec >= colR.height) {\r\n    const tail = Vector3.add(capsulePos, capsuleVec, _pushoutCapsuleTail);\r\n    return pushoutFromSphere(tail, colRW.radius * colR.radiusTailScale, ptR.pointRadius, point, out);\r\n  }\r\n\r\n  const posOnVec = Vector3.scale(capsuleVecN, distOnVec, _pushoutCapsulePosOnVec);\r\n  Vector3.add(capsulePos, posOnVec, posOnVec);\r\n  const pushVec = Vector3.sub(point, posOnVec, _pushoutCapsulePushVec);\r\n  const sqrPushDist = pushVec.magnitudeSq;\r\n  if (sqrPushDist > EPSILON) {\r\n    const pushDist = Math.sqrt(sqrPushDist) - ptR.pointRadius;\r\n    const r = colRW.radius * lerp(1.0, colR.radiusTailScale, distOnVec / colR.height);\r\n    if (pushDist < r) {\r\n      const scaled = Vector3.scale(pushVec, r / pushDist, _pushoutCapsuleScaled);\r\n      Vector3.add(posOnVec, scaled, scaled);\r\n      return writeCollisionResult(out, true, scaled, !out);\r\n    }\r\n  }\r\n  return writeCollisionResult(out, false, point, !out);\r\n}\r\n\r\n// PushIn (keep point inside collider - inverse mode)\r\n\r\nexport function pushInFromSphere(\r\n  center: Vector3,\r\n  radius: number,\r\n  point: Vector3,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  const direction = Vector3.sub(center, point, _pushInSphereDirection);\r\n  const sqrLen = direction.magnitudeSq;\r\n  if (sqrLen > EPSILON && sqrLen > radius * radius) {\r\n    const dirLen = Math.sqrt(sqrLen);\r\n    const directionN = Vector3.normalize(direction, _pushInSphereDirectionN);\r\n    const scaled = Vector3.scale(directionN, dirLen - radius, _pushInSphereScaled);\r\n    Vector3.add(point, scaled, scaled);\r\n    return writeCollisionResult(out, true, scaled, !out);\r\n  }\r\n  return writeCollisionResult(out, false, point, !out);\r\n}\r\n\r\nexport function pushInFromCollider(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point: Vector3,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  if (colR.height <= EPSILON) {\r\n    return pushInFromSphere(colRW.positionCurrent, colRW.radius, point, out);\r\n  }\r\n  return pushInFromCapsule(colR, colRW, point, out);\r\n}\r\n\r\nexport function pushInFromCapsule(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point: Vector3,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  const capsuleVec = colRW.directionCurrent;\r\n  const capsuleVecN = Vector3.normalize(capsuleVec, _pushInCapsuleVecN);\r\n  const capsulePos = colRW.positionCurrent;\r\n  const targetVec = Vector3.sub(point, capsulePos, _pushInCapsuleTargetVec);\r\n  const distOnVec = Vector3.dot(capsuleVecN, targetVec);\r\n\r\n  if (distOnVec <= EPSILON) {\r\n    return pushInFromSphere(capsulePos, colRW.radius, point, out);\r\n  }\r\n  if (distOnVec >= colR.height) {\r\n    const tail = Vector3.add(capsulePos, capsuleVec, _pushInCapsuleTail);\r\n    return pushInFromSphere(tail, colRW.radius * colR.radiusTailScale, point, out);\r\n  }\r\n\r\n  const posOnVec = Vector3.scale(capsuleVecN, distOnVec, _pushInCapsulePosOnVec);\r\n  Vector3.add(capsulePos, posOnVec, posOnVec);\r\n  const pullVec = Vector3.sub(posOnVec, point, _pushInCapsulePullVec);\r\n  const sqrPullDist = pullVec.magnitudeSq;\r\n  if (sqrPullDist > EPSILON) {\r\n    const r = colRW.radius * lerp(1.0, colR.radiusTailScale, colR.height / distOnVec);\r\n    if (sqrPullDist > r * r) {\r\n      const pullDist = Math.sqrt(sqrPullDist);\r\n      const pullVecN = Vector3.normalize(pullVec, _pushInCapsulePullVecN);\r\n      const scaled = Vector3.scale(pullVecN, pullDist - r, _pushInCapsuleScaled);\r\n      Vector3.add(point, scaled, scaled);\r\n      return writeCollisionResult(out, true, scaled, !out);\r\n    }\r\n  }\r\n  return writeCollisionResult(out, false, point, !out);\r\n}\r\n\r\n// Line segment vs collider detection\r\n\r\nexport function collisionDetectionSphere(\r\n  center: Vector3,\r\n  radius: number,\r\n  point1: Vector3,\r\n  point2: Vector3,\r\n  out?: LineCollisionResult\r\n): LineCollisionResult {\r\n  const dir = Vector3.sub(point2, point1, _collisionSphereDir);\r\n  const dirLen = dir.magnitude;\r\n  if (dirLen < EPSILON) {\r\n    return writeLineCollisionResult(out, false, point1, center, radius, !out);\r\n  }\r\n  const dirN = Vector3.scale(dir, 1 / dirLen, _collisionSphereDirN);\r\n  const toCenter = Vector3.sub(center, point1, _collisionSphereToCenter);\r\n  const dot = Vector3.dot(dirN, toCenter);\r\n  const clamped = Math.max(0, Math.min(dot, dirLen));\r\n  const ptOnLine = Vector3.scale(dirN, clamped, _collisionSphereScaled);\r\n  Vector3.add(point1, ptOnLine, ptOnLine);\r\n  const diff = Vector3.sub(center, ptOnLine, _collisionSphereDiff);\r\n  const hit = diff.magnitudeSq <= radius * radius;\r\n  return writeLineCollisionResult(out, hit, ptOnLine, center, radius, !out);\r\n}\r\n\r\nexport function collisionDetectionCapsule(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point1: Vector3,\r\n  point2: Vector3,\r\n  out?: LineCollisionResult\r\n): LineCollisionResult {\r\n  const capsuleDir = colRW.directionCurrent;\r\n  const capsulePos = colRW.positionCurrent;\r\n\r\n  let res = collisionDetectionSphere(capsulePos, colRW.radius, point1, point2, out);\r\n  if (res.hit) {\r\n    return res;\r\n  }\r\n\r\n  const tail = Vector3.add(capsulePos, capsuleDir, _collisionCapsuleTail);\r\n  res = collisionDetectionSphere(\r\n    tail,\r\n    colRW.radius * colR.radiusTailScale,\r\n    point1,\r\n    point2,\r\n    _collisionCapsuleTempLineResult\r\n  );\r\n  if (res.hit) {\r\n    return writeLineCollisionResult(out, true, res.pointOnLine, res.pointOnCollider, res.radius, !out);\r\n  }\r\n\r\n  const pointDir = Vector3.sub(point2, point1, _collisionCapsulePointDir);\r\n  const nearest = computeNearestPoints(capsulePos, capsuleDir, point1, pointDir, _nearestResult);\r\n  const t1 = Math.max(0, Math.min(1, nearest.tP));\r\n  const r = colRW.radius * lerp(1.0, colR.radiusTailScale, t1);\r\n\r\n  if (nearest.sqrDistance > r * r) {\r\n    return writeLineCollisionResult(out, false, point1, capsulePos, r, !out);\r\n  }\r\n\r\n  const t2 = Math.max(0, Math.min(1, nearest.tQ));\r\n  const ptOnCol = Vector3.scale(capsuleDir, t1, _collisionCapsulePtOnCol);\r\n  Vector3.add(capsulePos, ptOnCol, ptOnCol);\r\n  const ptOnLine = Vector3.scale(pointDir, t2, _collisionCapsulePtOnLine);\r\n  Vector3.add(point1, ptOnLine, ptOnLine);\r\n  const diff = Vector3.sub(ptOnCol, ptOnLine, _collisionCapsuleDiff);\r\n  const hit = diff.magnitudeSq <= r * r;\r\n  return writeLineCollisionResult(out, hit, ptOnLine, ptOnCol, r, !out);\r\n}\r\n\r\nexport function collisionDetection(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point1: Vector3,\r\n  point2: Vector3,\r\n  out?: LineCollisionResult\r\n): LineCollisionResult {\r\n  if (colR.height <= EPSILON) {\r\n    return collisionDetectionSphere(colRW.positionCurrent, colRW.radius, point1, point2, out);\r\n  }\r\n  return collisionDetectionCapsule(colR, colRW, point1, point2, out);\r\n}\r\n\r\nexport function pushInCollisionDetection(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point1: Vector3,\r\n  point2: Vector3,\r\n  out?: LineCollisionResult\r\n): LineCollisionResult {\r\n  if (colR.height <= EPSILON) {\r\n    return collisionDetectionSphere(colRW.positionCurrent, colRW.radius, point1, point2, out);\r\n  }\r\n  const res = collisionDetectionCapsule(colR, colRW, point1, point2, out);\r\n  res.hit = false;\r\n  return res;\r\n}\r\n\r\n// Nearest points between two line segments\r\n\r\nexport function computeNearestPoints(\r\n  posP: Vector3,\r\n  dirP: Vector3,\r\n  posQ: Vector3,\r\n  dirQ: Vector3,\r\n  out?: NearestPointsResult\r\n): {\r\n  tP: number;\r\n  tQ: number;\r\n  pointOnP: Vector3;\r\n  pointOnQ: Vector3;\r\n  sqrDistance: number;\r\n} {\r\n  const cross0 = Vector3.cross(dirQ, dirP, _nearestCross0);\r\n  const n1 = Vector3.cross(dirP, cross0, _nearestN1);\r\n  const cross1 = Vector3.cross(dirP, dirQ, _nearestCross1);\r\n  const n2 = Vector3.cross(dirQ, cross1, _nearestN2);\r\n  const dP_n2 = Vector3.dot(dirP, n2);\r\n  const dQ_n1 = Vector3.dot(dirQ, n1);\r\n  const posDiff = Vector3.sub(posQ, posP, _nearestPosDiff);\r\n  const tP = dP_n2 !== 0 ? Vector3.dot(posDiff, n2) / dP_n2 : 0;\r\n  const tQ = dQ_n1 !== 0 ? Vector3.dot(Vector3.scale(posDiff, -1, posDiff), n1) / dQ_n1 : 0;\r\n  const pointOnP = Vector3.scale(dirP, tP, _nearestPointOnP);\r\n  Vector3.add(posP, pointOnP, pointOnP);\r\n  const pointOnQ = Vector3.scale(dirQ, tQ, _nearestPointOnQ);\r\n  Vector3.add(posQ, pointOnQ, pointOnQ);\r\n  const diff = Vector3.sub(pointOnQ, pointOnP, _nearestPointDiff);\r\n  return writeNearestPointsResult(out, tP, tQ, pointOnP, pointOnQ, diff.magnitudeSq, !out);\r\n}\r\n\r\n// Surface collision (triangle-based)\r\n\r\nexport function checkSurfaceCollision(\r\n  ptA: Vector3,\r\n  ptB: Vector3,\r\n  ptC: Vector3,\r\n  colliderPos: Vector3,\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  out?: SurfaceCheckResult\r\n): SurfaceCheckResult {\r\n  _surfaceNoHit.hit = false;\r\n  _surfaceNoHit.intersectionPoint.setXYZ(0, 0, 0);\r\n  _surfaceNoHit.pushOut.setXYZ(0, 0, 0);\r\n  _surfaceNoHit.pointOnCollider.set(colliderPos);\r\n  _surfaceNoHit.radius = colRW.radius;\r\n\r\n  let pointOnCollider = colliderPos;\r\n  let radius = colRW.radius;\r\n  const isCapsule = colR.height > EPSILON;\r\n\r\n  const triCenter = centerOfTriangle(ptA, ptB, ptC, _surfaceTriCenter);\r\n  const edgeAB = Vector3.sub(ptB, ptA, _surfaceEdgeAB);\r\n  const edgeAC = Vector3.sub(ptC, ptA, _surfaceEdgeAC);\r\n  const planeNormal = Vector3.cross(edgeAB, edgeAC, _surfacePlaneNormal);\r\n  Vector3.normalize(planeNormal, planeNormal);\r\n  Vector3.scale(planeNormal, -1, planeNormal);\r\n  const planeNormalNeg = Vector3.scale(planeNormal, -1, _surfacePlaneNormalNeg);\r\n  const planeDist = -Vector3.dot(planeNormalNeg, ptA);\r\n  const colliderDir = Vector3.sub(colliderPos, triCenter, _surfaceColliderDir);\r\n  Vector3.normalize(colliderDir, colliderDir);\r\n  const dot = Vector3.dot(colliderDir, planeNormal);\r\n\r\n  if (isCapsule) {\r\n    const side = Vector3.dot(colRW.directionCurrent, planeNormal) * dot;\r\n    const rayDir = Vector3.scale(planeNormal, dot * -1, _surfaceRayDir);\r\n    const tempPOC = pointOnCollider;\r\n\r\n    if (side < 0) {\r\n      radius = colRW.radius * colR.radiusTailScale;\r\n      pointOnCollider = Vector3.add(colliderPos, colRW.directionCurrent, _surfaceTail);\r\n    }\r\n\r\n    const rayDirN = Vector3.normalize(rayDir, _surfaceRayDirN);\r\n    const enter = raycast(planeNormalNeg, planeDist, pointOnCollider, rayDirN);\r\n    if (enter !== null) {\r\n      const ip = Vector3.scale(rayDirN, enter, _surfaceIntersection);\r\n      Vector3.add(pointOnCollider, ip, ip);\r\n      if (triangleContainsPoint(ptA, ptB, ptC, ip)) {\r\n        const pushOut = Vector3.sub(ip, pointOnCollider, _surfacePushOut);\r\n        const toCol = Vector3.sub(pointOnCollider, ip, _surfaceToCol);\r\n        if (toCol.magnitudeSq <= radius * radius) {\r\n          return writeSurfaceCheckResult(out, true, ip, pushOut, pointOnCollider, radius, !out);\r\n        }\r\n      }\r\n    } else if (colR.forceType !== ColliderForce.Off) {\r\n      pointOnCollider = tempPOC;\r\n      let endVec = Vector3.add(colliderPos, colRW.directionCurrent, _surfaceEndVec);\r\n      _surfaceColDirVec.set(colRW.directionCurrent);\r\n      let colDirVec = _surfaceColDirVec;\r\n      if (colR.forceType === ColliderForce.Pull) {\r\n        const tmp = pointOnCollider;\r\n        pointOnCollider = endVec;\r\n        endVec = tmp;\r\n        colDirVec = Vector3.scale(colDirVec, -1, colDirVec);\r\n      }\r\n      const enter2 = raycast(planeNormalNeg, planeDist, pointOnCollider, colDirVec);\r\n      if (enter2 !== null) {\r\n        const ip = Vector3.scale(colDirVec, enter2, _surfaceIntersection);\r\n        Vector3.add(pointOnCollider, ip, ip);\r\n        if (triangleContainsPoint(ptA, ptB, ptC, ip)) {\r\n          const intersecToEnd = Vector3.sub(endVec, ip, _surfaceIntersecToEnd);\r\n          const colToEnd = Vector3.sub(endVec, pointOnCollider, _surfaceColToEnd);\r\n          const colToIntersect = Vector3.sub(ip, pointOnCollider, _surfaceColToIntersect);\r\n          const pDot = Vector3.dot(intersecToEnd, colToIntersect);\r\n          const lDot = Vector3.dot(colToEnd, colToEnd);\r\n          if (!(pDot >= 0 && pDot <= lDot)) {\r\n            return writeSurfaceCheckResult(\r\n              out,\r\n              _surfaceNoHit.hit,\r\n              _surfaceNoHit.intersectionPoint,\r\n              _surfaceNoHit.pushOut,\r\n              _surfaceNoHit.pointOnCollider,\r\n              _surfaceNoHit.radius,\r\n              !out\r\n            );\r\n          }\r\n          const dotVal = Vector3.dot(colToEnd, colToIntersect);\r\n          const s2eMag = Vector3.dot(colToEnd, colToEnd);\r\n          const colToEndN = Vector3.normalize(colToEnd, colToEnd);\r\n          const eVec = Vector3.scale(colToEndN, -radius, _surfaceEVec);\r\n          Vector3.add(pointOnCollider, eVec, eVec);\r\n          const pushOut = Vector3.sub(ip, eVec, _surfacePushOut);\r\n          const poc2 = Vector3.scale(colToEnd, dotVal / s2eMag, _surfacePoc2);\r\n          Vector3.add(pointOnCollider, poc2, poc2);\r\n          const toCol = Vector3.sub(poc2, ip, _surfaceToCol);\r\n          if (toCol.magnitudeSq <= radius * radius) {\r\n            return writeSurfaceCheckResult(out, true, ip, pushOut, poc2, radius, !out);\r\n          }\r\n        }\r\n      }\r\n    }\r\n  } else {\r\n    const rayDir = Vector3.scale(planeNormal, dot * -1, _surfaceRayDir);\r\n    const rayDirN = Vector3.normalize(rayDir, _surfaceRayDirN);\r\n    const enter = raycast(planeNormalNeg, planeDist, pointOnCollider, rayDirN);\r\n    if (enter !== null) {\r\n      const ip = Vector3.scale(rayDirN, enter, _surfaceIntersection);\r\n      Vector3.add(pointOnCollider, ip, ip);\r\n      if (triangleContainsPoint(ptA, ptB, ptC, ip)) {\r\n        const pushOut = Vector3.sub(ip, pointOnCollider, _surfacePushOut);\r\n        const toCol = Vector3.sub(pointOnCollider, ip, _surfaceToCol);\r\n        if (toCol.magnitudeSq <= radius * radius) {\r\n          return writeSurfaceCheckResult(out, true, ip, pushOut, pointOnCollider, radius, !out);\r\n        }\r\n      }\r\n    }\r\n  }\r\n\r\n  return writeSurfaceCheckResult(\r\n    out,\r\n    _surfaceNoHit.hit,\r\n    _surfaceNoHit.intersectionPoint,\r\n    _surfaceNoHit.pushOut,\r\n    _surfaceNoHit.pointOnCollider,\r\n    _surfaceNoHit.radius,\r\n    !out\r\n  );\r\n}\r\n\r\n// Helpers\r\n\r\nfunction raycast(normal: Vector3, planeDist: number, origin: Vector3, direction: Vector3): number | null {\r\n  const vdot = Vector3.dot(direction, normal);\r\n  const ndot = -Vector3.dot(origin, normal) - planeDist;\r\n  if (Math.abs(vdot) <= EPSILON) {\r\n    return null;\r\n  }\r\n  const enter = ndot / vdot;\r\n  return enter > 0 ? enter : null;\r\n}\r\n\r\nfunction centerOfTriangle(a: Vector3, b: Vector3, c: Vector3, result?: Vector3): Vector3 {\r\n  result = result || new Vector3();\r\n  return result.setXYZ((a.x + b.x + c.x) / 3, (a.y + b.y + c.y) / 3, (a.z + b.z + c.z) / 3);\r\n}\r\n\r\nfunction triangleContainsPoint(a: Vector3, b: Vector3, c: Vector3, p: Vector3): boolean {\r\n  const ap = Vector3.sub(a, p, _triangleAp);\r\n  const bp = Vector3.sub(b, p, _triangleBp);\r\n  const cp = Vector3.sub(c, p, _triangleCp);\r\n  const u = Vector3.cross(ap, bp, _triangleU);\r\n  const vv = Vector3.cross(bp, cp, _triangleV);\r\n  const w = Vector3.cross(cp, ap, _triangleW);\r\n  if (Vector3.dot(u, vv) < 0) {\r\n    return false;\r\n  }\r\n  if (Vector3.dot(vv, w) < 0) {\r\n    return false;\r\n  }\r\n  return true;\r\n}\r\n\r\nfunction lerp(a: number, b: number, t: number): number {\r\n  return a + (b - a) * t;\r\n}\r\n"],"names":["_pushoutSphereDirection","Vector3","_pushoutSphereScaled","_pushoutCapsuleVecN","_pushoutCapsuleTargetVec","_pushoutCapsuleTail","_pushoutCapsulePosOnVec","_pushoutCapsulePushVec","_pushoutCapsuleScaled","_pushInSphereDirection","_pushInSphereDirectionN","_pushInSphereScaled","_pushInCapsuleVecN","_pushInCapsuleTargetVec","_pushInCapsuleTail","_pushInCapsulePosOnVec","_pushInCapsulePullVec","_pushInCapsulePullVecN","_pushInCapsuleScaled","_collisionSphereDir","_collisionSphereDirN","_collisionSphereToCenter","_collisionSphereScaled","_collisionSphereDiff","_collisionCapsuleTail","_collisionCapsulePointDir","_collisionCapsulePtOnCol","_collisionCapsulePtOnLine","_collisionCapsuleDiff","_collisionCapsuleTempLineResult","hit","pointOnLine","pointOnCollider","radius","_nearestCross0","_nearestCross1","_nearestN1","_nearestN2","_nearestPosDiff","_nearestPointOnP","_nearestPointOnQ","_nearestPointDiff","_nearestResult","tP","tQ","pointOnP","pointOnQ","sqrDistance","_surfaceNoHit","intersectionPoint","pushOut","_surfaceTriCenter","_surfaceEdgeAB","_surfaceEdgeAC","_surfacePlaneNormal","_surfacePlaneNormalNeg","_surfaceColliderDir","_surfaceRayDir","_surfaceRayDirN","_surfaceTail","_surfaceIntersection","_surfacePushOut","_surfaceToCol","_surfaceEndVec","_surfaceColDirVec","_surfaceIntersecToEnd","_surfaceColToEnd","_surfaceColToIntersect","_surfaceEVec","_surfacePoc2","_triangleAp","_triangleBp","_triangleCp","_triangleU","_triangleV","_triangleW","writeCollisionResult","out","point","copyPoint","clone","set","writeLineCollisionResult","copyVectors","writeSurfaceCheckResult","writeNearestPointsResult","pushoutFromSphere","center","pointRadius","direction","sub","sqrLen","magnitudeSq","EPSILON","dirLen","Math","sqrt","scaled","scale","add","pushoutFromCollider","colR","colRW","ptR","height","positionCurrent","pushoutFromCapsule","capsuleVec","directionCurrent","capsuleVecN","normalize","capsulePos","targetVec","distOnVec","dot","tail","radiusTailScale","posOnVec","pushVec","sqrPushDist","pushDist","r","lerp","pushInFromSphere","directionN","pushInFromCollider","pushInFromCapsule","pullVec","sqrPullDist","pullDist","pullVecN","collisionDetectionSphere","point1","point2","dir","magnitude","dirN","toCenter","clamped","max","min","ptOnLine","diff","collisionDetectionCapsule","capsuleDir","res","pointDir","nearest","computeNearestPoints","t1","t2","ptOnCol","collisionDetection","pushInCollisionDetection","posP","dirP","posQ","dirQ","cross0","cross","n1","cross1","n2","dP_n2","dQ_n1","posDiff","checkSurfaceCollision","ptA","ptB","ptC","colliderPos","setXYZ","isCapsule","triCenter","centerOfTriangle","edgeAB","edgeAC","planeNormal","planeNormalNeg","planeDist","colliderDir","side","rayDir","tempPOC","rayDirN","enter","raycast","ip","triangleContainsPoint","toCol","forceType","ColliderForce","Off","endVec","colDirVec","Pull","tmp","enter2","intersecToEnd","colToEnd","colToIntersect","pDot","lDot","dotVal","s2eMag","colToEndN","eVec","poc2","normal","origin","vdot","ndot","abs","a","b","c","result","x","y","z","p","ap","bp","cp","u","vv","w","t"],"mappings":";;;AAAA;AAkCA,MAAMA,0BAA0B,IAAIC,OAAAA,EAAAA;AACpC,MAAMC,uBAAuB,IAAID,OAAAA,EAAAA;AACjC,MAAME,sBAAsB,IAAIF,OAAAA,EAAAA;AAChC,MAAMG,2BAA2B,IAAIH,OAAAA,EAAAA;AACrC,MAAMI,sBAAsB,IAAIJ,OAAAA,EAAAA;AAChC,MAAMK,0BAA0B,IAAIL,OAAAA,EAAAA;AACpC,MAAMM,yBAAyB,IAAIN,OAAAA,EAAAA;AACnC,MAAMO,wBAAwB,IAAIP,OAAAA,EAAAA;AAClC,MAAMQ,yBAAyB,IAAIR,OAAAA,EAAAA;AACnC,MAAMS,0BAA0B,IAAIT,OAAAA,EAAAA;AACpC,MAAMU,sBAAsB,IAAIV,OAAAA,EAAAA;AAChC,MAAMW,qBAAqB,IAAIX,OAAAA,EAAAA;AAC/B,MAAMY,0BAA0B,IAAIZ,OAAAA,EAAAA;AACpC,MAAMa,qBAAqB,IAAIb,OAAAA,EAAAA;AAC/B,MAAMc,yBAAyB,IAAId,OAAAA,EAAAA;AACnC,MAAMe,wBAAwB,IAAIf,OAAAA,EAAAA;AAClC,MAAMgB,yBAAyB,IAAIhB,OAAAA,EAAAA;AACnC,MAAMiB,uBAAuB,IAAIjB,OAAAA,EAAAA;AACjC,MAAMkB,sBAAsB,IAAIlB,OAAAA,EAAAA;AAChC,MAAMmB,uBAAuB,IAAInB,OAAAA,EAAAA;AACjC,MAAMoB,2BAA2B,IAAIpB,OAAAA,EAAAA;AACrC,MAAMqB,yBAAyB,IAAIrB,OAAAA,EAAAA;AACnC,MAAMsB,uBAAuB,IAAItB,OAAAA,EAAAA;AACjC,MAAMuB,wBAAwB,IAAIvB,OAAAA,EAAAA;AAClC,MAAMwB,4BAA4B,IAAIxB,OAAAA,EAAAA;AACtC,MAAMyB,2BAA2B,IAAIzB,OAAAA,EAAAA;AACrC,MAAM0B,4BAA4B,IAAI1B,OAAAA,EAAAA;AACtC,MAAM2B,wBAAwB,IAAI3B,OAAAA,EAAAA;AAClC,MAAM4B,+BAAuD,GAAA;IAC3DC,GAAK,EAAA,KAAA;AACLC,IAAAA,WAAAA,EAAa,IAAI9B,OAAAA,EAAAA;AACjB+B,IAAAA,eAAAA,EAAiB,IAAI/B,OAAAA,EAAAA;IACrBgC,MAAQ,EAAA;AACV,CAAA;AACA,MAAMC,iBAAiB,IAAIjC,OAAAA,EAAAA;AAC3B,MAAMkC,iBAAiB,IAAIlC,OAAAA,EAAAA;AAC3B,MAAMmC,aAAa,IAAInC,OAAAA,EAAAA;AACvB,MAAMoC,aAAa,IAAIpC,OAAAA,EAAAA;AACvB,MAAMqC,kBAAkB,IAAIrC,OAAAA,EAAAA;AAC5B,MAAMsC,mBAAmB,IAAItC,OAAAA,EAAAA;AAC7B,MAAMuC,mBAAmB,IAAIvC,OAAAA,EAAAA;AAC7B,MAAMwC,oBAAoB,IAAIxC,OAAAA,EAAAA;AAC9B,MAAMyC,cAAsC,GAAA;IAC1CC,EAAI,EAAA,CAAA;IACJC,EAAI,EAAA,CAAA;AACJC,IAAAA,QAAAA,EAAU,IAAI5C,OAAAA,EAAAA;AACd6C,IAAAA,QAAAA,EAAU,IAAI7C,OAAAA,EAAAA;IACd8C,WAAa,EAAA;AACf,CAAA;AACA,MAAMC,aAAoC,GAAA;IACxClB,GAAK,EAAA,KAAA;AACLmB,IAAAA,iBAAAA,EAAmB,IAAIhD,OAAAA,EAAAA;AACvBiD,IAAAA,OAAAA,EAAS,IAAIjD,OAAAA,EAAAA;AACb+B,IAAAA,eAAAA,EAAiB,IAAI/B,OAAAA,EAAAA;IACrBgC,MAAQ,EAAA;AACV,CAAA;AACA,MAAMkB,oBAAoB,IAAIlD,OAAAA,EAAAA;AAC9B,MAAMmD,iBAAiB,IAAInD,OAAAA,EAAAA;AAC3B,MAAMoD,iBAAiB,IAAIpD,OAAAA,EAAAA;AAC3B,MAAMqD,sBAAsB,IAAIrD,OAAAA,EAAAA;AAChC,MAAMsD,yBAAyB,IAAItD,OAAAA,EAAAA;AACnC,MAAMuD,sBAAsB,IAAIvD,OAAAA,EAAAA;AAChC,MAAMwD,iBAAiB,IAAIxD,OAAAA,EAAAA;AAC3B,MAAMyD,kBAAkB,IAAIzD,OAAAA,EAAAA;AAC5B,MAAM0D,eAAe,IAAI1D,OAAAA,EAAAA;AACzB,MAAM2D,uBAAuB,IAAI3D,OAAAA,EAAAA;AACjC,MAAM4D,kBAAkB,IAAI5D,OAAAA,EAAAA;AAC5B,MAAM6D,gBAAgB,IAAI7D,OAAAA,EAAAA;AAC1B,MAAM8D,iBAAiB,IAAI9D,OAAAA,EAAAA;AAC3B,MAAM+D,oBAAoB,IAAI/D,OAAAA,EAAAA;AAC9B,MAAMgE,wBAAwB,IAAIhE,OAAAA,EAAAA;AAClC,MAAMiE,mBAAmB,IAAIjE,OAAAA,EAAAA;AAC7B,MAAMkE,yBAAyB,IAAIlE,OAAAA,EAAAA;AACnC,MAAMmE,eAAe,IAAInE,OAAAA,EAAAA;AACzB,MAAMoE,eAAe,IAAIpE,OAAAA,EAAAA;AACzB,MAAMqE,cAAc,IAAIrE,OAAAA,EAAAA;AACxB,MAAMsE,cAAc,IAAItE,OAAAA,EAAAA;AACxB,MAAMuE,cAAc,IAAIvE,OAAAA,EAAAA;AACxB,MAAMwE,aAAa,IAAIxE,OAAAA,EAAAA;AACvB,MAAMyE,aAAa,IAAIzE,OAAAA,EAAAA;AACvB,MAAM0E,aAAa,IAAI1E,OAAAA,EAAAA;AAEvB,SAAS2E,qBACPC,GAAgC,EAChC/C,GAAY,EACZgD,KAAc,EACdC,SAAkB,EAAA;AAElB,IAAA,IAAI,CAACF,GAAK,EAAA;QACR,OAAO;AAAE/C,YAAAA,GAAAA;YAAKgD,KAAOC,EAAAA,SAAAA,GAAYD,KAAME,CAAAA,KAAK,EAAKF,GAAAA;AAAM,SAAA;AACzD;IACA,IAAI,CAACD,GAAIC,CAAAA,KAAK,EAAE;QACdD,GAAIC,CAAAA,KAAK,GAAG,IAAI7E,OAAAA,EAAAA;AAClB;AACA4E,IAAAA,GAAAA,CAAI/C,GAAG,GAAGA,GAAAA;IACV+C,GAAIC,CAAAA,KAAK,CAACG,GAAG,CAACH,KAAAA,CAAAA;IACd,OAAOD,GAAAA;AACT;AAEA,SAASK,wBAAAA,CACPL,GAAoC,EACpC/C,GAAY,EACZC,WAAoB,EACpBC,eAAwB,EACxBC,MAAc,EACdkD,WAAoB,EAAA;AAEpB,IAAA,IAAI,CAACN,GAAK,EAAA;QACR,OAAO;AACL/C,YAAAA,GAAAA;YACAC,WAAaoD,EAAAA,WAAAA,GAAcpD,WAAYiD,CAAAA,KAAK,EAAKjD,GAAAA,WAAAA;YACjDC,eAAiBmD,EAAAA,WAAAA,GAAcnD,eAAgBgD,CAAAA,KAAK,EAAKhD,GAAAA,eAAAA;AACzDC,YAAAA;AACF,SAAA;AACF;IACA,IAAI,CAAC4C,GAAI9C,CAAAA,WAAW,EAAE;QACpB8C,GAAI9C,CAAAA,WAAW,GAAG,IAAI9B,OAAAA,EAAAA;AACxB;IACA,IAAI,CAAC4E,GAAI7C,CAAAA,eAAe,EAAE;QACxB6C,GAAI7C,CAAAA,eAAe,GAAG,IAAI/B,OAAAA,EAAAA;AAC5B;AACA4E,IAAAA,GAAAA,CAAI/C,GAAG,GAAGA,GAAAA;IACV+C,GAAI9C,CAAAA,WAAW,CAACkD,GAAG,CAAClD,WAAAA,CAAAA;IACpB8C,GAAI7C,CAAAA,eAAe,CAACiD,GAAG,CAACjD,eAAAA,CAAAA;AACxB6C,IAAAA,GAAAA,CAAI5C,MAAM,GAAGA,MAAAA;IACb,OAAO4C,GAAAA;AACT;AAEA,SAASO,uBACPP,CAAAA,GAAmC,EACnC/C,GAAY,EACZmB,iBAA0B,EAC1BC,OAAgB,EAChBlB,eAAwB,EACxBC,MAAc,EACdkD,WAAoB,EAAA;AAEpB,IAAA,IAAI,CAACN,GAAK,EAAA;QACR,OAAO;AACL/C,YAAAA,GAAAA;YACAmB,iBAAmBkC,EAAAA,WAAAA,GAAclC,iBAAkB+B,CAAAA,KAAK,EAAK/B,GAAAA,iBAAAA;YAC7DC,OAASiC,EAAAA,WAAAA,GAAcjC,OAAQ8B,CAAAA,KAAK,EAAK9B,GAAAA,OAAAA;YACzClB,eAAiBmD,EAAAA,WAAAA,GAAcnD,eAAgBgD,CAAAA,KAAK,EAAKhD,GAAAA,eAAAA;AACzDC,YAAAA;AACF,SAAA;AACF;IACA,IAAI,CAAC4C,GAAI5B,CAAAA,iBAAiB,EAAE;QAC1B4B,GAAI5B,CAAAA,iBAAiB,GAAG,IAAIhD,OAAAA,EAAAA;AAC9B;IACA,IAAI,CAAC4E,GAAI3B,CAAAA,OAAO,EAAE;QAChB2B,GAAI3B,CAAAA,OAAO,GAAG,IAAIjD,OAAAA,EAAAA;AACpB;IACA,IAAI,CAAC4E,GAAI7C,CAAAA,eAAe,EAAE;QACxB6C,GAAI7C,CAAAA,eAAe,GAAG,IAAI/B,OAAAA,EAAAA;AAC5B;AACA4E,IAAAA,GAAAA,CAAI/C,GAAG,GAAGA,GAAAA;IACV+C,GAAI5B,CAAAA,iBAAiB,CAACgC,GAAG,CAAChC,iBAAAA,CAAAA;IAC1B4B,GAAI3B,CAAAA,OAAO,CAAC+B,GAAG,CAAC/B,OAAAA,CAAAA;IAChB2B,GAAI7C,CAAAA,eAAe,CAACiD,GAAG,CAACjD,eAAAA,CAAAA;AACxB6C,IAAAA,GAAAA,CAAI5C,MAAM,GAAGA,MAAAA;IACb,OAAO4C,GAAAA;AACT;AAEA,SAASQ,wBACPR,CAAAA,GAAoC,EACpClC,EAAU,EACVC,EAAU,EACVC,QAAiB,EACjBC,QAAiB,EACjBC,WAAmB,EACnBoC,WAAoB,EAAA;AAEpB,IAAA,IAAI,CAACN,GAAK,EAAA;QACR,OAAO;AACLlC,YAAAA,EAAAA;AACAC,YAAAA,EAAAA;YACAC,QAAUsC,EAAAA,WAAAA,GAActC,QAASmC,CAAAA,KAAK,EAAKnC,GAAAA,QAAAA;YAC3CC,QAAUqC,EAAAA,WAAAA,GAAcrC,QAASkC,CAAAA,KAAK,EAAKlC,GAAAA,QAAAA;AAC3CC,YAAAA;AACF,SAAA;AACF;AACA8B,IAAAA,GAAAA,CAAIlC,EAAE,GAAGA,EAAAA;AACTkC,IAAAA,GAAAA,CAAIjC,EAAE,GAAGA,EAAAA;IACTiC,GAAIhC,CAAAA,QAAQ,CAACoC,GAAG,CAACpC,QAAAA,CAAAA;IACjBgC,GAAI/B,CAAAA,QAAQ,CAACmC,GAAG,CAACnC,QAAAA,CAAAA;AACjB+B,IAAAA,GAAAA,CAAI9B,WAAW,GAAGA,WAAAA;IAClB,OAAO8B,GAAAA;AACT;AAEA;AAEO,SAASS,iBACdC,CAAAA,MAAe,EACftD,MAAc,EACduD,WAAmB,EACnBV,KAAc,EACdD,GAAqB,EAAA;AAErB,IAAA,MAAMY,SAAYxF,GAAAA,OAAAA,CAAQyF,GAAG,CAACZ,OAAOS,MAAQvF,EAAAA,uBAAAA,CAAAA;IAC7C,MAAM2F,MAAAA,GAASF,UAAUG,WAAW;AACpC,IAAA,IAAID,SAASE,OAAS,EAAA;AACpB,QAAA,MAAMC,MAASC,GAAAA,IAAAA,CAAKC,IAAI,CAACL,MAAUH,CAAAA,GAAAA,WAAAA;AACnC,QAAA,IAAIM,SAAS7D,MAAQ,EAAA;AACnB,YAAA,MAAMgE,SAAShG,OAAQiG,CAAAA,KAAK,CAACT,SAAAA,EAAWxD,SAAS6D,MAAQ5F,EAAAA,oBAAAA,CAAAA;YACzDD,OAAQkG,CAAAA,GAAG,CAACZ,MAAAA,EAAQU,MAAQA,EAAAA,MAAAA,CAAAA;AAC5B,YAAA,OAAOrB,oBAAqBC,CAAAA,GAAAA,EAAK,IAAMoB,EAAAA,MAAAA,EAAQ,CAACpB,GAAAA,CAAAA;AAClD;AACF;AACA,IAAA,OAAOD,oBAAqBC,CAAAA,GAAAA,EAAK,KAAOC,EAAAA,KAAAA,EAAO,CAACD,GAAAA,CAAAA;AAClD;AAEO,SAASuB,mBACdC,CAAAA,IAAe,EACfC,KAAiB,EACjBxB,KAAc,EACdyB,GAAW,EACX1B,GAAqB,EAAA;IAErB,IAAIwB,IAAAA,CAAKG,MAAM,IAAIX,OAAS,EAAA;QAC1B,OAAOP,iBAAAA,CAAkBgB,KAAMG,CAAAA,eAAe,EAAEH,KAAAA,CAAMrE,MAAM,EAAEsE,GAAAA,CAAIf,WAAW,EAAEV,KAAOD,EAAAA,GAAAA,CAAAA;AACxF;AACA,IAAA,OAAO6B,kBAAmBL,CAAAA,IAAAA,EAAMC,KAAOxB,EAAAA,KAAAA,EAAOyB,GAAK1B,EAAAA,GAAAA,CAAAA;AACrD;AAEO,SAAS6B,kBACdL,CAAAA,IAAe,EACfC,KAAiB,EACjBxB,KAAc,EACdyB,GAAW,EACX1B,GAAqB,EAAA;IAErB,MAAM8B,UAAAA,GAAaL,MAAMM,gBAAgB;AACzC,IAAA,MAAMC,WAAc5G,GAAAA,OAAAA,CAAQ6G,SAAS,CAACH,UAAYxG,EAAAA,mBAAAA,CAAAA;IAClD,MAAM4G,UAAAA,GAAaT,MAAMG,eAAe;AACxC,IAAA,MAAMO,SAAY/G,GAAAA,OAAAA,CAAQyF,GAAG,CAACZ,OAAOiC,UAAY3G,EAAAA,wBAAAA,CAAAA;AACjD,IAAA,MAAM6G,SAAYhH,GAAAA,OAAAA,CAAQiH,GAAG,CAACL,WAAaG,EAAAA,SAAAA,CAAAA;AAE3C,IAAA,IAAIC,aAAapB,OAAS,EAAA;QACxB,OAAOP,iBAAAA,CAAkByB,YAAYT,KAAMrE,CAAAA,MAAM,EAAEsE,GAAIf,CAAAA,WAAW,EAAEV,KAAOD,EAAAA,GAAAA,CAAAA;AAC7E;IACA,IAAIoC,SAAAA,IAAaZ,IAAKG,CAAAA,MAAM,EAAE;AAC5B,QAAA,MAAMW,IAAOlH,GAAAA,OAAAA,CAAQkG,GAAG,CAACY,YAAYJ,UAAYtG,EAAAA,mBAAAA,CAAAA;QACjD,OAAOiF,iBAAAA,CAAkB6B,IAAMb,EAAAA,KAAAA,CAAMrE,MAAM,GAAGoE,IAAKe,CAAAA,eAAe,EAAEb,GAAAA,CAAIf,WAAW,EAAEV,KAAOD,EAAAA,GAAAA,CAAAA;AAC9F;AAEA,IAAA,MAAMwC,QAAWpH,GAAAA,OAAAA,CAAQiG,KAAK,CAACW,aAAaI,SAAW3G,EAAAA,uBAAAA,CAAAA;IACvDL,OAAQkG,CAAAA,GAAG,CAACY,UAAAA,EAAYM,QAAUA,EAAAA,QAAAA,CAAAA;AAClC,IAAA,MAAMC,OAAUrH,GAAAA,OAAAA,CAAQyF,GAAG,CAACZ,OAAOuC,QAAU9G,EAAAA,sBAAAA,CAAAA;IAC7C,MAAMgH,WAAAA,GAAcD,QAAQ1B,WAAW;AACvC,IAAA,IAAI2B,cAAc1B,OAAS,EAAA;AACzB,QAAA,MAAM2B,WAAWzB,IAAKC,CAAAA,IAAI,CAACuB,WAAAA,CAAAA,GAAehB,IAAIf,WAAW;QACzD,MAAMiC,CAAAA,GAAInB,KAAMrE,CAAAA,MAAM,GAAGyF,IAAAA,CAAK,GAAKrB,EAAAA,IAAAA,CAAKe,eAAe,EAAEH,SAAYZ,GAAAA,IAAAA,CAAKG,MAAM,CAAA;AAChF,QAAA,IAAIgB,WAAWC,CAAG,EAAA;AAChB,YAAA,MAAMxB,SAAShG,OAAQiG,CAAAA,KAAK,CAACoB,OAAAA,EAASG,IAAID,QAAUhH,EAAAA,qBAAAA,CAAAA;YACpDP,OAAQkG,CAAAA,GAAG,CAACkB,QAAAA,EAAUpB,MAAQA,EAAAA,MAAAA,CAAAA;AAC9B,YAAA,OAAOrB,oBAAqBC,CAAAA,GAAAA,EAAK,IAAMoB,EAAAA,MAAAA,EAAQ,CAACpB,GAAAA,CAAAA;AAClD;AACF;AACA,IAAA,OAAOD,oBAAqBC,CAAAA,GAAAA,EAAK,KAAOC,EAAAA,KAAAA,EAAO,CAACD,GAAAA,CAAAA;AAClD;AAEA;AAEO,SAAS8C,iBACdpC,MAAe,EACftD,MAAc,EACd6C,KAAc,EACdD,GAAqB,EAAA;AAErB,IAAA,MAAMY,SAAYxF,GAAAA,OAAAA,CAAQyF,GAAG,CAACH,QAAQT,KAAOrE,EAAAA,sBAAAA,CAAAA;IAC7C,MAAMkF,MAAAA,GAASF,UAAUG,WAAW;AACpC,IAAA,IAAID,MAASE,GAAAA,OAAAA,IAAWF,MAAS1D,GAAAA,MAAAA,GAASA,MAAQ,EAAA;QAChD,MAAM6D,MAAAA,GAASC,IAAKC,CAAAA,IAAI,CAACL,MAAAA,CAAAA;AACzB,QAAA,MAAMiC,UAAa3H,GAAAA,OAAAA,CAAQ6G,SAAS,CAACrB,SAAW/E,EAAAA,uBAAAA,CAAAA;AAChD,QAAA,MAAMuF,SAAShG,OAAQiG,CAAAA,KAAK,CAAC0B,UAAAA,EAAY9B,SAAS7D,MAAQtB,EAAAA,mBAAAA,CAAAA;QAC1DV,OAAQkG,CAAAA,GAAG,CAACrB,KAAAA,EAAOmB,MAAQA,EAAAA,MAAAA,CAAAA;AAC3B,QAAA,OAAOrB,oBAAqBC,CAAAA,GAAAA,EAAK,IAAMoB,EAAAA,MAAAA,EAAQ,CAACpB,GAAAA,CAAAA;AAClD;AACA,IAAA,OAAOD,oBAAqBC,CAAAA,GAAAA,EAAK,KAAOC,EAAAA,KAAAA,EAAO,CAACD,GAAAA,CAAAA;AAClD;AAEO,SAASgD,mBACdxB,IAAe,EACfC,KAAiB,EACjBxB,KAAc,EACdD,GAAqB,EAAA;IAErB,IAAIwB,IAAAA,CAAKG,MAAM,IAAIX,OAAS,EAAA;AAC1B,QAAA,OAAO8B,iBAAiBrB,KAAMG,CAAAA,eAAe,EAAEH,KAAMrE,CAAAA,MAAM,EAAE6C,KAAOD,EAAAA,GAAAA,CAAAA;AACtE;IACA,OAAOiD,iBAAAA,CAAkBzB,IAAMC,EAAAA,KAAAA,EAAOxB,KAAOD,EAAAA,GAAAA,CAAAA;AAC/C;AAEO,SAASiD,kBACdzB,IAAe,EACfC,KAAiB,EACjBxB,KAAc,EACdD,GAAqB,EAAA;IAErB,MAAM8B,UAAAA,GAAaL,MAAMM,gBAAgB;AACzC,IAAA,MAAMC,WAAc5G,GAAAA,OAAAA,CAAQ6G,SAAS,CAACH,UAAY/F,EAAAA,kBAAAA,CAAAA;IAClD,MAAMmG,UAAAA,GAAaT,MAAMG,eAAe;AACxC,IAAA,MAAMO,SAAY/G,GAAAA,OAAAA,CAAQyF,GAAG,CAACZ,OAAOiC,UAAYlG,EAAAA,uBAAAA,CAAAA;AACjD,IAAA,MAAMoG,SAAYhH,GAAAA,OAAAA,CAAQiH,GAAG,CAACL,WAAaG,EAAAA,SAAAA,CAAAA;AAE3C,IAAA,IAAIC,aAAapB,OAAS,EAAA;AACxB,QAAA,OAAO8B,gBAAiBZ,CAAAA,UAAAA,EAAYT,KAAMrE,CAAAA,MAAM,EAAE6C,KAAOD,EAAAA,GAAAA,CAAAA;AAC3D;IACA,IAAIoC,SAAAA,IAAaZ,IAAKG,CAAAA,MAAM,EAAE;AAC5B,QAAA,MAAMW,IAAOlH,GAAAA,OAAAA,CAAQkG,GAAG,CAACY,YAAYJ,UAAY7F,EAAAA,kBAAAA,CAAAA;QACjD,OAAO6G,gBAAAA,CAAiBR,MAAMb,KAAMrE,CAAAA,MAAM,GAAGoE,IAAKe,CAAAA,eAAe,EAAEtC,KAAOD,EAAAA,GAAAA,CAAAA;AAC5E;AAEA,IAAA,MAAMwC,QAAWpH,GAAAA,OAAAA,CAAQiG,KAAK,CAACW,aAAaI,SAAWlG,EAAAA,sBAAAA,CAAAA;IACvDd,OAAQkG,CAAAA,GAAG,CAACY,UAAAA,EAAYM,QAAUA,EAAAA,QAAAA,CAAAA;AAClC,IAAA,MAAMU,OAAU9H,GAAAA,OAAAA,CAAQyF,GAAG,CAAC2B,UAAUvC,KAAO9D,EAAAA,qBAAAA,CAAAA;IAC7C,MAAMgH,WAAAA,GAAcD,QAAQnC,WAAW;AACvC,IAAA,IAAIoC,cAAcnC,OAAS,EAAA;QACzB,MAAM4B,CAAAA,GAAInB,KAAMrE,CAAAA,MAAM,GAAGyF,IAAAA,CAAK,GAAKrB,EAAAA,IAAAA,CAAKe,eAAe,EAAEf,IAAKG,CAAAA,MAAM,GAAGS,SAAAA,CAAAA;QACvE,IAAIe,WAAAA,GAAcP,IAAIA,CAAG,EAAA;YACvB,MAAMQ,QAAAA,GAAWlC,IAAKC,CAAAA,IAAI,CAACgC,WAAAA,CAAAA;AAC3B,YAAA,MAAME,QAAWjI,GAAAA,OAAAA,CAAQ6G,SAAS,CAACiB,OAAS9G,EAAAA,sBAAAA,CAAAA;AAC5C,YAAA,MAAMgF,SAAShG,OAAQiG,CAAAA,KAAK,CAACgC,QAAAA,EAAUD,WAAWR,CAAGvG,EAAAA,oBAAAA,CAAAA;YACrDjB,OAAQkG,CAAAA,GAAG,CAACrB,KAAAA,EAAOmB,MAAQA,EAAAA,MAAAA,CAAAA;AAC3B,YAAA,OAAOrB,oBAAqBC,CAAAA,GAAAA,EAAK,IAAMoB,EAAAA,MAAAA,EAAQ,CAACpB,GAAAA,CAAAA;AAClD;AACF;AACA,IAAA,OAAOD,oBAAqBC,CAAAA,GAAAA,EAAK,KAAOC,EAAAA,KAAAA,EAAO,CAACD,GAAAA,CAAAA;AAClD;AAEA;AAEO,SAASsD,wBACd5C,CAAAA,MAAe,EACftD,MAAc,EACdmG,MAAe,EACfC,MAAe,EACfxD,GAAyB,EAAA;AAEzB,IAAA,MAAMyD,GAAMrI,GAAAA,OAAAA,CAAQyF,GAAG,CAAC2C,QAAQD,MAAQjH,EAAAA,mBAAAA,CAAAA;IACxC,MAAM2E,MAAAA,GAASwC,IAAIC,SAAS;AAC5B,IAAA,IAAIzC,SAASD,OAAS,EAAA;AACpB,QAAA,OAAOX,yBAAyBL,GAAK,EAAA,KAAA,EAAOuD,MAAQ7C,EAAAA,MAAAA,EAAQtD,QAAQ,CAAC4C,GAAAA,CAAAA;AACvE;AACA,IAAA,MAAM2D,OAAOvI,OAAQiG,CAAAA,KAAK,CAACoC,GAAAA,EAAK,IAAIxC,MAAQ1E,EAAAA,oBAAAA,CAAAA;AAC5C,IAAA,MAAMqH,QAAWxI,GAAAA,OAAAA,CAAQyF,GAAG,CAACH,QAAQ6C,MAAQ/G,EAAAA,wBAAAA,CAAAA;AAC7C,IAAA,MAAM6F,GAAMjH,GAAAA,OAAAA,CAAQiH,GAAG,CAACsB,IAAMC,EAAAA,QAAAA,CAAAA;IAC9B,MAAMC,OAAAA,GAAU3C,KAAK4C,GAAG,CAAC,GAAG5C,IAAK6C,CAAAA,GAAG,CAAC1B,GAAKpB,EAAAA,MAAAA,CAAAA,CAAAA;AAC1C,IAAA,MAAM+C,QAAW5I,GAAAA,OAAAA,CAAQiG,KAAK,CAACsC,MAAME,OAASpH,EAAAA,sBAAAA,CAAAA;IAC9CrB,OAAQkG,CAAAA,GAAG,CAACiC,MAAAA,EAAQS,QAAUA,EAAAA,QAAAA,CAAAA;AAC9B,IAAA,MAAMC,IAAO7I,GAAAA,OAAAA,CAAQyF,GAAG,CAACH,QAAQsD,QAAUtH,EAAAA,oBAAAA,CAAAA;AAC3C,IAAA,MAAMO,GAAMgH,GAAAA,IAAAA,CAAKlD,WAAW,IAAI3D,MAASA,GAAAA,MAAAA;AACzC,IAAA,OAAOiD,yBAAyBL,GAAK/C,EAAAA,GAAAA,EAAK+G,QAAUtD,EAAAA,MAAAA,EAAQtD,QAAQ,CAAC4C,GAAAA,CAAAA;AACvE;AAEO,SAASkE,yBACd1C,CAAAA,IAAe,EACfC,KAAiB,EACjB8B,MAAe,EACfC,MAAe,EACfxD,GAAyB,EAAA;IAEzB,MAAMmE,UAAAA,GAAa1C,MAAMM,gBAAgB;IACzC,MAAMG,UAAAA,GAAaT,MAAMG,eAAe;AAExC,IAAA,IAAIwC,MAAMd,wBAAyBpB,CAAAA,UAAAA,EAAYT,MAAMrE,MAAM,EAAEmG,QAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;IAC7E,IAAIoE,GAAAA,CAAInH,GAAG,EAAE;QACX,OAAOmH,GAAAA;AACT;AAEA,IAAA,MAAM9B,IAAOlH,GAAAA,OAAAA,CAAQkG,GAAG,CAACY,YAAYiC,UAAYxH,EAAAA,qBAAAA,CAAAA;IACjDyH,GAAMd,GAAAA,wBAAAA,CACJhB,MACAb,KAAMrE,CAAAA,MAAM,GAAGoE,IAAKe,CAAAA,eAAe,EACnCgB,MAAAA,EACAC,MACAxG,EAAAA,+BAAAA,CAAAA;IAEF,IAAIoH,GAAAA,CAAInH,GAAG,EAAE;AACX,QAAA,OAAOoD,wBAAyBL,CAAAA,GAAAA,EAAK,IAAMoE,EAAAA,GAAAA,CAAIlH,WAAW,EAAEkH,GAAIjH,CAAAA,eAAe,EAAEiH,GAAAA,CAAIhH,MAAM,EAAE,CAAC4C,GAAAA,CAAAA;AAChG;AAEA,IAAA,MAAMqE,QAAWjJ,GAAAA,OAAAA,CAAQyF,GAAG,CAAC2C,QAAQD,MAAQ3G,EAAAA,yBAAAA,CAAAA;AAC7C,IAAA,MAAM0H,OAAUC,GAAAA,oBAAAA,CAAqBrC,UAAYiC,EAAAA,UAAAA,EAAYZ,QAAQc,QAAUxG,EAAAA,cAAAA,CAAAA;IAC/E,MAAM2G,EAAAA,GAAKtD,IAAK4C,CAAAA,GAAG,CAAC,CAAA,EAAG5C,KAAK6C,GAAG,CAAC,CAAGO,EAAAA,OAAAA,CAAQxG,EAAE,CAAA,CAAA;IAC7C,MAAM8E,CAAAA,GAAInB,MAAMrE,MAAM,GAAGyF,KAAK,GAAKrB,EAAAA,IAAAA,CAAKe,eAAe,EAAEiC,EAAAA,CAAAA;AAEzD,IAAA,IAAIF,OAAQpG,CAAAA,WAAW,GAAG0E,CAAAA,GAAIA,CAAG,EAAA;AAC/B,QAAA,OAAOvC,yBAAyBL,GAAK,EAAA,KAAA,EAAOuD,MAAQrB,EAAAA,UAAAA,EAAYU,GAAG,CAAC5C,GAAAA,CAAAA;AACtE;IAEA,MAAMyE,EAAAA,GAAKvD,IAAK4C,CAAAA,GAAG,CAAC,CAAA,EAAG5C,KAAK6C,GAAG,CAAC,CAAGO,EAAAA,OAAAA,CAAQvG,EAAE,CAAA,CAAA;AAC7C,IAAA,MAAM2G,OAAUtJ,GAAAA,OAAAA,CAAQiG,KAAK,CAAC8C,YAAYK,EAAI3H,EAAAA,wBAAAA,CAAAA;IAC9CzB,OAAQkG,CAAAA,GAAG,CAACY,UAAAA,EAAYwC,OAASA,EAAAA,OAAAA,CAAAA;AACjC,IAAA,MAAMV,QAAW5I,GAAAA,OAAAA,CAAQiG,KAAK,CAACgD,UAAUI,EAAI3H,EAAAA,yBAAAA,CAAAA;IAC7C1B,OAAQkG,CAAAA,GAAG,CAACiC,MAAAA,EAAQS,QAAUA,EAAAA,QAAAA,CAAAA;AAC9B,IAAA,MAAMC,IAAO7I,GAAAA,OAAAA,CAAQyF,GAAG,CAAC6D,SAASV,QAAUjH,EAAAA,qBAAAA,CAAAA;AAC5C,IAAA,MAAME,GAAMgH,GAAAA,IAAAA,CAAKlD,WAAW,IAAI6B,CAAIA,GAAAA,CAAAA;AACpC,IAAA,OAAOvC,yBAAyBL,GAAK/C,EAAAA,GAAAA,EAAK+G,QAAUU,EAAAA,OAAAA,EAAS9B,GAAG,CAAC5C,GAAAA,CAAAA;AACnE;AAEO,SAAS2E,kBACdnD,CAAAA,IAAe,EACfC,KAAiB,EACjB8B,MAAe,EACfC,MAAe,EACfxD,GAAyB,EAAA;IAEzB,IAAIwB,IAAAA,CAAKG,MAAM,IAAIX,OAAS,EAAA;QAC1B,OAAOsC,wBAAAA,CAAyB7B,MAAMG,eAAe,EAAEH,MAAMrE,MAAM,EAAEmG,QAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;AACvF;AACA,IAAA,OAAOkE,yBAA0B1C,CAAAA,IAAAA,EAAMC,KAAO8B,EAAAA,MAAAA,EAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;AAChE;AAEO,SAAS4E,wBACdpD,CAAAA,IAAe,EACfC,KAAiB,EACjB8B,MAAe,EACfC,MAAe,EACfxD,GAAyB,EAAA;IAEzB,IAAIwB,IAAAA,CAAKG,MAAM,IAAIX,OAAS,EAAA;QAC1B,OAAOsC,wBAAAA,CAAyB7B,MAAMG,eAAe,EAAEH,MAAMrE,MAAM,EAAEmG,QAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;AACvF;AACA,IAAA,MAAMoE,GAAMF,GAAAA,yBAAAA,CAA0B1C,IAAMC,EAAAA,KAAAA,EAAO8B,QAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;AACnEoE,IAAAA,GAAAA,CAAInH,GAAG,GAAG,KAAA;IACV,OAAOmH,GAAAA;AACT;AAEA;AAEO,SAASG,oBACdM,CAAAA,IAAa,EACbC,IAAa,EACbC,IAAa,EACbC,IAAa,EACbhF,GAAyB,EAAA;AAQzB,IAAA,MAAMiF,MAAS7J,GAAAA,OAAAA,CAAQ8J,KAAK,CAACF,MAAMF,IAAMzH,EAAAA,cAAAA,CAAAA;AACzC,IAAA,MAAM8H,EAAK/J,GAAAA,OAAAA,CAAQ8J,KAAK,CAACJ,MAAMG,MAAQ1H,EAAAA,UAAAA,CAAAA;AACvC,IAAA,MAAM6H,MAAShK,GAAAA,OAAAA,CAAQ8J,KAAK,CAACJ,MAAME,IAAM1H,EAAAA,cAAAA,CAAAA;AACzC,IAAA,MAAM+H,EAAKjK,GAAAA,OAAAA,CAAQ8J,KAAK,CAACF,MAAMI,MAAQ5H,EAAAA,UAAAA,CAAAA;AACvC,IAAA,MAAM8H,KAAQlK,GAAAA,OAAAA,CAAQiH,GAAG,CAACyC,IAAMO,EAAAA,EAAAA,CAAAA;AAChC,IAAA,MAAME,KAAQnK,GAAAA,OAAAA,CAAQiH,GAAG,CAAC2C,IAAMG,EAAAA,EAAAA,CAAAA;AAChC,IAAA,MAAMK,OAAUpK,GAAAA,OAAAA,CAAQyF,GAAG,CAACkE,MAAMF,IAAMpH,EAAAA,eAAAA,CAAAA;IACxC,MAAMK,EAAAA,GAAKwH,UAAU,CAAIlK,GAAAA,OAAAA,CAAQiH,GAAG,CAACmD,OAAAA,EAASH,MAAMC,KAAQ,GAAA,CAAA;AAC5D,IAAA,MAAMvH,EAAKwH,GAAAA,KAAAA,KAAU,CAAInK,GAAAA,OAAAA,CAAQiH,GAAG,CAACjH,OAAAA,CAAQiG,KAAK,CAACmE,OAAS,EAAA,EAAIA,EAAAA,OAAAA,CAAAA,EAAUL,MAAMI,KAAQ,GAAA,CAAA;AACxF,IAAA,MAAMvH,QAAW5C,GAAAA,OAAAA,CAAQiG,KAAK,CAACyD,MAAMhH,EAAIJ,EAAAA,gBAAAA,CAAAA;IACzCtC,OAAQkG,CAAAA,GAAG,CAACuD,IAAAA,EAAM7G,QAAUA,EAAAA,QAAAA,CAAAA;AAC5B,IAAA,MAAMC,QAAW7C,GAAAA,OAAAA,CAAQiG,KAAK,CAAC2D,MAAMjH,EAAIJ,EAAAA,gBAAAA,CAAAA;IACzCvC,OAAQkG,CAAAA,GAAG,CAACyD,IAAAA,EAAM9G,QAAUA,EAAAA,QAAAA,CAAAA;AAC5B,IAAA,MAAMgG,IAAO7I,GAAAA,OAAAA,CAAQyF,GAAG,CAAC5C,UAAUD,QAAUJ,EAAAA,iBAAAA,CAAAA;IAC7C,OAAO4C,wBAAAA,CAAyBR,KAAKlC,EAAIC,EAAAA,EAAAA,EAAIC,UAAUC,QAAUgG,EAAAA,IAAAA,CAAKlD,WAAW,EAAE,CAACf,GAAAA,CAAAA;AACtF;AAEA;AAEO,SAASyF,qBAAAA,CACdC,GAAY,EACZC,GAAY,EACZC,GAAY,EACZC,WAAoB,EACpBrE,IAAe,EACfC,KAAiB,EACjBzB,GAAwB,EAAA;AAExB7B,IAAAA,aAAAA,CAAclB,GAAG,GAAG,KAAA;AACpBkB,IAAAA,aAAAA,CAAcC,iBAAiB,CAAC0H,MAAM,CAAC,GAAG,CAAG,EAAA,CAAA,CAAA;AAC7C3H,IAAAA,aAAAA,CAAcE,OAAO,CAACyH,MAAM,CAAC,GAAG,CAAG,EAAA,CAAA,CAAA;IACnC3H,aAAchB,CAAAA,eAAe,CAACiD,GAAG,CAACyF,WAAAA,CAAAA;IAClC1H,aAAcf,CAAAA,MAAM,GAAGqE,KAAAA,CAAMrE,MAAM;AAEnC,IAAA,IAAID,eAAkB0I,GAAAA,WAAAA;IACtB,IAAIzI,MAAAA,GAASqE,MAAMrE,MAAM;IACzB,MAAM2I,SAAAA,GAAYvE,IAAKG,CAAAA,MAAM,GAAGX,OAAAA;AAEhC,IAAA,MAAMgF,SAAYC,GAAAA,gBAAAA,CAAiBP,GAAKC,EAAAA,GAAAA,EAAKC,GAAKtH,EAAAA,iBAAAA,CAAAA;AAClD,IAAA,MAAM4H,MAAS9K,GAAAA,OAAAA,CAAQyF,GAAG,CAAC8E,KAAKD,GAAKnH,EAAAA,cAAAA,CAAAA;AACrC,IAAA,MAAM4H,MAAS/K,GAAAA,OAAAA,CAAQyF,GAAG,CAAC+E,KAAKF,GAAKlH,EAAAA,cAAAA,CAAAA;AACrC,IAAA,MAAM4H,WAAchL,GAAAA,OAAAA,CAAQ8J,KAAK,CAACgB,QAAQC,MAAQ1H,EAAAA,mBAAAA,CAAAA;IAClDrD,OAAQ6G,CAAAA,SAAS,CAACmE,WAAaA,EAAAA,WAAAA,CAAAA;AAC/BhL,IAAAA,OAAAA,CAAQiG,KAAK,CAAC+E,WAAa,EAAA,EAAIA,EAAAA,WAAAA,CAAAA;AAC/B,IAAA,MAAMC,iBAAiBjL,OAAQiG,CAAAA,KAAK,CAAC+E,WAAAA,EAAa,EAAI1H,EAAAA,sBAAAA,CAAAA;AACtD,IAAA,MAAM4H,SAAY,GAAA,CAAClL,OAAQiH,CAAAA,GAAG,CAACgE,cAAgBX,EAAAA,GAAAA,CAAAA;AAC/C,IAAA,MAAMa,WAAcnL,GAAAA,OAAAA,CAAQyF,GAAG,CAACgF,aAAaG,SAAWrH,EAAAA,mBAAAA,CAAAA;IACxDvD,OAAQ6G,CAAAA,SAAS,CAACsE,WAAaA,EAAAA,WAAAA,CAAAA;AAC/B,IAAA,MAAMlE,GAAMjH,GAAAA,OAAAA,CAAQiH,GAAG,CAACkE,WAAaH,EAAAA,WAAAA,CAAAA;AAErC,IAAA,IAAIL,SAAW,EAAA;AACb,QAAA,MAAMS,OAAOpL,OAAQiH,CAAAA,GAAG,CAACZ,KAAMM,CAAAA,gBAAgB,EAAEqE,WAAe/D,CAAAA,GAAAA,GAAAA;AAChE,QAAA,MAAMoE,SAASrL,OAAQiG,CAAAA,KAAK,CAAC+E,WAAa/D,EAAAA,GAAAA,GAAM,EAAIzD,EAAAA,cAAAA,CAAAA;AACpD,QAAA,MAAM8H,OAAUvJ,GAAAA,eAAAA;AAEhB,QAAA,IAAIqJ,OAAO,CAAG,EAAA;AACZpJ,YAAAA,MAAAA,GAASqE,KAAMrE,CAAAA,MAAM,GAAGoE,IAAAA,CAAKe,eAAe;AAC5CpF,YAAAA,eAAAA,GAAkB/B,QAAQkG,GAAG,CAACuE,WAAapE,EAAAA,KAAAA,CAAMM,gBAAgB,EAAEjD,YAAAA,CAAAA;AACrE;AAEA,QAAA,MAAM6H,OAAUvL,GAAAA,OAAAA,CAAQ6G,SAAS,CAACwE,MAAQ5H,EAAAA,eAAAA,CAAAA;AAC1C,QAAA,MAAM+H,KAAQC,GAAAA,OAAAA,CAAQR,cAAgBC,EAAAA,SAAAA,EAAWnJ,eAAiBwJ,EAAAA,OAAAA,CAAAA;AAClE,QAAA,IAAIC,UAAU,IAAM,EAAA;AAClB,YAAA,MAAME,EAAK1L,GAAAA,OAAAA,CAAQiG,KAAK,CAACsF,SAASC,KAAO7H,EAAAA,oBAAAA,CAAAA;YACzC3D,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB2J,EAAIA,EAAAA,EAAAA,CAAAA;AACjC,YAAA,IAAIC,qBAAsBrB,CAAAA,GAAAA,EAAKC,GAAKC,EAAAA,GAAAA,EAAKkB,EAAK,CAAA,EAAA;AAC5C,gBAAA,MAAMzI,OAAUjD,GAAAA,OAAAA,CAAQyF,GAAG,CAACiG,IAAI3J,eAAiB6B,EAAAA,eAAAA,CAAAA;AACjD,gBAAA,MAAMgI,KAAQ5L,GAAAA,OAAAA,CAAQyF,GAAG,CAAC1D,iBAAiB2J,EAAI7H,EAAAA,aAAAA,CAAAA;AAC/C,gBAAA,IAAI+H,KAAMjG,CAAAA,WAAW,IAAI3D,MAAAA,GAASA,MAAQ,EAAA;AACxC,oBAAA,OAAOmD,wBAAwBP,GAAK,EAAA,IAAA,EAAM8G,IAAIzI,OAASlB,EAAAA,eAAAA,EAAiBC,QAAQ,CAAC4C,GAAAA,CAAAA;AACnF;AACF;AACF,SAAA,MAAO,IAAIwB,IAAKyF,CAAAA,SAAS,KAAKC,aAAAA,CAAcC,GAAG,EAAE;YAC/ChK,eAAkBuJ,GAAAA,OAAAA;AAClB,YAAA,IAAIU,SAAShM,OAAQkG,CAAAA,GAAG,CAACuE,WAAapE,EAAAA,KAAAA,CAAMM,gBAAgB,EAAE7C,cAAAA,CAAAA;YAC9DC,iBAAkBiB,CAAAA,GAAG,CAACqB,KAAAA,CAAMM,gBAAgB,CAAA;AAC5C,YAAA,IAAIsF,SAAYlI,GAAAA,iBAAAA;AAChB,YAAA,IAAIqC,IAAKyF,CAAAA,SAAS,KAAKC,aAAAA,CAAcI,IAAI,EAAE;AACzC,gBAAA,MAAMC,GAAMpK,GAAAA,eAAAA;gBACZA,eAAkBiK,GAAAA,MAAAA;gBAClBA,MAASG,GAAAA,GAAAA;AACTF,gBAAAA,SAAAA,GAAYjM,OAAQiG,CAAAA,KAAK,CAACgG,SAAAA,EAAW,EAAIA,EAAAA,SAAAA,CAAAA;AAC3C;AACA,YAAA,MAAMG,MAASX,GAAAA,OAAAA,CAAQR,cAAgBC,EAAAA,SAAAA,EAAWnJ,eAAiBkK,EAAAA,SAAAA,CAAAA;AACnE,YAAA,IAAIG,WAAW,IAAM,EAAA;AACnB,gBAAA,MAAMV,EAAK1L,GAAAA,OAAAA,CAAQiG,KAAK,CAACgG,WAAWG,MAAQzI,EAAAA,oBAAAA,CAAAA;gBAC5C3D,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB2J,EAAIA,EAAAA,EAAAA,CAAAA;AACjC,gBAAA,IAAIC,qBAAsBrB,CAAAA,GAAAA,EAAKC,GAAKC,EAAAA,GAAAA,EAAKkB,EAAK,CAAA,EAAA;AAC5C,oBAAA,MAAMW,aAAgBrM,GAAAA,OAAAA,CAAQyF,GAAG,CAACuG,QAAQN,EAAI1H,EAAAA,qBAAAA,CAAAA;AAC9C,oBAAA,MAAMsI,QAAWtM,GAAAA,OAAAA,CAAQyF,GAAG,CAACuG,QAAQjK,eAAiBkC,EAAAA,gBAAAA,CAAAA;AACtD,oBAAA,MAAMsI,cAAiBvM,GAAAA,OAAAA,CAAQyF,GAAG,CAACiG,IAAI3J,eAAiBmC,EAAAA,sBAAAA,CAAAA;AACxD,oBAAA,MAAMsI,IAAOxM,GAAAA,OAAAA,CAAQiH,GAAG,CAACoF,aAAeE,EAAAA,cAAAA,CAAAA;AACxC,oBAAA,MAAME,IAAOzM,GAAAA,OAAAA,CAAQiH,GAAG,CAACqF,QAAUA,EAAAA,QAAAA,CAAAA;AACnC,oBAAA,IAAI,EAAEE,IAAAA,IAAQ,CAAKA,IAAAA,IAAAA,IAAQC,IAAG,CAAI,EAAA;AAChC,wBAAA,OAAOtH,wBACLP,GACA7B,EAAAA,aAAAA,CAAclB,GAAG,EACjBkB,cAAcC,iBAAiB,EAC/BD,aAAcE,CAAAA,OAAO,EACrBF,aAAchB,CAAAA,eAAe,EAC7BgB,aAAcf,CAAAA,MAAM,EACpB,CAAC4C,GAAAA,CAAAA;AAEL;AACA,oBAAA,MAAM8H,MAAS1M,GAAAA,OAAAA,CAAQiH,GAAG,CAACqF,QAAUC,EAAAA,cAAAA,CAAAA;AACrC,oBAAA,MAAMI,MAAS3M,GAAAA,OAAAA,CAAQiH,GAAG,CAACqF,QAAUA,EAAAA,QAAAA,CAAAA;AACrC,oBAAA,MAAMM,SAAY5M,GAAAA,OAAAA,CAAQ6G,SAAS,CAACyF,QAAUA,EAAAA,QAAAA,CAAAA;AAC9C,oBAAA,MAAMO,OAAO7M,OAAQiG,CAAAA,KAAK,CAAC2G,SAAAA,EAAW,CAAC5K,MAAQmC,EAAAA,YAAAA,CAAAA;oBAC/CnE,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB8K,IAAMA,EAAAA,IAAAA,CAAAA;AACnC,oBAAA,MAAM5J,OAAUjD,GAAAA,OAAAA,CAAQyF,GAAG,CAACiG,IAAImB,IAAMjJ,EAAAA,eAAAA,CAAAA;AACtC,oBAAA,MAAMkJ,OAAO9M,OAAQiG,CAAAA,KAAK,CAACqG,QAAAA,EAAUI,SAASC,MAAQvI,EAAAA,YAAAA,CAAAA;oBACtDpE,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB+K,IAAMA,EAAAA,IAAAA,CAAAA;AACnC,oBAAA,MAAMlB,KAAQ5L,GAAAA,OAAAA,CAAQyF,GAAG,CAACqH,MAAMpB,EAAI7H,EAAAA,aAAAA,CAAAA;AACpC,oBAAA,IAAI+H,KAAMjG,CAAAA,WAAW,IAAI3D,MAAAA,GAASA,MAAQ,EAAA;AACxC,wBAAA,OAAOmD,wBAAwBP,GAAK,EAAA,IAAA,EAAM8G,IAAIzI,OAAS6J,EAAAA,IAAAA,EAAM9K,QAAQ,CAAC4C,GAAAA,CAAAA;AACxE;AACF;AACF;AACF;KACK,MAAA;AACL,QAAA,MAAMyG,SAASrL,OAAQiG,CAAAA,KAAK,CAAC+E,WAAa/D,EAAAA,GAAAA,GAAM,EAAIzD,EAAAA,cAAAA,CAAAA;AACpD,QAAA,MAAM+H,OAAUvL,GAAAA,OAAAA,CAAQ6G,SAAS,CAACwE,MAAQ5H,EAAAA,eAAAA,CAAAA;AAC1C,QAAA,MAAM+H,KAAQC,GAAAA,OAAAA,CAAQR,cAAgBC,EAAAA,SAAAA,EAAWnJ,eAAiBwJ,EAAAA,OAAAA,CAAAA;AAClE,QAAA,IAAIC,UAAU,IAAM,EAAA;AAClB,YAAA,MAAME,EAAK1L,GAAAA,OAAAA,CAAQiG,KAAK,CAACsF,SAASC,KAAO7H,EAAAA,oBAAAA,CAAAA;YACzC3D,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB2J,EAAIA,EAAAA,EAAAA,CAAAA;AACjC,YAAA,IAAIC,qBAAsBrB,CAAAA,GAAAA,EAAKC,GAAKC,EAAAA,GAAAA,EAAKkB,EAAK,CAAA,EAAA;AAC5C,gBAAA,MAAMzI,OAAUjD,GAAAA,OAAAA,CAAQyF,GAAG,CAACiG,IAAI3J,eAAiB6B,EAAAA,eAAAA,CAAAA;AACjD,gBAAA,MAAMgI,KAAQ5L,GAAAA,OAAAA,CAAQyF,GAAG,CAAC1D,iBAAiB2J,EAAI7H,EAAAA,aAAAA,CAAAA;AAC/C,gBAAA,IAAI+H,KAAMjG,CAAAA,WAAW,IAAI3D,MAAAA,GAASA,MAAQ,EAAA;AACxC,oBAAA,OAAOmD,wBAAwBP,GAAK,EAAA,IAAA,EAAM8G,IAAIzI,OAASlB,EAAAA,eAAAA,EAAiBC,QAAQ,CAAC4C,GAAAA,CAAAA;AACnF;AACF;AACF;AACF;AAEA,IAAA,OAAOO,wBACLP,GACA7B,EAAAA,aAAAA,CAAclB,GAAG,EACjBkB,cAAcC,iBAAiB,EAC/BD,aAAcE,CAAAA,OAAO,EACrBF,aAAchB,CAAAA,eAAe,EAC7BgB,aAAcf,CAAAA,MAAM,EACpB,CAAC4C,GAAAA,CAAAA;AAEL;AAEA;AAEA,SAAS6G,QAAQsB,MAAe,EAAE7B,SAAiB,EAAE8B,MAAe,EAAExH,SAAkB,EAAA;AACtF,IAAA,MAAMyH,IAAOjN,GAAAA,OAAAA,CAAQiH,GAAG,CAACzB,SAAWuH,EAAAA,MAAAA,CAAAA;AACpC,IAAA,MAAMG,OAAO,CAAClN,OAAAA,CAAQiH,GAAG,CAAC+F,QAAQD,MAAU7B,CAAAA,GAAAA,SAAAA;AAC5C,IAAA,IAAIpF,IAAKqH,CAAAA,GAAG,CAACF,IAAAA,CAAAA,IAASrH,OAAS,EAAA;QAC7B,OAAO,IAAA;AACT;AACA,IAAA,MAAM4F,QAAQ0B,IAAOD,GAAAA,IAAAA;IACrB,OAAOzB,KAAAA,GAAQ,IAAIA,KAAQ,GAAA,IAAA;AAC7B;AAEA,SAASX,iBAAiBuC,CAAU,EAAEC,CAAU,EAAEC,CAAU,EAAEC,MAAgB,EAAA;AAC5EA,IAAAA,MAAAA,GAASA,UAAU,IAAIvN,OAAAA,EAAAA;AACvB,IAAA,OAAOuN,OAAO7C,MAAM,CAAC,CAAC0C,CAAAA,CAAEI,CAAC,GAAGH,CAAAA,CAAEG,CAAC,GAAGF,EAAEE,CAAAA,IAAK,CAAG,EAACJ,CAAAA,CAAEK,CAAAA,CAAC,GAAGJ,CAAAA,CAAEI,CAAC,GAAGH,CAAAA,CAAEG,CAAC,IAAI,GAAG,CAACL,CAAEM,CAAAA,CAAC,GAAGL,CAAEK,CAAAA,CAAC,GAAGJ,CAAEI,CAAAA,CAAC,IAAI,CAAA,CAAA;AACzF;AAEA,SAAS/B,sBAAsByB,CAAU,EAAEC,CAAU,EAAEC,CAAU,EAAEK,CAAU,EAAA;AAC3E,IAAA,MAAMC,EAAK5N,GAAAA,OAAAA,CAAQyF,GAAG,CAAC2H,GAAGO,CAAGtJ,EAAAA,WAAAA,CAAAA;AAC7B,IAAA,MAAMwJ,EAAK7N,GAAAA,OAAAA,CAAQyF,GAAG,CAAC4H,GAAGM,CAAGrJ,EAAAA,WAAAA,CAAAA;AAC7B,IAAA,MAAMwJ,EAAK9N,GAAAA,OAAAA,CAAQyF,GAAG,CAAC6H,GAAGK,CAAGpJ,EAAAA,WAAAA,CAAAA;AAC7B,IAAA,MAAMwJ,CAAI/N,GAAAA,OAAAA,CAAQ8J,KAAK,CAAC8D,IAAIC,EAAIrJ,EAAAA,UAAAA,CAAAA;AAChC,IAAA,MAAMwJ,EAAKhO,GAAAA,OAAAA,CAAQ8J,KAAK,CAAC+D,IAAIC,EAAIrJ,EAAAA,UAAAA,CAAAA;AACjC,IAAA,MAAMwJ,CAAIjO,GAAAA,OAAAA,CAAQ8J,KAAK,CAACgE,IAAIF,EAAIlJ,EAAAA,UAAAA,CAAAA;AAChC,IAAA,IAAI1E,OAAQiH,CAAAA,GAAG,CAAC8G,CAAAA,EAAGC,MAAM,CAAG,EAAA;QAC1B,OAAO,KAAA;AACT;AACA,IAAA,IAAIhO,OAAQiH,CAAAA,GAAG,CAAC+G,EAAAA,EAAIC,KAAK,CAAG,EAAA;QAC1B,OAAO,KAAA;AACT;IACA,OAAO,IAAA;AACT;AAEA,SAASxG,IAAK2F,CAAAA,CAAS,EAAEC,CAAS,EAAEa,CAAS,EAAA;AAC3C,IAAA,OAAOd,CAAI,GAACC,CAAAA,CAAAA,GAAID,CAAAA,IAAKc,CAAAA;AACvB;;;;"}
+{"version":3,"file":"collision.js","sources":["../../../src/animation/joint_dynamics/collision.ts"],"sourcesContent":["// Collision detection & response - direct port of SPCRJointDynamicsJob.cs Collision class\r\n\r\nimport { Vector3 } from '@zephyr3d/base';\r\nimport type { ColliderR, ColliderRW, PointR } from './types';\r\nimport { EPSILON, ColliderForce } from './types';\r\n\r\n/** @public */\r\nexport interface CollisionResult {\r\n  hit: boolean;\r\n  point: Vector3;\r\n}\r\n\r\n/** @public */\r\nexport interface LineCollisionResult {\r\n  hit: boolean;\r\n  pointOnLine: Vector3;\r\n  pointOnCollider: Vector3;\r\n  radius: number;\r\n}\r\n\r\n/** @public */\r\nexport interface SurfaceCheckResult {\r\n  hit: boolean;\r\n  intersectionPoint: Vector3;\r\n  pushOut: Vector3;\r\n  pointOnCollider: Vector3;\r\n  radius: number;\r\n}\r\n\r\n/** @public */\r\nexport interface NearestPointsResult {\r\n  tP: number;\r\n  tQ: number;\r\n  pointOnP: Vector3;\r\n  pointOnQ: Vector3;\r\n  sqrDistance: number;\r\n}\r\n\r\nconst _pushoutSphereDirection = new Vector3();\r\nconst _pushoutSphereScaled = new Vector3();\r\nconst _pushoutCapsuleVecN = new Vector3();\r\nconst _pushoutCapsuleTargetVec = new Vector3();\r\nconst _pushoutCapsuleTail = new Vector3();\r\nconst _pushoutCapsulePosOnVec = new Vector3();\r\nconst _pushoutCapsulePushVec = new Vector3();\r\nconst _pushoutCapsuleScaled = new Vector3();\r\nconst _pushInSphereDirection = new Vector3();\r\nconst _pushInSphereDirectionN = new Vector3();\r\nconst _pushInSphereScaled = new Vector3();\r\nconst _pushInCapsuleVecN = new Vector3();\r\nconst _pushInCapsuleTargetVec = new Vector3();\r\nconst _pushInCapsuleTail = new Vector3();\r\nconst _pushInCapsulePosOnVec = new Vector3();\r\nconst _pushInCapsulePullVec = new Vector3();\r\nconst _pushInCapsulePullVecN = new Vector3();\r\nconst _pushInCapsuleScaled = new Vector3();\r\nconst _collisionSphereDir = new Vector3();\r\nconst _collisionSphereDirN = new Vector3();\r\nconst _collisionSphereToCenter = new Vector3();\r\nconst _collisionSphereScaled = new Vector3();\r\nconst _collisionSphereDiff = new Vector3();\r\nconst _collisionCapsuleTail = new Vector3();\r\nconst _collisionCapsulePointDir = new Vector3();\r\nconst _collisionCapsulePtOnCol = new Vector3();\r\nconst _collisionCapsulePtOnLine = new Vector3();\r\nconst _collisionCapsuleDiff = new Vector3();\r\nconst _collisionCapsuleTempLineResult: LineCollisionResult = {\r\n  hit: false,\r\n  pointOnLine: new Vector3(),\r\n  pointOnCollider: new Vector3(),\r\n  radius: 0\r\n};\r\nconst _nearestCross0 = new Vector3();\r\nconst _nearestCross1 = new Vector3();\r\nconst _nearestN1 = new Vector3();\r\nconst _nearestN2 = new Vector3();\r\nconst _nearestPosDiff = new Vector3();\r\nconst _nearestPointOnP = new Vector3();\r\nconst _nearestPointOnQ = new Vector3();\r\nconst _nearestPointDiff = new Vector3();\r\nconst _nearestResult: NearestPointsResult = {\r\n  tP: 0,\r\n  tQ: 0,\r\n  pointOnP: new Vector3(),\r\n  pointOnQ: new Vector3(),\r\n  sqrDistance: 0\r\n};\r\nconst _surfaceNoHit: SurfaceCheckResult = {\r\n  hit: false,\r\n  intersectionPoint: new Vector3(),\r\n  pushOut: new Vector3(),\r\n  pointOnCollider: new Vector3(),\r\n  radius: 0\r\n};\r\nconst _surfaceTriCenter = new Vector3();\r\nconst _surfaceEdgeAB = new Vector3();\r\nconst _surfaceEdgeAC = new Vector3();\r\nconst _surfacePlaneNormal = new Vector3();\r\nconst _surfacePlaneNormalNeg = new Vector3();\r\nconst _surfaceColliderDir = new Vector3();\r\nconst _surfaceRayDir = new Vector3();\r\nconst _surfaceRayDirN = new Vector3();\r\nconst _surfaceTail = new Vector3();\r\nconst _surfaceIntersection = new Vector3();\r\nconst _surfacePushOut = new Vector3();\r\nconst _surfaceToCol = new Vector3();\r\nconst _surfaceEndVec = new Vector3();\r\nconst _surfaceColDirVec = new Vector3();\r\nconst _surfaceIntersecToEnd = new Vector3();\r\nconst _surfaceColToEnd = new Vector3();\r\nconst _surfaceColToIntersect = new Vector3();\r\nconst _surfaceEVec = new Vector3();\r\nconst _surfacePoc2 = new Vector3();\r\nconst _triangleAp = new Vector3();\r\nconst _triangleBp = new Vector3();\r\nconst _triangleCp = new Vector3();\r\nconst _triangleU = new Vector3();\r\nconst _triangleV = new Vector3();\r\nconst _triangleW = new Vector3();\r\n\r\nfunction writeCollisionResult(\r\n  out: CollisionResult | undefined,\r\n  hit: boolean,\r\n  point: Vector3,\r\n  copyPoint: boolean\r\n) {\r\n  if (!out) {\r\n    return { hit, point: copyPoint ? point.clone() : point };\r\n  }\r\n  if (!out.point) {\r\n    out.point = new Vector3();\r\n  }\r\n  out.hit = hit;\r\n  out.point.set(point);\r\n  return out;\r\n}\r\n\r\nfunction writeLineCollisionResult(\r\n  out: LineCollisionResult | undefined,\r\n  hit: boolean,\r\n  pointOnLine: Vector3,\r\n  pointOnCollider: Vector3,\r\n  radius: number,\r\n  copyVectors: boolean\r\n) {\r\n  if (!out) {\r\n    return {\r\n      hit,\r\n      pointOnLine: copyVectors ? pointOnLine.clone() : pointOnLine,\r\n      pointOnCollider: copyVectors ? pointOnCollider.clone() : pointOnCollider,\r\n      radius\r\n    };\r\n  }\r\n  if (!out.pointOnLine) {\r\n    out.pointOnLine = new Vector3();\r\n  }\r\n  if (!out.pointOnCollider) {\r\n    out.pointOnCollider = new Vector3();\r\n  }\r\n  out.hit = hit;\r\n  out.pointOnLine.set(pointOnLine);\r\n  out.pointOnCollider.set(pointOnCollider);\r\n  out.radius = radius;\r\n  return out;\r\n}\r\n\r\nfunction writeSurfaceCheckResult(\r\n  out: SurfaceCheckResult | undefined,\r\n  hit: boolean,\r\n  intersectionPoint: Vector3,\r\n  pushOut: Vector3,\r\n  pointOnCollider: Vector3,\r\n  radius: number,\r\n  copyVectors: boolean\r\n) {\r\n  if (!out) {\r\n    return {\r\n      hit,\r\n      intersectionPoint: copyVectors ? intersectionPoint.clone() : intersectionPoint,\r\n      pushOut: copyVectors ? pushOut.clone() : pushOut,\r\n      pointOnCollider: copyVectors ? pointOnCollider.clone() : pointOnCollider,\r\n      radius\r\n    };\r\n  }\r\n  if (!out.intersectionPoint) {\r\n    out.intersectionPoint = new Vector3();\r\n  }\r\n  if (!out.pushOut) {\r\n    out.pushOut = new Vector3();\r\n  }\r\n  if (!out.pointOnCollider) {\r\n    out.pointOnCollider = new Vector3();\r\n  }\r\n  out.hit = hit;\r\n  out.intersectionPoint.set(intersectionPoint);\r\n  out.pushOut.set(pushOut);\r\n  out.pointOnCollider.set(pointOnCollider);\r\n  out.radius = radius;\r\n  return out;\r\n}\r\n\r\nfunction writeNearestPointsResult(\r\n  out: NearestPointsResult | undefined,\r\n  tP: number,\r\n  tQ: number,\r\n  pointOnP: Vector3,\r\n  pointOnQ: Vector3,\r\n  sqrDistance: number,\r\n  copyVectors: boolean\r\n) {\r\n  if (!out) {\r\n    return {\r\n      tP,\r\n      tQ,\r\n      pointOnP: copyVectors ? pointOnP.clone() : pointOnP,\r\n      pointOnQ: copyVectors ? pointOnQ.clone() : pointOnQ,\r\n      sqrDistance\r\n    };\r\n  }\r\n  out.tP = tP;\r\n  out.tQ = tQ;\r\n  out.pointOnP.set(pointOnP);\r\n  out.pointOnQ.set(pointOnQ);\r\n  out.sqrDistance = sqrDistance;\r\n  return out;\r\n}\r\n\r\n// Pushout (keep point outside collider)\r\n\r\n/**\r\n * Pushes a point out of a sphere collider.\r\n *\r\n * @public\r\n */\r\nexport function pushoutFromSphere(\r\n  center: Vector3,\r\n  radius: number,\r\n  pointRadius: number,\r\n  point: Vector3,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  const direction = Vector3.sub(point, center, _pushoutSphereDirection);\r\n  const sqrLen = direction.magnitudeSq;\r\n  if (sqrLen > EPSILON) {\r\n    const dirLen = Math.sqrt(sqrLen) - pointRadius;\r\n    if (dirLen < radius) {\r\n      const scaled = Vector3.scale(direction, radius / dirLen, _pushoutSphereScaled);\r\n      Vector3.add(center, scaled, scaled);\r\n      return writeCollisionResult(out, true, scaled, !out);\r\n    }\r\n  }\r\n  return writeCollisionResult(out, false, point, !out);\r\n}\r\n\r\n/**\r\n * Pushes a point out of a collider.\r\n *\r\n * @public\r\n */\r\nexport function pushoutFromCollider(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point: Vector3,\r\n  ptR: PointR,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  if (colR.height <= EPSILON) {\r\n    return pushoutFromSphere(colRW.positionCurrent, colRW.radius, ptR.pointRadius, point, out);\r\n  }\r\n  return pushoutFromCapsule(colR, colRW, point, ptR, out);\r\n}\r\n\r\n/**\r\n * Pushes a point out of a capsule collider.\r\n *\r\n * @public\r\n */\r\nexport function pushoutFromCapsule(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point: Vector3,\r\n  ptR: PointR,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  const capsuleVec = colRW.directionCurrent;\r\n  const capsuleVecN = Vector3.normalize(capsuleVec, _pushoutCapsuleVecN);\r\n  const capsulePos = colRW.positionCurrent;\r\n  const targetVec = Vector3.sub(point, capsulePos, _pushoutCapsuleTargetVec);\r\n  const distOnVec = Vector3.dot(capsuleVecN, targetVec);\r\n\r\n  if (distOnVec <= EPSILON) {\r\n    return pushoutFromSphere(capsulePos, colRW.radius, ptR.pointRadius, point, out);\r\n  }\r\n  if (distOnVec >= colR.height) {\r\n    const tail = Vector3.add(capsulePos, capsuleVec, _pushoutCapsuleTail);\r\n    return pushoutFromSphere(tail, colRW.radius * colR.radiusTailScale, ptR.pointRadius, point, out);\r\n  }\r\n\r\n  const posOnVec = Vector3.scale(capsuleVecN, distOnVec, _pushoutCapsulePosOnVec);\r\n  Vector3.add(capsulePos, posOnVec, posOnVec);\r\n  const pushVec = Vector3.sub(point, posOnVec, _pushoutCapsulePushVec);\r\n  const sqrPushDist = pushVec.magnitudeSq;\r\n  if (sqrPushDist > EPSILON) {\r\n    const pushDist = Math.sqrt(sqrPushDist) - ptR.pointRadius;\r\n    const r = colRW.radius * lerp(1.0, colR.radiusTailScale, distOnVec / colR.height);\r\n    if (pushDist < r) {\r\n      const scaled = Vector3.scale(pushVec, r / pushDist, _pushoutCapsuleScaled);\r\n      Vector3.add(posOnVec, scaled, scaled);\r\n      return writeCollisionResult(out, true, scaled, !out);\r\n    }\r\n  }\r\n  return writeCollisionResult(out, false, point, !out);\r\n}\r\n\r\n// PushIn (keep point inside collider - inverse mode)\r\n\r\n/**\r\n * Pulls a point inside a sphere collider.\r\n *\r\n * @public\r\n */\r\nexport function pushInFromSphere(\r\n  center: Vector3,\r\n  radius: number,\r\n  point: Vector3,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  const direction = Vector3.sub(center, point, _pushInSphereDirection);\r\n  const sqrLen = direction.magnitudeSq;\r\n  if (sqrLen > EPSILON && sqrLen > radius * radius) {\r\n    const dirLen = Math.sqrt(sqrLen);\r\n    const directionN = Vector3.normalize(direction, _pushInSphereDirectionN);\r\n    const scaled = Vector3.scale(directionN, dirLen - radius, _pushInSphereScaled);\r\n    Vector3.add(point, scaled, scaled);\r\n    return writeCollisionResult(out, true, scaled, !out);\r\n  }\r\n  return writeCollisionResult(out, false, point, !out);\r\n}\r\n\r\n/**\r\n * Pulls a point inside a collider.\r\n *\r\n * @public\r\n */\r\nexport function pushInFromCollider(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point: Vector3,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  if (colR.height <= EPSILON) {\r\n    return pushInFromSphere(colRW.positionCurrent, colRW.radius, point, out);\r\n  }\r\n  return pushInFromCapsule(colR, colRW, point, out);\r\n}\r\n\r\n/**\r\n * Pulls a point inside a capsule collider.\r\n *\r\n * @public\r\n */\r\nexport function pushInFromCapsule(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point: Vector3,\r\n  out?: CollisionResult\r\n): CollisionResult {\r\n  const capsuleVec = colRW.directionCurrent;\r\n  const capsuleVecN = Vector3.normalize(capsuleVec, _pushInCapsuleVecN);\r\n  const capsulePos = colRW.positionCurrent;\r\n  const targetVec = Vector3.sub(point, capsulePos, _pushInCapsuleTargetVec);\r\n  const distOnVec = Vector3.dot(capsuleVecN, targetVec);\r\n\r\n  if (distOnVec <= EPSILON) {\r\n    return pushInFromSphere(capsulePos, colRW.radius, point, out);\r\n  }\r\n  if (distOnVec >= colR.height) {\r\n    const tail = Vector3.add(capsulePos, capsuleVec, _pushInCapsuleTail);\r\n    return pushInFromSphere(tail, colRW.radius * colR.radiusTailScale, point, out);\r\n  }\r\n\r\n  const posOnVec = Vector3.scale(capsuleVecN, distOnVec, _pushInCapsulePosOnVec);\r\n  Vector3.add(capsulePos, posOnVec, posOnVec);\r\n  const pullVec = Vector3.sub(posOnVec, point, _pushInCapsulePullVec);\r\n  const sqrPullDist = pullVec.magnitudeSq;\r\n  if (sqrPullDist > EPSILON) {\r\n    const r = colRW.radius * lerp(1.0, colR.radiusTailScale, colR.height / distOnVec);\r\n    if (sqrPullDist > r * r) {\r\n      const pullDist = Math.sqrt(sqrPullDist);\r\n      const pullVecN = Vector3.normalize(pullVec, _pushInCapsulePullVecN);\r\n      const scaled = Vector3.scale(pullVecN, pullDist - r, _pushInCapsuleScaled);\r\n      Vector3.add(point, scaled, scaled);\r\n      return writeCollisionResult(out, true, scaled, !out);\r\n    }\r\n  }\r\n  return writeCollisionResult(out, false, point, !out);\r\n}\r\n\r\n// Line segment vs collider detection\r\n\r\n/**\r\n * Performs sphere collision detection.\r\n *\r\n * @public\r\n */\r\nexport function collisionDetectionSphere(\r\n  center: Vector3,\r\n  radius: number,\r\n  point1: Vector3,\r\n  point2: Vector3,\r\n  out?: LineCollisionResult\r\n): LineCollisionResult {\r\n  const dir = Vector3.sub(point2, point1, _collisionSphereDir);\r\n  const dirLen = dir.magnitude;\r\n  if (dirLen < EPSILON) {\r\n    return writeLineCollisionResult(out, false, point1, center, radius, !out);\r\n  }\r\n  const dirN = Vector3.scale(dir, 1 / dirLen, _collisionSphereDirN);\r\n  const toCenter = Vector3.sub(center, point1, _collisionSphereToCenter);\r\n  const dot = Vector3.dot(dirN, toCenter);\r\n  const clamped = Math.max(0, Math.min(dot, dirLen));\r\n  const ptOnLine = Vector3.scale(dirN, clamped, _collisionSphereScaled);\r\n  Vector3.add(point1, ptOnLine, ptOnLine);\r\n  const diff = Vector3.sub(center, ptOnLine, _collisionSphereDiff);\r\n  const hit = diff.magnitudeSq <= radius * radius;\r\n  return writeLineCollisionResult(out, hit, ptOnLine, center, radius, !out);\r\n}\r\n\r\n/**\r\n * Performs capsule collision detection.\r\n *\r\n * @public\r\n */\r\nexport function collisionDetectionCapsule(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point1: Vector3,\r\n  point2: Vector3,\r\n  out?: LineCollisionResult\r\n): LineCollisionResult {\r\n  const capsuleDir = colRW.directionCurrent;\r\n  const capsulePos = colRW.positionCurrent;\r\n\r\n  let res = collisionDetectionSphere(capsulePos, colRW.radius, point1, point2, out);\r\n  if (res.hit) {\r\n    return res;\r\n  }\r\n\r\n  const tail = Vector3.add(capsulePos, capsuleDir, _collisionCapsuleTail);\r\n  res = collisionDetectionSphere(\r\n    tail,\r\n    colRW.radius * colR.radiusTailScale,\r\n    point1,\r\n    point2,\r\n    _collisionCapsuleTempLineResult\r\n  );\r\n  if (res.hit) {\r\n    return writeLineCollisionResult(out, true, res.pointOnLine, res.pointOnCollider, res.radius, !out);\r\n  }\r\n\r\n  const pointDir = Vector3.sub(point2, point1, _collisionCapsulePointDir);\r\n  const nearest = computeNearestPoints(capsulePos, capsuleDir, point1, pointDir, _nearestResult);\r\n  const t1 = Math.max(0, Math.min(1, nearest.tP));\r\n  const r = colRW.radius * lerp(1.0, colR.radiusTailScale, t1);\r\n\r\n  if (nearest.sqrDistance > r * r) {\r\n    return writeLineCollisionResult(out, false, point1, capsulePos, r, !out);\r\n  }\r\n\r\n  const t2 = Math.max(0, Math.min(1, nearest.tQ));\r\n  const ptOnCol = Vector3.scale(capsuleDir, t1, _collisionCapsulePtOnCol);\r\n  Vector3.add(capsulePos, ptOnCol, ptOnCol);\r\n  const ptOnLine = Vector3.scale(pointDir, t2, _collisionCapsulePtOnLine);\r\n  Vector3.add(point1, ptOnLine, ptOnLine);\r\n  const diff = Vector3.sub(ptOnCol, ptOnLine, _collisionCapsuleDiff);\r\n  const hit = diff.magnitudeSq <= r * r;\r\n  return writeLineCollisionResult(out, hit, ptOnLine, ptOnCol, r, !out);\r\n}\r\n\r\n/**\r\n * Performs collision detection against the specified collider.\r\n *\r\n * @public\r\n */\r\nexport function collisionDetection(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point1: Vector3,\r\n  point2: Vector3,\r\n  out?: LineCollisionResult\r\n): LineCollisionResult {\r\n  if (colR.height <= EPSILON) {\r\n    return collisionDetectionSphere(colRW.positionCurrent, colRW.radius, point1, point2, out);\r\n  }\r\n  return collisionDetectionCapsule(colR, colRW, point1, point2, out);\r\n}\r\n\r\n/**\r\n * Performs inward collision detection.\r\n *\r\n * @public\r\n */\r\nexport function pushInCollisionDetection(\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  point1: Vector3,\r\n  point2: Vector3,\r\n  out?: LineCollisionResult\r\n): LineCollisionResult {\r\n  if (colR.height <= EPSILON) {\r\n    return collisionDetectionSphere(colRW.positionCurrent, colRW.radius, point1, point2, out);\r\n  }\r\n  const res = collisionDetectionCapsule(colR, colRW, point1, point2, out);\r\n  res.hit = false;\r\n  return res;\r\n}\r\n\r\n// Nearest points between two line segments\r\n\r\n/**\r\n * Computes the nearest points between two segments.\r\n *\r\n * @public\r\n */\r\nexport function computeNearestPoints(\r\n  posP: Vector3,\r\n  dirP: Vector3,\r\n  posQ: Vector3,\r\n  dirQ: Vector3,\r\n  out?: NearestPointsResult\r\n): {\r\n  tP: number;\r\n  tQ: number;\r\n  pointOnP: Vector3;\r\n  pointOnQ: Vector3;\r\n  sqrDistance: number;\r\n} {\r\n  const cross0 = Vector3.cross(dirQ, dirP, _nearestCross0);\r\n  const n1 = Vector3.cross(dirP, cross0, _nearestN1);\r\n  const cross1 = Vector3.cross(dirP, dirQ, _nearestCross1);\r\n  const n2 = Vector3.cross(dirQ, cross1, _nearestN2);\r\n  const dP_n2 = Vector3.dot(dirP, n2);\r\n  const dQ_n1 = Vector3.dot(dirQ, n1);\r\n  const posDiff = Vector3.sub(posQ, posP, _nearestPosDiff);\r\n  const tP = dP_n2 !== 0 ? Vector3.dot(posDiff, n2) / dP_n2 : 0;\r\n  const tQ = dQ_n1 !== 0 ? Vector3.dot(Vector3.scale(posDiff, -1, posDiff), n1) / dQ_n1 : 0;\r\n  const pointOnP = Vector3.scale(dirP, tP, _nearestPointOnP);\r\n  Vector3.add(posP, pointOnP, pointOnP);\r\n  const pointOnQ = Vector3.scale(dirQ, tQ, _nearestPointOnQ);\r\n  Vector3.add(posQ, pointOnQ, pointOnQ);\r\n  const diff = Vector3.sub(pointOnQ, pointOnP, _nearestPointDiff);\r\n  return writeNearestPointsResult(out, tP, tQ, pointOnP, pointOnQ, diff.magnitudeSq, !out);\r\n}\r\n\r\n// Surface collision (triangle-based)\r\n\r\n/**\r\n * Checks triangle-surface collision against a collider.\r\n *\r\n * @public\r\n */\r\nexport function checkSurfaceCollision(\r\n  ptA: Vector3,\r\n  ptB: Vector3,\r\n  ptC: Vector3,\r\n  colliderPos: Vector3,\r\n  colR: ColliderR,\r\n  colRW: ColliderRW,\r\n  out?: SurfaceCheckResult\r\n): SurfaceCheckResult {\r\n  _surfaceNoHit.hit = false;\r\n  _surfaceNoHit.intersectionPoint.setXYZ(0, 0, 0);\r\n  _surfaceNoHit.pushOut.setXYZ(0, 0, 0);\r\n  _surfaceNoHit.pointOnCollider.set(colliderPos);\r\n  _surfaceNoHit.radius = colRW.radius;\r\n\r\n  let pointOnCollider = colliderPos;\r\n  let radius = colRW.radius;\r\n  const isCapsule = colR.height > EPSILON;\r\n\r\n  const triCenter = centerOfTriangle(ptA, ptB, ptC, _surfaceTriCenter);\r\n  const edgeAB = Vector3.sub(ptB, ptA, _surfaceEdgeAB);\r\n  const edgeAC = Vector3.sub(ptC, ptA, _surfaceEdgeAC);\r\n  const planeNormal = Vector3.cross(edgeAB, edgeAC, _surfacePlaneNormal);\r\n  Vector3.normalize(planeNormal, planeNormal);\r\n  Vector3.scale(planeNormal, -1, planeNormal);\r\n  const planeNormalNeg = Vector3.scale(planeNormal, -1, _surfacePlaneNormalNeg);\r\n  const planeDist = -Vector3.dot(planeNormalNeg, ptA);\r\n  const colliderDir = Vector3.sub(colliderPos, triCenter, _surfaceColliderDir);\r\n  Vector3.normalize(colliderDir, colliderDir);\r\n  const dot = Vector3.dot(colliderDir, planeNormal);\r\n\r\n  if (isCapsule) {\r\n    const side = Vector3.dot(colRW.directionCurrent, planeNormal) * dot;\r\n    const rayDir = Vector3.scale(planeNormal, dot * -1, _surfaceRayDir);\r\n    const tempPOC = pointOnCollider;\r\n\r\n    if (side < 0) {\r\n      radius = colRW.radius * colR.radiusTailScale;\r\n      pointOnCollider = Vector3.add(colliderPos, colRW.directionCurrent, _surfaceTail);\r\n    }\r\n\r\n    const rayDirN = Vector3.normalize(rayDir, _surfaceRayDirN);\r\n    const enter = raycast(planeNormalNeg, planeDist, pointOnCollider, rayDirN);\r\n    if (enter !== null) {\r\n      const ip = Vector3.scale(rayDirN, enter, _surfaceIntersection);\r\n      Vector3.add(pointOnCollider, ip, ip);\r\n      if (triangleContainsPoint(ptA, ptB, ptC, ip)) {\r\n        const pushOut = Vector3.sub(ip, pointOnCollider, _surfacePushOut);\r\n        const toCol = Vector3.sub(pointOnCollider, ip, _surfaceToCol);\r\n        if (toCol.magnitudeSq <= radius * radius) {\r\n          return writeSurfaceCheckResult(out, true, ip, pushOut, pointOnCollider, radius, !out);\r\n        }\r\n      }\r\n    } else if (colR.forceType !== ColliderForce.Off) {\r\n      pointOnCollider = tempPOC;\r\n      let endVec = Vector3.add(colliderPos, colRW.directionCurrent, _surfaceEndVec);\r\n      _surfaceColDirVec.set(colRW.directionCurrent);\r\n      let colDirVec = _surfaceColDirVec;\r\n      if (colR.forceType === ColliderForce.Pull) {\r\n        const tmp = pointOnCollider;\r\n        pointOnCollider = endVec;\r\n        endVec = tmp;\r\n        colDirVec = Vector3.scale(colDirVec, -1, colDirVec);\r\n      }\r\n      const enter2 = raycast(planeNormalNeg, planeDist, pointOnCollider, colDirVec);\r\n      if (enter2 !== null) {\r\n        const ip = Vector3.scale(colDirVec, enter2, _surfaceIntersection);\r\n        Vector3.add(pointOnCollider, ip, ip);\r\n        if (triangleContainsPoint(ptA, ptB, ptC, ip)) {\r\n          const intersecToEnd = Vector3.sub(endVec, ip, _surfaceIntersecToEnd);\r\n          const colToEnd = Vector3.sub(endVec, pointOnCollider, _surfaceColToEnd);\r\n          const colToIntersect = Vector3.sub(ip, pointOnCollider, _surfaceColToIntersect);\r\n          const pDot = Vector3.dot(intersecToEnd, colToIntersect);\r\n          const lDot = Vector3.dot(colToEnd, colToEnd);\r\n          if (!(pDot >= 0 && pDot <= lDot)) {\r\n            return writeSurfaceCheckResult(\r\n              out,\r\n              _surfaceNoHit.hit,\r\n              _surfaceNoHit.intersectionPoint,\r\n              _surfaceNoHit.pushOut,\r\n              _surfaceNoHit.pointOnCollider,\r\n              _surfaceNoHit.radius,\r\n              !out\r\n            );\r\n          }\r\n          const dotVal = Vector3.dot(colToEnd, colToIntersect);\r\n          const s2eMag = Vector3.dot(colToEnd, colToEnd);\r\n          const colToEndN = Vector3.normalize(colToEnd, colToEnd);\r\n          const eVec = Vector3.scale(colToEndN, -radius, _surfaceEVec);\r\n          Vector3.add(pointOnCollider, eVec, eVec);\r\n          const pushOut = Vector3.sub(ip, eVec, _surfacePushOut);\r\n          const poc2 = Vector3.scale(colToEnd, dotVal / s2eMag, _surfacePoc2);\r\n          Vector3.add(pointOnCollider, poc2, poc2);\r\n          const toCol = Vector3.sub(poc2, ip, _surfaceToCol);\r\n          if (toCol.magnitudeSq <= radius * radius) {\r\n            return writeSurfaceCheckResult(out, true, ip, pushOut, poc2, radius, !out);\r\n          }\r\n        }\r\n      }\r\n    }\r\n  } else {\r\n    const rayDir = Vector3.scale(planeNormal, dot * -1, _surfaceRayDir);\r\n    const rayDirN = Vector3.normalize(rayDir, _surfaceRayDirN);\r\n    const enter = raycast(planeNormalNeg, planeDist, pointOnCollider, rayDirN);\r\n    if (enter !== null) {\r\n      const ip = Vector3.scale(rayDirN, enter, _surfaceIntersection);\r\n      Vector3.add(pointOnCollider, ip, ip);\r\n      if (triangleContainsPoint(ptA, ptB, ptC, ip)) {\r\n        const pushOut = Vector3.sub(ip, pointOnCollider, _surfacePushOut);\r\n        const toCol = Vector3.sub(pointOnCollider, ip, _surfaceToCol);\r\n        if (toCol.magnitudeSq <= radius * radius) {\r\n          return writeSurfaceCheckResult(out, true, ip, pushOut, pointOnCollider, radius, !out);\r\n        }\r\n      }\r\n    }\r\n  }\r\n\r\n  return writeSurfaceCheckResult(\r\n    out,\r\n    _surfaceNoHit.hit,\r\n    _surfaceNoHit.intersectionPoint,\r\n    _surfaceNoHit.pushOut,\r\n    _surfaceNoHit.pointOnCollider,\r\n    _surfaceNoHit.radius,\r\n    !out\r\n  );\r\n}\r\n\r\n// Helpers\r\n\r\nfunction raycast(normal: Vector3, planeDist: number, origin: Vector3, direction: Vector3): number | null {\r\n  const vdot = Vector3.dot(direction, normal);\r\n  const ndot = -Vector3.dot(origin, normal) - planeDist;\r\n  if (Math.abs(vdot) <= EPSILON) {\r\n    return null;\r\n  }\r\n  const enter = ndot / vdot;\r\n  return enter > 0 ? enter : null;\r\n}\r\n\r\nfunction centerOfTriangle(a: Vector3, b: Vector3, c: Vector3, result?: Vector3): Vector3 {\r\n  result = result || new Vector3();\r\n  return result.setXYZ((a.x + b.x + c.x) / 3, (a.y + b.y + c.y) / 3, (a.z + b.z + c.z) / 3);\r\n}\r\n\r\nfunction triangleContainsPoint(a: Vector3, b: Vector3, c: Vector3, p: Vector3): boolean {\r\n  const ap = Vector3.sub(a, p, _triangleAp);\r\n  const bp = Vector3.sub(b, p, _triangleBp);\r\n  const cp = Vector3.sub(c, p, _triangleCp);\r\n  const u = Vector3.cross(ap, bp, _triangleU);\r\n  const vv = Vector3.cross(bp, cp, _triangleV);\r\n  const w = Vector3.cross(cp, ap, _triangleW);\r\n  if (Vector3.dot(u, vv) < 0) {\r\n    return false;\r\n  }\r\n  if (Vector3.dot(vv, w) < 0) {\r\n    return false;\r\n  }\r\n  return true;\r\n}\r\n\r\nfunction lerp(a: number, b: number, t: number): number {\r\n  return a + (b - a) * t;\r\n}\r\n"],"names":["_pushoutSphereDirection","Vector3","_pushoutSphereScaled","_pushoutCapsuleVecN","_pushoutCapsuleTargetVec","_pushoutCapsuleTail","_pushoutCapsulePosOnVec","_pushoutCapsulePushVec","_pushoutCapsuleScaled","_pushInSphereDirection","_pushInSphereDirectionN","_pushInSphereScaled","_pushInCapsuleVecN","_pushInCapsuleTargetVec","_pushInCapsuleTail","_pushInCapsulePosOnVec","_pushInCapsulePullVec","_pushInCapsulePullVecN","_pushInCapsuleScaled","_collisionSphereDir","_collisionSphereDirN","_collisionSphereToCenter","_collisionSphereScaled","_collisionSphereDiff","_collisionCapsuleTail","_collisionCapsulePointDir","_collisionCapsulePtOnCol","_collisionCapsulePtOnLine","_collisionCapsuleDiff","_collisionCapsuleTempLineResult","hit","pointOnLine","pointOnCollider","radius","_nearestCross0","_nearestCross1","_nearestN1","_nearestN2","_nearestPosDiff","_nearestPointOnP","_nearestPointOnQ","_nearestPointDiff","_nearestResult","tP","tQ","pointOnP","pointOnQ","sqrDistance","_surfaceNoHit","intersectionPoint","pushOut","_surfaceTriCenter","_surfaceEdgeAB","_surfaceEdgeAC","_surfacePlaneNormal","_surfacePlaneNormalNeg","_surfaceColliderDir","_surfaceRayDir","_surfaceRayDirN","_surfaceTail","_surfaceIntersection","_surfacePushOut","_surfaceToCol","_surfaceEndVec","_surfaceColDirVec","_surfaceIntersecToEnd","_surfaceColToEnd","_surfaceColToIntersect","_surfaceEVec","_surfacePoc2","_triangleAp","_triangleBp","_triangleCp","_triangleU","_triangleV","_triangleW","writeCollisionResult","out","point","copyPoint","clone","set","writeLineCollisionResult","copyVectors","writeSurfaceCheckResult","writeNearestPointsResult","pushoutFromSphere","center","pointRadius","direction","sub","sqrLen","magnitudeSq","EPSILON","dirLen","Math","sqrt","scaled","scale","add","pushoutFromCollider","colR","colRW","ptR","height","positionCurrent","pushoutFromCapsule","capsuleVec","directionCurrent","capsuleVecN","normalize","capsulePos","targetVec","distOnVec","dot","tail","radiusTailScale","posOnVec","pushVec","sqrPushDist","pushDist","r","lerp","pushInFromSphere","directionN","pushInFromCollider","pushInFromCapsule","pullVec","sqrPullDist","pullDist","pullVecN","collisionDetectionSphere","point1","point2","dir","magnitude","dirN","toCenter","clamped","max","min","ptOnLine","diff","collisionDetectionCapsule","capsuleDir","res","pointDir","nearest","computeNearestPoints","t1","t2","ptOnCol","collisionDetection","pushInCollisionDetection","posP","dirP","posQ","dirQ","cross0","cross","n1","cross1","n2","dP_n2","dQ_n1","posDiff","checkSurfaceCollision","ptA","ptB","ptC","colliderPos","setXYZ","isCapsule","triCenter","centerOfTriangle","edgeAB","edgeAC","planeNormal","planeNormalNeg","planeDist","colliderDir","side","rayDir","tempPOC","rayDirN","enter","raycast","ip","triangleContainsPoint","toCol","forceType","ColliderForce","Off","endVec","colDirVec","Pull","tmp","enter2","intersecToEnd","colToEnd","colToIntersect","pDot","lDot","dotVal","s2eMag","colToEndN","eVec","poc2","normal","origin","vdot","ndot","abs","a","b","c","result","x","y","z","p","ap","bp","cp","u","vv","w","t"],"mappings":";;;AAAA;AAsCA,MAAMA,0BAA0B,IAAIC,OAAAA,EAAAA;AACpC,MAAMC,uBAAuB,IAAID,OAAAA,EAAAA;AACjC,MAAME,sBAAsB,IAAIF,OAAAA,EAAAA;AAChC,MAAMG,2BAA2B,IAAIH,OAAAA,EAAAA;AACrC,MAAMI,sBAAsB,IAAIJ,OAAAA,EAAAA;AAChC,MAAMK,0BAA0B,IAAIL,OAAAA,EAAAA;AACpC,MAAMM,yBAAyB,IAAIN,OAAAA,EAAAA;AACnC,MAAMO,wBAAwB,IAAIP,OAAAA,EAAAA;AAClC,MAAMQ,yBAAyB,IAAIR,OAAAA,EAAAA;AACnC,MAAMS,0BAA0B,IAAIT,OAAAA,EAAAA;AACpC,MAAMU,sBAAsB,IAAIV,OAAAA,EAAAA;AAChC,MAAMW,qBAAqB,IAAIX,OAAAA,EAAAA;AAC/B,MAAMY,0BAA0B,IAAIZ,OAAAA,EAAAA;AACpC,MAAMa,qBAAqB,IAAIb,OAAAA,EAAAA;AAC/B,MAAMc,yBAAyB,IAAId,OAAAA,EAAAA;AACnC,MAAMe,wBAAwB,IAAIf,OAAAA,EAAAA;AAClC,MAAMgB,yBAAyB,IAAIhB,OAAAA,EAAAA;AACnC,MAAMiB,uBAAuB,IAAIjB,OAAAA,EAAAA;AACjC,MAAMkB,sBAAsB,IAAIlB,OAAAA,EAAAA;AAChC,MAAMmB,uBAAuB,IAAInB,OAAAA,EAAAA;AACjC,MAAMoB,2BAA2B,IAAIpB,OAAAA,EAAAA;AACrC,MAAMqB,yBAAyB,IAAIrB,OAAAA,EAAAA;AACnC,MAAMsB,uBAAuB,IAAItB,OAAAA,EAAAA;AACjC,MAAMuB,wBAAwB,IAAIvB,OAAAA,EAAAA;AAClC,MAAMwB,4BAA4B,IAAIxB,OAAAA,EAAAA;AACtC,MAAMyB,2BAA2B,IAAIzB,OAAAA,EAAAA;AACrC,MAAM0B,4BAA4B,IAAI1B,OAAAA,EAAAA;AACtC,MAAM2B,wBAAwB,IAAI3B,OAAAA,EAAAA;AAClC,MAAM4B,+BAAuD,GAAA;IAC3DC,GAAK,EAAA,KAAA;AACLC,IAAAA,WAAAA,EAAa,IAAI9B,OAAAA,EAAAA;AACjB+B,IAAAA,eAAAA,EAAiB,IAAI/B,OAAAA,EAAAA;IACrBgC,MAAQ,EAAA;AACV,CAAA;AACA,MAAMC,iBAAiB,IAAIjC,OAAAA,EAAAA;AAC3B,MAAMkC,iBAAiB,IAAIlC,OAAAA,EAAAA;AAC3B,MAAMmC,aAAa,IAAInC,OAAAA,EAAAA;AACvB,MAAMoC,aAAa,IAAIpC,OAAAA,EAAAA;AACvB,MAAMqC,kBAAkB,IAAIrC,OAAAA,EAAAA;AAC5B,MAAMsC,mBAAmB,IAAItC,OAAAA,EAAAA;AAC7B,MAAMuC,mBAAmB,IAAIvC,OAAAA,EAAAA;AAC7B,MAAMwC,oBAAoB,IAAIxC,OAAAA,EAAAA;AAC9B,MAAMyC,cAAsC,GAAA;IAC1CC,EAAI,EAAA,CAAA;IACJC,EAAI,EAAA,CAAA;AACJC,IAAAA,QAAAA,EAAU,IAAI5C,OAAAA,EAAAA;AACd6C,IAAAA,QAAAA,EAAU,IAAI7C,OAAAA,EAAAA;IACd8C,WAAa,EAAA;AACf,CAAA;AACA,MAAMC,aAAoC,GAAA;IACxClB,GAAK,EAAA,KAAA;AACLmB,IAAAA,iBAAAA,EAAmB,IAAIhD,OAAAA,EAAAA;AACvBiD,IAAAA,OAAAA,EAAS,IAAIjD,OAAAA,EAAAA;AACb+B,IAAAA,eAAAA,EAAiB,IAAI/B,OAAAA,EAAAA;IACrBgC,MAAQ,EAAA;AACV,CAAA;AACA,MAAMkB,oBAAoB,IAAIlD,OAAAA,EAAAA;AAC9B,MAAMmD,iBAAiB,IAAInD,OAAAA,EAAAA;AAC3B,MAAMoD,iBAAiB,IAAIpD,OAAAA,EAAAA;AAC3B,MAAMqD,sBAAsB,IAAIrD,OAAAA,EAAAA;AAChC,MAAMsD,yBAAyB,IAAItD,OAAAA,EAAAA;AACnC,MAAMuD,sBAAsB,IAAIvD,OAAAA,EAAAA;AAChC,MAAMwD,iBAAiB,IAAIxD,OAAAA,EAAAA;AAC3B,MAAMyD,kBAAkB,IAAIzD,OAAAA,EAAAA;AAC5B,MAAM0D,eAAe,IAAI1D,OAAAA,EAAAA;AACzB,MAAM2D,uBAAuB,IAAI3D,OAAAA,EAAAA;AACjC,MAAM4D,kBAAkB,IAAI5D,OAAAA,EAAAA;AAC5B,MAAM6D,gBAAgB,IAAI7D,OAAAA,EAAAA;AAC1B,MAAM8D,iBAAiB,IAAI9D,OAAAA,EAAAA;AAC3B,MAAM+D,oBAAoB,IAAI/D,OAAAA,EAAAA;AAC9B,MAAMgE,wBAAwB,IAAIhE,OAAAA,EAAAA;AAClC,MAAMiE,mBAAmB,IAAIjE,OAAAA,EAAAA;AAC7B,MAAMkE,yBAAyB,IAAIlE,OAAAA,EAAAA;AACnC,MAAMmE,eAAe,IAAInE,OAAAA,EAAAA;AACzB,MAAMoE,eAAe,IAAIpE,OAAAA,EAAAA;AACzB,MAAMqE,cAAc,IAAIrE,OAAAA,EAAAA;AACxB,MAAMsE,cAAc,IAAItE,OAAAA,EAAAA;AACxB,MAAMuE,cAAc,IAAIvE,OAAAA,EAAAA;AACxB,MAAMwE,aAAa,IAAIxE,OAAAA,EAAAA;AACvB,MAAMyE,aAAa,IAAIzE,OAAAA,EAAAA;AACvB,MAAM0E,aAAa,IAAI1E,OAAAA,EAAAA;AAEvB,SAAS2E,qBACPC,GAAgC,EAChC/C,GAAY,EACZgD,KAAc,EACdC,SAAkB,EAAA;AAElB,IAAA,IAAI,CAACF,GAAK,EAAA;QACR,OAAO;AAAE/C,YAAAA,GAAAA;YAAKgD,KAAOC,EAAAA,SAAAA,GAAYD,KAAME,CAAAA,KAAK,EAAKF,GAAAA;AAAM,SAAA;AACzD;IACA,IAAI,CAACD,GAAIC,CAAAA,KAAK,EAAE;QACdD,GAAIC,CAAAA,KAAK,GAAG,IAAI7E,OAAAA,EAAAA;AAClB;AACA4E,IAAAA,GAAAA,CAAI/C,GAAG,GAAGA,GAAAA;IACV+C,GAAIC,CAAAA,KAAK,CAACG,GAAG,CAACH,KAAAA,CAAAA;IACd,OAAOD,GAAAA;AACT;AAEA,SAASK,wBAAAA,CACPL,GAAoC,EACpC/C,GAAY,EACZC,WAAoB,EACpBC,eAAwB,EACxBC,MAAc,EACdkD,WAAoB,EAAA;AAEpB,IAAA,IAAI,CAACN,GAAK,EAAA;QACR,OAAO;AACL/C,YAAAA,GAAAA;YACAC,WAAaoD,EAAAA,WAAAA,GAAcpD,WAAYiD,CAAAA,KAAK,EAAKjD,GAAAA,WAAAA;YACjDC,eAAiBmD,EAAAA,WAAAA,GAAcnD,eAAgBgD,CAAAA,KAAK,EAAKhD,GAAAA,eAAAA;AACzDC,YAAAA;AACF,SAAA;AACF;IACA,IAAI,CAAC4C,GAAI9C,CAAAA,WAAW,EAAE;QACpB8C,GAAI9C,CAAAA,WAAW,GAAG,IAAI9B,OAAAA,EAAAA;AACxB;IACA,IAAI,CAAC4E,GAAI7C,CAAAA,eAAe,EAAE;QACxB6C,GAAI7C,CAAAA,eAAe,GAAG,IAAI/B,OAAAA,EAAAA;AAC5B;AACA4E,IAAAA,GAAAA,CAAI/C,GAAG,GAAGA,GAAAA;IACV+C,GAAI9C,CAAAA,WAAW,CAACkD,GAAG,CAAClD,WAAAA,CAAAA;IACpB8C,GAAI7C,CAAAA,eAAe,CAACiD,GAAG,CAACjD,eAAAA,CAAAA;AACxB6C,IAAAA,GAAAA,CAAI5C,MAAM,GAAGA,MAAAA;IACb,OAAO4C,GAAAA;AACT;AAEA,SAASO,uBACPP,CAAAA,GAAmC,EACnC/C,GAAY,EACZmB,iBAA0B,EAC1BC,OAAgB,EAChBlB,eAAwB,EACxBC,MAAc,EACdkD,WAAoB,EAAA;AAEpB,IAAA,IAAI,CAACN,GAAK,EAAA;QACR,OAAO;AACL/C,YAAAA,GAAAA;YACAmB,iBAAmBkC,EAAAA,WAAAA,GAAclC,iBAAkB+B,CAAAA,KAAK,EAAK/B,GAAAA,iBAAAA;YAC7DC,OAASiC,EAAAA,WAAAA,GAAcjC,OAAQ8B,CAAAA,KAAK,EAAK9B,GAAAA,OAAAA;YACzClB,eAAiBmD,EAAAA,WAAAA,GAAcnD,eAAgBgD,CAAAA,KAAK,EAAKhD,GAAAA,eAAAA;AACzDC,YAAAA;AACF,SAAA;AACF;IACA,IAAI,CAAC4C,GAAI5B,CAAAA,iBAAiB,EAAE;QAC1B4B,GAAI5B,CAAAA,iBAAiB,GAAG,IAAIhD,OAAAA,EAAAA;AAC9B;IACA,IAAI,CAAC4E,GAAI3B,CAAAA,OAAO,EAAE;QAChB2B,GAAI3B,CAAAA,OAAO,GAAG,IAAIjD,OAAAA,EAAAA;AACpB;IACA,IAAI,CAAC4E,GAAI7C,CAAAA,eAAe,EAAE;QACxB6C,GAAI7C,CAAAA,eAAe,GAAG,IAAI/B,OAAAA,EAAAA;AAC5B;AACA4E,IAAAA,GAAAA,CAAI/C,GAAG,GAAGA,GAAAA;IACV+C,GAAI5B,CAAAA,iBAAiB,CAACgC,GAAG,CAAChC,iBAAAA,CAAAA;IAC1B4B,GAAI3B,CAAAA,OAAO,CAAC+B,GAAG,CAAC/B,OAAAA,CAAAA;IAChB2B,GAAI7C,CAAAA,eAAe,CAACiD,GAAG,CAACjD,eAAAA,CAAAA;AACxB6C,IAAAA,GAAAA,CAAI5C,MAAM,GAAGA,MAAAA;IACb,OAAO4C,GAAAA;AACT;AAEA,SAASQ,wBACPR,CAAAA,GAAoC,EACpClC,EAAU,EACVC,EAAU,EACVC,QAAiB,EACjBC,QAAiB,EACjBC,WAAmB,EACnBoC,WAAoB,EAAA;AAEpB,IAAA,IAAI,CAACN,GAAK,EAAA;QACR,OAAO;AACLlC,YAAAA,EAAAA;AACAC,YAAAA,EAAAA;YACAC,QAAUsC,EAAAA,WAAAA,GAActC,QAASmC,CAAAA,KAAK,EAAKnC,GAAAA,QAAAA;YAC3CC,QAAUqC,EAAAA,WAAAA,GAAcrC,QAASkC,CAAAA,KAAK,EAAKlC,GAAAA,QAAAA;AAC3CC,YAAAA;AACF,SAAA;AACF;AACA8B,IAAAA,GAAAA,CAAIlC,EAAE,GAAGA,EAAAA;AACTkC,IAAAA,GAAAA,CAAIjC,EAAE,GAAGA,EAAAA;IACTiC,GAAIhC,CAAAA,QAAQ,CAACoC,GAAG,CAACpC,QAAAA,CAAAA;IACjBgC,GAAI/B,CAAAA,QAAQ,CAACmC,GAAG,CAACnC,QAAAA,CAAAA;AACjB+B,IAAAA,GAAAA,CAAI9B,WAAW,GAAGA,WAAAA;IAClB,OAAO8B,GAAAA;AACT;AAEA;AAEA;;;;IAKO,SAASS,iBAAAA,CACdC,MAAe,EACftD,MAAc,EACduD,WAAmB,EACnBV,KAAc,EACdD,GAAqB,EAAA;AAErB,IAAA,MAAMY,SAAYxF,GAAAA,OAAAA,CAAQyF,GAAG,CAACZ,OAAOS,MAAQvF,EAAAA,uBAAAA,CAAAA;IAC7C,MAAM2F,MAAAA,GAASF,UAAUG,WAAW;AACpC,IAAA,IAAID,SAASE,OAAS,EAAA;AACpB,QAAA,MAAMC,MAASC,GAAAA,IAAAA,CAAKC,IAAI,CAACL,MAAUH,CAAAA,GAAAA,WAAAA;AACnC,QAAA,IAAIM,SAAS7D,MAAQ,EAAA;AACnB,YAAA,MAAMgE,SAAShG,OAAQiG,CAAAA,KAAK,CAACT,SAAAA,EAAWxD,SAAS6D,MAAQ5F,EAAAA,oBAAAA,CAAAA;YACzDD,OAAQkG,CAAAA,GAAG,CAACZ,MAAAA,EAAQU,MAAQA,EAAAA,MAAAA,CAAAA;AAC5B,YAAA,OAAOrB,oBAAqBC,CAAAA,GAAAA,EAAK,IAAMoB,EAAAA,MAAAA,EAAQ,CAACpB,GAAAA,CAAAA;AAClD;AACF;AACA,IAAA,OAAOD,oBAAqBC,CAAAA,GAAAA,EAAK,KAAOC,EAAAA,KAAAA,EAAO,CAACD,GAAAA,CAAAA;AAClD;AAEA;;;;IAKO,SAASuB,mBAAAA,CACdC,IAAe,EACfC,KAAiB,EACjBxB,KAAc,EACdyB,GAAW,EACX1B,GAAqB,EAAA;IAErB,IAAIwB,IAAAA,CAAKG,MAAM,IAAIX,OAAS,EAAA;QAC1B,OAAOP,iBAAAA,CAAkBgB,KAAMG,CAAAA,eAAe,EAAEH,KAAAA,CAAMrE,MAAM,EAAEsE,GAAAA,CAAIf,WAAW,EAAEV,KAAOD,EAAAA,GAAAA,CAAAA;AACxF;AACA,IAAA,OAAO6B,kBAAmBL,CAAAA,IAAAA,EAAMC,KAAOxB,EAAAA,KAAAA,EAAOyB,GAAK1B,EAAAA,GAAAA,CAAAA;AACrD;AAEA;;;;IAKO,SAAS6B,kBAAAA,CACdL,IAAe,EACfC,KAAiB,EACjBxB,KAAc,EACdyB,GAAW,EACX1B,GAAqB,EAAA;IAErB,MAAM8B,UAAAA,GAAaL,MAAMM,gBAAgB;AACzC,IAAA,MAAMC,WAAc5G,GAAAA,OAAAA,CAAQ6G,SAAS,CAACH,UAAYxG,EAAAA,mBAAAA,CAAAA;IAClD,MAAM4G,UAAAA,GAAaT,MAAMG,eAAe;AACxC,IAAA,MAAMO,SAAY/G,GAAAA,OAAAA,CAAQyF,GAAG,CAACZ,OAAOiC,UAAY3G,EAAAA,wBAAAA,CAAAA;AACjD,IAAA,MAAM6G,SAAYhH,GAAAA,OAAAA,CAAQiH,GAAG,CAACL,WAAaG,EAAAA,SAAAA,CAAAA;AAE3C,IAAA,IAAIC,aAAapB,OAAS,EAAA;QACxB,OAAOP,iBAAAA,CAAkByB,YAAYT,KAAMrE,CAAAA,MAAM,EAAEsE,GAAIf,CAAAA,WAAW,EAAEV,KAAOD,EAAAA,GAAAA,CAAAA;AAC7E;IACA,IAAIoC,SAAAA,IAAaZ,IAAKG,CAAAA,MAAM,EAAE;AAC5B,QAAA,MAAMW,IAAOlH,GAAAA,OAAAA,CAAQkG,GAAG,CAACY,YAAYJ,UAAYtG,EAAAA,mBAAAA,CAAAA;QACjD,OAAOiF,iBAAAA,CAAkB6B,IAAMb,EAAAA,KAAAA,CAAMrE,MAAM,GAAGoE,IAAKe,CAAAA,eAAe,EAAEb,GAAAA,CAAIf,WAAW,EAAEV,KAAOD,EAAAA,GAAAA,CAAAA;AAC9F;AAEA,IAAA,MAAMwC,QAAWpH,GAAAA,OAAAA,CAAQiG,KAAK,CAACW,aAAaI,SAAW3G,EAAAA,uBAAAA,CAAAA;IACvDL,OAAQkG,CAAAA,GAAG,CAACY,UAAAA,EAAYM,QAAUA,EAAAA,QAAAA,CAAAA;AAClC,IAAA,MAAMC,OAAUrH,GAAAA,OAAAA,CAAQyF,GAAG,CAACZ,OAAOuC,QAAU9G,EAAAA,sBAAAA,CAAAA;IAC7C,MAAMgH,WAAAA,GAAcD,QAAQ1B,WAAW;AACvC,IAAA,IAAI2B,cAAc1B,OAAS,EAAA;AACzB,QAAA,MAAM2B,WAAWzB,IAAKC,CAAAA,IAAI,CAACuB,WAAAA,CAAAA,GAAehB,IAAIf,WAAW;QACzD,MAAMiC,CAAAA,GAAInB,KAAMrE,CAAAA,MAAM,GAAGyF,IAAAA,CAAK,GAAKrB,EAAAA,IAAAA,CAAKe,eAAe,EAAEH,SAAYZ,GAAAA,IAAAA,CAAKG,MAAM,CAAA;AAChF,QAAA,IAAIgB,WAAWC,CAAG,EAAA;AAChB,YAAA,MAAMxB,SAAShG,OAAQiG,CAAAA,KAAK,CAACoB,OAAAA,EAASG,IAAID,QAAUhH,EAAAA,qBAAAA,CAAAA;YACpDP,OAAQkG,CAAAA,GAAG,CAACkB,QAAAA,EAAUpB,MAAQA,EAAAA,MAAAA,CAAAA;AAC9B,YAAA,OAAOrB,oBAAqBC,CAAAA,GAAAA,EAAK,IAAMoB,EAAAA,MAAAA,EAAQ,CAACpB,GAAAA,CAAAA;AAClD;AACF;AACA,IAAA,OAAOD,oBAAqBC,CAAAA,GAAAA,EAAK,KAAOC,EAAAA,KAAAA,EAAO,CAACD,GAAAA,CAAAA;AAClD;AAEA;AAEA;;;;IAKO,SAAS8C,gBACdpC,CAAAA,MAAe,EACftD,MAAc,EACd6C,KAAc,EACdD,GAAqB,EAAA;AAErB,IAAA,MAAMY,SAAYxF,GAAAA,OAAAA,CAAQyF,GAAG,CAACH,QAAQT,KAAOrE,EAAAA,sBAAAA,CAAAA;IAC7C,MAAMkF,MAAAA,GAASF,UAAUG,WAAW;AACpC,IAAA,IAAID,MAASE,GAAAA,OAAAA,IAAWF,MAAS1D,GAAAA,MAAAA,GAASA,MAAQ,EAAA;QAChD,MAAM6D,MAAAA,GAASC,IAAKC,CAAAA,IAAI,CAACL,MAAAA,CAAAA;AACzB,QAAA,MAAMiC,UAAa3H,GAAAA,OAAAA,CAAQ6G,SAAS,CAACrB,SAAW/E,EAAAA,uBAAAA,CAAAA;AAChD,QAAA,MAAMuF,SAAShG,OAAQiG,CAAAA,KAAK,CAAC0B,UAAAA,EAAY9B,SAAS7D,MAAQtB,EAAAA,mBAAAA,CAAAA;QAC1DV,OAAQkG,CAAAA,GAAG,CAACrB,KAAAA,EAAOmB,MAAQA,EAAAA,MAAAA,CAAAA;AAC3B,QAAA,OAAOrB,oBAAqBC,CAAAA,GAAAA,EAAK,IAAMoB,EAAAA,MAAAA,EAAQ,CAACpB,GAAAA,CAAAA;AAClD;AACA,IAAA,OAAOD,oBAAqBC,CAAAA,GAAAA,EAAK,KAAOC,EAAAA,KAAAA,EAAO,CAACD,GAAAA,CAAAA;AAClD;AAEA;;;;IAKO,SAASgD,kBACdxB,CAAAA,IAAe,EACfC,KAAiB,EACjBxB,KAAc,EACdD,GAAqB,EAAA;IAErB,IAAIwB,IAAAA,CAAKG,MAAM,IAAIX,OAAS,EAAA;AAC1B,QAAA,OAAO8B,iBAAiBrB,KAAMG,CAAAA,eAAe,EAAEH,KAAMrE,CAAAA,MAAM,EAAE6C,KAAOD,EAAAA,GAAAA,CAAAA;AACtE;IACA,OAAOiD,iBAAAA,CAAkBzB,IAAMC,EAAAA,KAAAA,EAAOxB,KAAOD,EAAAA,GAAAA,CAAAA;AAC/C;AAEA;;;;IAKO,SAASiD,iBACdzB,CAAAA,IAAe,EACfC,KAAiB,EACjBxB,KAAc,EACdD,GAAqB,EAAA;IAErB,MAAM8B,UAAAA,GAAaL,MAAMM,gBAAgB;AACzC,IAAA,MAAMC,WAAc5G,GAAAA,OAAAA,CAAQ6G,SAAS,CAACH,UAAY/F,EAAAA,kBAAAA,CAAAA;IAClD,MAAMmG,UAAAA,GAAaT,MAAMG,eAAe;AACxC,IAAA,MAAMO,SAAY/G,GAAAA,OAAAA,CAAQyF,GAAG,CAACZ,OAAOiC,UAAYlG,EAAAA,uBAAAA,CAAAA;AACjD,IAAA,MAAMoG,SAAYhH,GAAAA,OAAAA,CAAQiH,GAAG,CAACL,WAAaG,EAAAA,SAAAA,CAAAA;AAE3C,IAAA,IAAIC,aAAapB,OAAS,EAAA;AACxB,QAAA,OAAO8B,gBAAiBZ,CAAAA,UAAAA,EAAYT,KAAMrE,CAAAA,MAAM,EAAE6C,KAAOD,EAAAA,GAAAA,CAAAA;AAC3D;IACA,IAAIoC,SAAAA,IAAaZ,IAAKG,CAAAA,MAAM,EAAE;AAC5B,QAAA,MAAMW,IAAOlH,GAAAA,OAAAA,CAAQkG,GAAG,CAACY,YAAYJ,UAAY7F,EAAAA,kBAAAA,CAAAA;QACjD,OAAO6G,gBAAAA,CAAiBR,MAAMb,KAAMrE,CAAAA,MAAM,GAAGoE,IAAKe,CAAAA,eAAe,EAAEtC,KAAOD,EAAAA,GAAAA,CAAAA;AAC5E;AAEA,IAAA,MAAMwC,QAAWpH,GAAAA,OAAAA,CAAQiG,KAAK,CAACW,aAAaI,SAAWlG,EAAAA,sBAAAA,CAAAA;IACvDd,OAAQkG,CAAAA,GAAG,CAACY,UAAAA,EAAYM,QAAUA,EAAAA,QAAAA,CAAAA;AAClC,IAAA,MAAMU,OAAU9H,GAAAA,OAAAA,CAAQyF,GAAG,CAAC2B,UAAUvC,KAAO9D,EAAAA,qBAAAA,CAAAA;IAC7C,MAAMgH,WAAAA,GAAcD,QAAQnC,WAAW;AACvC,IAAA,IAAIoC,cAAcnC,OAAS,EAAA;QACzB,MAAM4B,CAAAA,GAAInB,KAAMrE,CAAAA,MAAM,GAAGyF,IAAAA,CAAK,GAAKrB,EAAAA,IAAAA,CAAKe,eAAe,EAAEf,IAAKG,CAAAA,MAAM,GAAGS,SAAAA,CAAAA;QACvE,IAAIe,WAAAA,GAAcP,IAAIA,CAAG,EAAA;YACvB,MAAMQ,QAAAA,GAAWlC,IAAKC,CAAAA,IAAI,CAACgC,WAAAA,CAAAA;AAC3B,YAAA,MAAME,QAAWjI,GAAAA,OAAAA,CAAQ6G,SAAS,CAACiB,OAAS9G,EAAAA,sBAAAA,CAAAA;AAC5C,YAAA,MAAMgF,SAAShG,OAAQiG,CAAAA,KAAK,CAACgC,QAAAA,EAAUD,WAAWR,CAAGvG,EAAAA,oBAAAA,CAAAA;YACrDjB,OAAQkG,CAAAA,GAAG,CAACrB,KAAAA,EAAOmB,MAAQA,EAAAA,MAAAA,CAAAA;AAC3B,YAAA,OAAOrB,oBAAqBC,CAAAA,GAAAA,EAAK,IAAMoB,EAAAA,MAAAA,EAAQ,CAACpB,GAAAA,CAAAA;AAClD;AACF;AACA,IAAA,OAAOD,oBAAqBC,CAAAA,GAAAA,EAAK,KAAOC,EAAAA,KAAAA,EAAO,CAACD,GAAAA,CAAAA;AAClD;AAEA;AAEA;;;;IAKO,SAASsD,wBAAAA,CACd5C,MAAe,EACftD,MAAc,EACdmG,MAAe,EACfC,MAAe,EACfxD,GAAyB,EAAA;AAEzB,IAAA,MAAMyD,GAAMrI,GAAAA,OAAAA,CAAQyF,GAAG,CAAC2C,QAAQD,MAAQjH,EAAAA,mBAAAA,CAAAA;IACxC,MAAM2E,MAAAA,GAASwC,IAAIC,SAAS;AAC5B,IAAA,IAAIzC,SAASD,OAAS,EAAA;AACpB,QAAA,OAAOX,yBAAyBL,GAAK,EAAA,KAAA,EAAOuD,MAAQ7C,EAAAA,MAAAA,EAAQtD,QAAQ,CAAC4C,GAAAA,CAAAA;AACvE;AACA,IAAA,MAAM2D,OAAOvI,OAAQiG,CAAAA,KAAK,CAACoC,GAAAA,EAAK,IAAIxC,MAAQ1E,EAAAA,oBAAAA,CAAAA;AAC5C,IAAA,MAAMqH,QAAWxI,GAAAA,OAAAA,CAAQyF,GAAG,CAACH,QAAQ6C,MAAQ/G,EAAAA,wBAAAA,CAAAA;AAC7C,IAAA,MAAM6F,GAAMjH,GAAAA,OAAAA,CAAQiH,GAAG,CAACsB,IAAMC,EAAAA,QAAAA,CAAAA;IAC9B,MAAMC,OAAAA,GAAU3C,KAAK4C,GAAG,CAAC,GAAG5C,IAAK6C,CAAAA,GAAG,CAAC1B,GAAKpB,EAAAA,MAAAA,CAAAA,CAAAA;AAC1C,IAAA,MAAM+C,QAAW5I,GAAAA,OAAAA,CAAQiG,KAAK,CAACsC,MAAME,OAASpH,EAAAA,sBAAAA,CAAAA;IAC9CrB,OAAQkG,CAAAA,GAAG,CAACiC,MAAAA,EAAQS,QAAUA,EAAAA,QAAAA,CAAAA;AAC9B,IAAA,MAAMC,IAAO7I,GAAAA,OAAAA,CAAQyF,GAAG,CAACH,QAAQsD,QAAUtH,EAAAA,oBAAAA,CAAAA;AAC3C,IAAA,MAAMO,GAAMgH,GAAAA,IAAAA,CAAKlD,WAAW,IAAI3D,MAASA,GAAAA,MAAAA;AACzC,IAAA,OAAOiD,yBAAyBL,GAAK/C,EAAAA,GAAAA,EAAK+G,QAAUtD,EAAAA,MAAAA,EAAQtD,QAAQ,CAAC4C,GAAAA,CAAAA;AACvE;AAEA;;;;IAKO,SAASkE,yBAAAA,CACd1C,IAAe,EACfC,KAAiB,EACjB8B,MAAe,EACfC,MAAe,EACfxD,GAAyB,EAAA;IAEzB,MAAMmE,UAAAA,GAAa1C,MAAMM,gBAAgB;IACzC,MAAMG,UAAAA,GAAaT,MAAMG,eAAe;AAExC,IAAA,IAAIwC,MAAMd,wBAAyBpB,CAAAA,UAAAA,EAAYT,MAAMrE,MAAM,EAAEmG,QAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;IAC7E,IAAIoE,GAAAA,CAAInH,GAAG,EAAE;QACX,OAAOmH,GAAAA;AACT;AAEA,IAAA,MAAM9B,IAAOlH,GAAAA,OAAAA,CAAQkG,GAAG,CAACY,YAAYiC,UAAYxH,EAAAA,qBAAAA,CAAAA;IACjDyH,GAAMd,GAAAA,wBAAAA,CACJhB,MACAb,KAAMrE,CAAAA,MAAM,GAAGoE,IAAKe,CAAAA,eAAe,EACnCgB,MAAAA,EACAC,MACAxG,EAAAA,+BAAAA,CAAAA;IAEF,IAAIoH,GAAAA,CAAInH,GAAG,EAAE;AACX,QAAA,OAAOoD,wBAAyBL,CAAAA,GAAAA,EAAK,IAAMoE,EAAAA,GAAAA,CAAIlH,WAAW,EAAEkH,GAAIjH,CAAAA,eAAe,EAAEiH,GAAAA,CAAIhH,MAAM,EAAE,CAAC4C,GAAAA,CAAAA;AAChG;AAEA,IAAA,MAAMqE,QAAWjJ,GAAAA,OAAAA,CAAQyF,GAAG,CAAC2C,QAAQD,MAAQ3G,EAAAA,yBAAAA,CAAAA;AAC7C,IAAA,MAAM0H,OAAUC,GAAAA,oBAAAA,CAAqBrC,UAAYiC,EAAAA,UAAAA,EAAYZ,QAAQc,QAAUxG,EAAAA,cAAAA,CAAAA;IAC/E,MAAM2G,EAAAA,GAAKtD,IAAK4C,CAAAA,GAAG,CAAC,CAAA,EAAG5C,KAAK6C,GAAG,CAAC,CAAGO,EAAAA,OAAAA,CAAQxG,EAAE,CAAA,CAAA;IAC7C,MAAM8E,CAAAA,GAAInB,MAAMrE,MAAM,GAAGyF,KAAK,GAAKrB,EAAAA,IAAAA,CAAKe,eAAe,EAAEiC,EAAAA,CAAAA;AAEzD,IAAA,IAAIF,OAAQpG,CAAAA,WAAW,GAAG0E,CAAAA,GAAIA,CAAG,EAAA;AAC/B,QAAA,OAAOvC,yBAAyBL,GAAK,EAAA,KAAA,EAAOuD,MAAQrB,EAAAA,UAAAA,EAAYU,GAAG,CAAC5C,GAAAA,CAAAA;AACtE;IAEA,MAAMyE,EAAAA,GAAKvD,IAAK4C,CAAAA,GAAG,CAAC,CAAA,EAAG5C,KAAK6C,GAAG,CAAC,CAAGO,EAAAA,OAAAA,CAAQvG,EAAE,CAAA,CAAA;AAC7C,IAAA,MAAM2G,OAAUtJ,GAAAA,OAAAA,CAAQiG,KAAK,CAAC8C,YAAYK,EAAI3H,EAAAA,wBAAAA,CAAAA;IAC9CzB,OAAQkG,CAAAA,GAAG,CAACY,UAAAA,EAAYwC,OAASA,EAAAA,OAAAA,CAAAA;AACjC,IAAA,MAAMV,QAAW5I,GAAAA,OAAAA,CAAQiG,KAAK,CAACgD,UAAUI,EAAI3H,EAAAA,yBAAAA,CAAAA;IAC7C1B,OAAQkG,CAAAA,GAAG,CAACiC,MAAAA,EAAQS,QAAUA,EAAAA,QAAAA,CAAAA;AAC9B,IAAA,MAAMC,IAAO7I,GAAAA,OAAAA,CAAQyF,GAAG,CAAC6D,SAASV,QAAUjH,EAAAA,qBAAAA,CAAAA;AAC5C,IAAA,MAAME,GAAMgH,GAAAA,IAAAA,CAAKlD,WAAW,IAAI6B,CAAIA,GAAAA,CAAAA;AACpC,IAAA,OAAOvC,yBAAyBL,GAAK/C,EAAAA,GAAAA,EAAK+G,QAAUU,EAAAA,OAAAA,EAAS9B,GAAG,CAAC5C,GAAAA,CAAAA;AACnE;AAEA;;;;IAKO,SAAS2E,kBAAAA,CACdnD,IAAe,EACfC,KAAiB,EACjB8B,MAAe,EACfC,MAAe,EACfxD,GAAyB,EAAA;IAEzB,IAAIwB,IAAAA,CAAKG,MAAM,IAAIX,OAAS,EAAA;QAC1B,OAAOsC,wBAAAA,CAAyB7B,MAAMG,eAAe,EAAEH,MAAMrE,MAAM,EAAEmG,QAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;AACvF;AACA,IAAA,OAAOkE,yBAA0B1C,CAAAA,IAAAA,EAAMC,KAAO8B,EAAAA,MAAAA,EAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;AAChE;AAEA;;;;IAKO,SAAS4E,wBAAAA,CACdpD,IAAe,EACfC,KAAiB,EACjB8B,MAAe,EACfC,MAAe,EACfxD,GAAyB,EAAA;IAEzB,IAAIwB,IAAAA,CAAKG,MAAM,IAAIX,OAAS,EAAA;QAC1B,OAAOsC,wBAAAA,CAAyB7B,MAAMG,eAAe,EAAEH,MAAMrE,MAAM,EAAEmG,QAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;AACvF;AACA,IAAA,MAAMoE,GAAMF,GAAAA,yBAAAA,CAA0B1C,IAAMC,EAAAA,KAAAA,EAAO8B,QAAQC,MAAQxD,EAAAA,GAAAA,CAAAA;AACnEoE,IAAAA,GAAAA,CAAInH,GAAG,GAAG,KAAA;IACV,OAAOmH,GAAAA;AACT;AAEA;AAEA;;;;IAKO,SAASG,oBAAAA,CACdM,IAAa,EACbC,IAAa,EACbC,IAAa,EACbC,IAAa,EACbhF,GAAyB,EAAA;AAQzB,IAAA,MAAMiF,MAAS7J,GAAAA,OAAAA,CAAQ8J,KAAK,CAACF,MAAMF,IAAMzH,EAAAA,cAAAA,CAAAA;AACzC,IAAA,MAAM8H,EAAK/J,GAAAA,OAAAA,CAAQ8J,KAAK,CAACJ,MAAMG,MAAQ1H,EAAAA,UAAAA,CAAAA;AACvC,IAAA,MAAM6H,MAAShK,GAAAA,OAAAA,CAAQ8J,KAAK,CAACJ,MAAME,IAAM1H,EAAAA,cAAAA,CAAAA;AACzC,IAAA,MAAM+H,EAAKjK,GAAAA,OAAAA,CAAQ8J,KAAK,CAACF,MAAMI,MAAQ5H,EAAAA,UAAAA,CAAAA;AACvC,IAAA,MAAM8H,KAAQlK,GAAAA,OAAAA,CAAQiH,GAAG,CAACyC,IAAMO,EAAAA,EAAAA,CAAAA;AAChC,IAAA,MAAME,KAAQnK,GAAAA,OAAAA,CAAQiH,GAAG,CAAC2C,IAAMG,EAAAA,EAAAA,CAAAA;AAChC,IAAA,MAAMK,OAAUpK,GAAAA,OAAAA,CAAQyF,GAAG,CAACkE,MAAMF,IAAMpH,EAAAA,eAAAA,CAAAA;IACxC,MAAMK,EAAAA,GAAKwH,UAAU,CAAIlK,GAAAA,OAAAA,CAAQiH,GAAG,CAACmD,OAAAA,EAASH,MAAMC,KAAQ,GAAA,CAAA;AAC5D,IAAA,MAAMvH,EAAKwH,GAAAA,KAAAA,KAAU,CAAInK,GAAAA,OAAAA,CAAQiH,GAAG,CAACjH,OAAAA,CAAQiG,KAAK,CAACmE,OAAS,EAAA,EAAIA,EAAAA,OAAAA,CAAAA,EAAUL,MAAMI,KAAQ,GAAA,CAAA;AACxF,IAAA,MAAMvH,QAAW5C,GAAAA,OAAAA,CAAQiG,KAAK,CAACyD,MAAMhH,EAAIJ,EAAAA,gBAAAA,CAAAA;IACzCtC,OAAQkG,CAAAA,GAAG,CAACuD,IAAAA,EAAM7G,QAAUA,EAAAA,QAAAA,CAAAA;AAC5B,IAAA,MAAMC,QAAW7C,GAAAA,OAAAA,CAAQiG,KAAK,CAAC2D,MAAMjH,EAAIJ,EAAAA,gBAAAA,CAAAA;IACzCvC,OAAQkG,CAAAA,GAAG,CAACyD,IAAAA,EAAM9G,QAAUA,EAAAA,QAAAA,CAAAA;AAC5B,IAAA,MAAMgG,IAAO7I,GAAAA,OAAAA,CAAQyF,GAAG,CAAC5C,UAAUD,QAAUJ,EAAAA,iBAAAA,CAAAA;IAC7C,OAAO4C,wBAAAA,CAAyBR,KAAKlC,EAAIC,EAAAA,EAAAA,EAAIC,UAAUC,QAAUgG,EAAAA,IAAAA,CAAKlD,WAAW,EAAE,CAACf,GAAAA,CAAAA;AACtF;AAEA;AAEA;;;;AAIC,IACM,SAASyF,qBACdC,CAAAA,GAAY,EACZC,GAAY,EACZC,GAAY,EACZC,WAAoB,EACpBrE,IAAe,EACfC,KAAiB,EACjBzB,GAAwB,EAAA;AAExB7B,IAAAA,aAAAA,CAAclB,GAAG,GAAG,KAAA;AACpBkB,IAAAA,aAAAA,CAAcC,iBAAiB,CAAC0H,MAAM,CAAC,GAAG,CAAG,EAAA,CAAA,CAAA;AAC7C3H,IAAAA,aAAAA,CAAcE,OAAO,CAACyH,MAAM,CAAC,GAAG,CAAG,EAAA,CAAA,CAAA;IACnC3H,aAAchB,CAAAA,eAAe,CAACiD,GAAG,CAACyF,WAAAA,CAAAA;IAClC1H,aAAcf,CAAAA,MAAM,GAAGqE,KAAAA,CAAMrE,MAAM;AAEnC,IAAA,IAAID,eAAkB0I,GAAAA,WAAAA;IACtB,IAAIzI,MAAAA,GAASqE,MAAMrE,MAAM;IACzB,MAAM2I,SAAAA,GAAYvE,IAAKG,CAAAA,MAAM,GAAGX,OAAAA;AAEhC,IAAA,MAAMgF,SAAYC,GAAAA,gBAAAA,CAAiBP,GAAKC,EAAAA,GAAAA,EAAKC,GAAKtH,EAAAA,iBAAAA,CAAAA;AAClD,IAAA,MAAM4H,MAAS9K,GAAAA,OAAAA,CAAQyF,GAAG,CAAC8E,KAAKD,GAAKnH,EAAAA,cAAAA,CAAAA;AACrC,IAAA,MAAM4H,MAAS/K,GAAAA,OAAAA,CAAQyF,GAAG,CAAC+E,KAAKF,GAAKlH,EAAAA,cAAAA,CAAAA;AACrC,IAAA,MAAM4H,WAAchL,GAAAA,OAAAA,CAAQ8J,KAAK,CAACgB,QAAQC,MAAQ1H,EAAAA,mBAAAA,CAAAA;IAClDrD,OAAQ6G,CAAAA,SAAS,CAACmE,WAAaA,EAAAA,WAAAA,CAAAA;AAC/BhL,IAAAA,OAAAA,CAAQiG,KAAK,CAAC+E,WAAa,EAAA,EAAIA,EAAAA,WAAAA,CAAAA;AAC/B,IAAA,MAAMC,iBAAiBjL,OAAQiG,CAAAA,KAAK,CAAC+E,WAAAA,EAAa,EAAI1H,EAAAA,sBAAAA,CAAAA;AACtD,IAAA,MAAM4H,SAAY,GAAA,CAAClL,OAAQiH,CAAAA,GAAG,CAACgE,cAAgBX,EAAAA,GAAAA,CAAAA;AAC/C,IAAA,MAAMa,WAAcnL,GAAAA,OAAAA,CAAQyF,GAAG,CAACgF,aAAaG,SAAWrH,EAAAA,mBAAAA,CAAAA;IACxDvD,OAAQ6G,CAAAA,SAAS,CAACsE,WAAaA,EAAAA,WAAAA,CAAAA;AAC/B,IAAA,MAAMlE,GAAMjH,GAAAA,OAAAA,CAAQiH,GAAG,CAACkE,WAAaH,EAAAA,WAAAA,CAAAA;AAErC,IAAA,IAAIL,SAAW,EAAA;AACb,QAAA,MAAMS,OAAOpL,OAAQiH,CAAAA,GAAG,CAACZ,KAAMM,CAAAA,gBAAgB,EAAEqE,WAAe/D,CAAAA,GAAAA,GAAAA;AAChE,QAAA,MAAMoE,SAASrL,OAAQiG,CAAAA,KAAK,CAAC+E,WAAa/D,EAAAA,GAAAA,GAAM,EAAIzD,EAAAA,cAAAA,CAAAA;AACpD,QAAA,MAAM8H,OAAUvJ,GAAAA,eAAAA;AAEhB,QAAA,IAAIqJ,OAAO,CAAG,EAAA;AACZpJ,YAAAA,MAAAA,GAASqE,KAAMrE,CAAAA,MAAM,GAAGoE,IAAAA,CAAKe,eAAe;AAC5CpF,YAAAA,eAAAA,GAAkB/B,QAAQkG,GAAG,CAACuE,WAAapE,EAAAA,KAAAA,CAAMM,gBAAgB,EAAEjD,YAAAA,CAAAA;AACrE;AAEA,QAAA,MAAM6H,OAAUvL,GAAAA,OAAAA,CAAQ6G,SAAS,CAACwE,MAAQ5H,EAAAA,eAAAA,CAAAA;AAC1C,QAAA,MAAM+H,KAAQC,GAAAA,OAAAA,CAAQR,cAAgBC,EAAAA,SAAAA,EAAWnJ,eAAiBwJ,EAAAA,OAAAA,CAAAA;AAClE,QAAA,IAAIC,UAAU,IAAM,EAAA;AAClB,YAAA,MAAME,EAAK1L,GAAAA,OAAAA,CAAQiG,KAAK,CAACsF,SAASC,KAAO7H,EAAAA,oBAAAA,CAAAA;YACzC3D,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB2J,EAAIA,EAAAA,EAAAA,CAAAA;AACjC,YAAA,IAAIC,qBAAsBrB,CAAAA,GAAAA,EAAKC,GAAKC,EAAAA,GAAAA,EAAKkB,EAAK,CAAA,EAAA;AAC5C,gBAAA,MAAMzI,OAAUjD,GAAAA,OAAAA,CAAQyF,GAAG,CAACiG,IAAI3J,eAAiB6B,EAAAA,eAAAA,CAAAA;AACjD,gBAAA,MAAMgI,KAAQ5L,GAAAA,OAAAA,CAAQyF,GAAG,CAAC1D,iBAAiB2J,EAAI7H,EAAAA,aAAAA,CAAAA;AAC/C,gBAAA,IAAI+H,KAAMjG,CAAAA,WAAW,IAAI3D,MAAAA,GAASA,MAAQ,EAAA;AACxC,oBAAA,OAAOmD,wBAAwBP,GAAK,EAAA,IAAA,EAAM8G,IAAIzI,OAASlB,EAAAA,eAAAA,EAAiBC,QAAQ,CAAC4C,GAAAA,CAAAA;AACnF;AACF;AACF,SAAA,MAAO,IAAIwB,IAAKyF,CAAAA,SAAS,KAAKC,aAAAA,CAAcC,GAAG,EAAE;YAC/ChK,eAAkBuJ,GAAAA,OAAAA;AAClB,YAAA,IAAIU,SAAShM,OAAQkG,CAAAA,GAAG,CAACuE,WAAapE,EAAAA,KAAAA,CAAMM,gBAAgB,EAAE7C,cAAAA,CAAAA;YAC9DC,iBAAkBiB,CAAAA,GAAG,CAACqB,KAAAA,CAAMM,gBAAgB,CAAA;AAC5C,YAAA,IAAIsF,SAAYlI,GAAAA,iBAAAA;AAChB,YAAA,IAAIqC,IAAKyF,CAAAA,SAAS,KAAKC,aAAAA,CAAcI,IAAI,EAAE;AACzC,gBAAA,MAAMC,GAAMpK,GAAAA,eAAAA;gBACZA,eAAkBiK,GAAAA,MAAAA;gBAClBA,MAASG,GAAAA,GAAAA;AACTF,gBAAAA,SAAAA,GAAYjM,OAAQiG,CAAAA,KAAK,CAACgG,SAAAA,EAAW,EAAIA,EAAAA,SAAAA,CAAAA;AAC3C;AACA,YAAA,MAAMG,MAASX,GAAAA,OAAAA,CAAQR,cAAgBC,EAAAA,SAAAA,EAAWnJ,eAAiBkK,EAAAA,SAAAA,CAAAA;AACnE,YAAA,IAAIG,WAAW,IAAM,EAAA;AACnB,gBAAA,MAAMV,EAAK1L,GAAAA,OAAAA,CAAQiG,KAAK,CAACgG,WAAWG,MAAQzI,EAAAA,oBAAAA,CAAAA;gBAC5C3D,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB2J,EAAIA,EAAAA,EAAAA,CAAAA;AACjC,gBAAA,IAAIC,qBAAsBrB,CAAAA,GAAAA,EAAKC,GAAKC,EAAAA,GAAAA,EAAKkB,EAAK,CAAA,EAAA;AAC5C,oBAAA,MAAMW,aAAgBrM,GAAAA,OAAAA,CAAQyF,GAAG,CAACuG,QAAQN,EAAI1H,EAAAA,qBAAAA,CAAAA;AAC9C,oBAAA,MAAMsI,QAAWtM,GAAAA,OAAAA,CAAQyF,GAAG,CAACuG,QAAQjK,eAAiBkC,EAAAA,gBAAAA,CAAAA;AACtD,oBAAA,MAAMsI,cAAiBvM,GAAAA,OAAAA,CAAQyF,GAAG,CAACiG,IAAI3J,eAAiBmC,EAAAA,sBAAAA,CAAAA;AACxD,oBAAA,MAAMsI,IAAOxM,GAAAA,OAAAA,CAAQiH,GAAG,CAACoF,aAAeE,EAAAA,cAAAA,CAAAA;AACxC,oBAAA,MAAME,IAAOzM,GAAAA,OAAAA,CAAQiH,GAAG,CAACqF,QAAUA,EAAAA,QAAAA,CAAAA;AACnC,oBAAA,IAAI,EAAEE,IAAAA,IAAQ,CAAKA,IAAAA,IAAAA,IAAQC,IAAG,CAAI,EAAA;AAChC,wBAAA,OAAOtH,wBACLP,GACA7B,EAAAA,aAAAA,CAAclB,GAAG,EACjBkB,cAAcC,iBAAiB,EAC/BD,aAAcE,CAAAA,OAAO,EACrBF,aAAchB,CAAAA,eAAe,EAC7BgB,aAAcf,CAAAA,MAAM,EACpB,CAAC4C,GAAAA,CAAAA;AAEL;AACA,oBAAA,MAAM8H,MAAS1M,GAAAA,OAAAA,CAAQiH,GAAG,CAACqF,QAAUC,EAAAA,cAAAA,CAAAA;AACrC,oBAAA,MAAMI,MAAS3M,GAAAA,OAAAA,CAAQiH,GAAG,CAACqF,QAAUA,EAAAA,QAAAA,CAAAA;AACrC,oBAAA,MAAMM,SAAY5M,GAAAA,OAAAA,CAAQ6G,SAAS,CAACyF,QAAUA,EAAAA,QAAAA,CAAAA;AAC9C,oBAAA,MAAMO,OAAO7M,OAAQiG,CAAAA,KAAK,CAAC2G,SAAAA,EAAW,CAAC5K,MAAQmC,EAAAA,YAAAA,CAAAA;oBAC/CnE,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB8K,IAAMA,EAAAA,IAAAA,CAAAA;AACnC,oBAAA,MAAM5J,OAAUjD,GAAAA,OAAAA,CAAQyF,GAAG,CAACiG,IAAImB,IAAMjJ,EAAAA,eAAAA,CAAAA;AACtC,oBAAA,MAAMkJ,OAAO9M,OAAQiG,CAAAA,KAAK,CAACqG,QAAAA,EAAUI,SAASC,MAAQvI,EAAAA,YAAAA,CAAAA;oBACtDpE,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB+K,IAAMA,EAAAA,IAAAA,CAAAA;AACnC,oBAAA,MAAMlB,KAAQ5L,GAAAA,OAAAA,CAAQyF,GAAG,CAACqH,MAAMpB,EAAI7H,EAAAA,aAAAA,CAAAA;AACpC,oBAAA,IAAI+H,KAAMjG,CAAAA,WAAW,IAAI3D,MAAAA,GAASA,MAAQ,EAAA;AACxC,wBAAA,OAAOmD,wBAAwBP,GAAK,EAAA,IAAA,EAAM8G,IAAIzI,OAAS6J,EAAAA,IAAAA,EAAM9K,QAAQ,CAAC4C,GAAAA,CAAAA;AACxE;AACF;AACF;AACF;KACK,MAAA;AACL,QAAA,MAAMyG,SAASrL,OAAQiG,CAAAA,KAAK,CAAC+E,WAAa/D,EAAAA,GAAAA,GAAM,EAAIzD,EAAAA,cAAAA,CAAAA;AACpD,QAAA,MAAM+H,OAAUvL,GAAAA,OAAAA,CAAQ6G,SAAS,CAACwE,MAAQ5H,EAAAA,eAAAA,CAAAA;AAC1C,QAAA,MAAM+H,KAAQC,GAAAA,OAAAA,CAAQR,cAAgBC,EAAAA,SAAAA,EAAWnJ,eAAiBwJ,EAAAA,OAAAA,CAAAA;AAClE,QAAA,IAAIC,UAAU,IAAM,EAAA;AAClB,YAAA,MAAME,EAAK1L,GAAAA,OAAAA,CAAQiG,KAAK,CAACsF,SAASC,KAAO7H,EAAAA,oBAAAA,CAAAA;YACzC3D,OAAQkG,CAAAA,GAAG,CAACnE,eAAAA,EAAiB2J,EAAIA,EAAAA,EAAAA,CAAAA;AACjC,YAAA,IAAIC,qBAAsBrB,CAAAA,GAAAA,EAAKC,GAAKC,EAAAA,GAAAA,EAAKkB,EAAK,CAAA,EAAA;AAC5C,gBAAA,MAAMzI,OAAUjD,GAAAA,OAAAA,CAAQyF,GAAG,CAACiG,IAAI3J,eAAiB6B,EAAAA,eAAAA,CAAAA;AACjD,gBAAA,MAAMgI,KAAQ5L,GAAAA,OAAAA,CAAQyF,GAAG,CAAC1D,iBAAiB2J,EAAI7H,EAAAA,aAAAA,CAAAA;AAC/C,gBAAA,IAAI+H,KAAMjG,CAAAA,WAAW,IAAI3D,MAAAA,GAASA,MAAQ,EAAA;AACxC,oBAAA,OAAOmD,wBAAwBP,GAAK,EAAA,IAAA,EAAM8G,IAAIzI,OAASlB,EAAAA,eAAAA,EAAiBC,QAAQ,CAAC4C,GAAAA,CAAAA;AACnF;AACF;AACF;AACF;AAEA,IAAA,OAAOO,wBACLP,GACA7B,EAAAA,aAAAA,CAAclB,GAAG,EACjBkB,cAAcC,iBAAiB,EAC/BD,aAAcE,CAAAA,OAAO,EACrBF,aAAchB,CAAAA,eAAe,EAC7BgB,aAAcf,CAAAA,MAAM,EACpB,CAAC4C,GAAAA,CAAAA;AAEL;AAEA;AAEA,SAAS6G,QAAQsB,MAAe,EAAE7B,SAAiB,EAAE8B,MAAe,EAAExH,SAAkB,EAAA;AACtF,IAAA,MAAMyH,IAAOjN,GAAAA,OAAAA,CAAQiH,GAAG,CAACzB,SAAWuH,EAAAA,MAAAA,CAAAA;AACpC,IAAA,MAAMG,OAAO,CAAClN,OAAAA,CAAQiH,GAAG,CAAC+F,QAAQD,MAAU7B,CAAAA,GAAAA,SAAAA;AAC5C,IAAA,IAAIpF,IAAKqH,CAAAA,GAAG,CAACF,IAAAA,CAAAA,IAASrH,OAAS,EAAA;QAC7B,OAAO,IAAA;AACT;AACA,IAAA,MAAM4F,QAAQ0B,IAAOD,GAAAA,IAAAA;IACrB,OAAOzB,KAAAA,GAAQ,IAAIA,KAAQ,GAAA,IAAA;AAC7B;AAEA,SAASX,iBAAiBuC,CAAU,EAAEC,CAAU,EAAEC,CAAU,EAAEC,MAAgB,EAAA;AAC5EA,IAAAA,MAAAA,GAASA,UAAU,IAAIvN,OAAAA,EAAAA;AACvB,IAAA,OAAOuN,OAAO7C,MAAM,CAAC,CAAC0C,CAAAA,CAAEI,CAAC,GAAGH,CAAAA,CAAEG,CAAC,GAAGF,EAAEE,CAAAA,IAAK,CAAG,EAACJ,CAAAA,CAAEK,CAAAA,CAAC,GAAGJ,CAAAA,CAAEI,CAAC,GAAGH,CAAAA,CAAEG,CAAC,IAAI,GAAG,CAACL,CAAEM,CAAAA,CAAC,GAAGL,CAAEK,CAAAA,CAAC,GAAGJ,CAAEI,CAAAA,CAAC,IAAI,CAAA,CAAA;AACzF;AAEA,SAAS/B,sBAAsByB,CAAU,EAAEC,CAAU,EAAEC,CAAU,EAAEK,CAAU,EAAA;AAC3E,IAAA,MAAMC,EAAK5N,GAAAA,OAAAA,CAAQyF,GAAG,CAAC2H,GAAGO,CAAGtJ,EAAAA,WAAAA,CAAAA;AAC7B,IAAA,MAAMwJ,EAAK7N,GAAAA,OAAAA,CAAQyF,GAAG,CAAC4H,GAAGM,CAAGrJ,EAAAA,WAAAA,CAAAA;AAC7B,IAAA,MAAMwJ,EAAK9N,GAAAA,OAAAA,CAAQyF,GAAG,CAAC6H,GAAGK,CAAGpJ,EAAAA,WAAAA,CAAAA;AAC7B,IAAA,MAAMwJ,CAAI/N,GAAAA,OAAAA,CAAQ8J,KAAK,CAAC8D,IAAIC,EAAIrJ,EAAAA,UAAAA,CAAAA;AAChC,IAAA,MAAMwJ,EAAKhO,GAAAA,OAAAA,CAAQ8J,KAAK,CAAC+D,IAAIC,EAAIrJ,EAAAA,UAAAA,CAAAA;AACjC,IAAA,MAAMwJ,CAAIjO,GAAAA,OAAAA,CAAQ8J,KAAK,CAACgE,IAAIF,EAAIlJ,EAAAA,UAAAA,CAAAA;AAChC,IAAA,IAAI1E,OAAQiH,CAAAA,GAAG,CAAC8G,CAAAA,EAAGC,MAAM,CAAG,EAAA;QAC1B,OAAO,KAAA;AACT;AACA,IAAA,IAAIhO,OAAQiH,CAAAA,GAAG,CAAC+G,EAAAA,EAAIC,KAAK,CAAG,EAAA;QAC1B,OAAO,KAAA;AACT;IACA,OAAO,IAAA;AACT;AAEA,SAASxG,IAAK2F,CAAAA,CAAS,EAAEC,CAAS,EAAEa,CAAS,EAAA;AAC3C,IAAA,OAAOd,CAAI,GAACC,CAAAA,CAAAA,GAAID,CAAAA,IAAKc,CAAAA;AACvB;;;;"}

package/dist/animation/joint_dynamics/constraints.js

@@ -136,7 +136,11 @@ function createSurfaceFaces(a, b, out) {
     }
 }
 // ── Public API ──
-function buildConstraints(rootPoints, options) {
+/**
+ * Builds solver constraints from the supplied root chains.
+ *
+ * @public
+ */ function buildConstraints(rootPoints, options) {
     const n = rootPoints.length;
     const groups = [];
     const addRaw = (raws, collide)=>{
@@ -227,7 +231,11 @@ function buildConstraints(rootPoints, options) {
     // Flatten groups into single array
     return groups.flat();
 }
-function buildSurfaceFaces(rootPoints, isLoop) {
+/**
+ * Builds triangle indices used for surface collision.
+ *
+ * @public
+ */ function buildSurfaceFaces(rootPoints, isLoop) {
     const out = [];
     const n = rootPoints.length;
     for(let i = 0; i < n - 1; i++){
@@ -238,7 +246,11 @@ function buildSurfaceFaces(rootPoints, isLoop) {
     }
     return out;
 }
-function computeMaxDepth(rootPoints) {
+/**
+ * Computes the maximum chain depth among all root points.
+ *
+ * @public
+ */ function computeMaxDepth(rootPoints) {
     let max = 0;
     function walk(node) {
         if (node.depth > max) {
@@ -253,7 +265,11 @@ function computeMaxDepth(rootPoints) {
     }
     return max;
 }
-function sortRootPointsByProximity(roots, ignoreY, fixedBeginEnd) {
+/**
+ * Sorts root points by proximity to the supplied reference position.
+ *
+ * @public
+ */ function sortRootPointsByProximity(roots, ignoreY, fixedBeginEnd) {
     if (roots.length <= 2) {
         return [
             ...roots