@pirireis/webglobeplugins 0.15.34 → 0.16.0

package/tests/Math/arc-sampling-test.ts

@@ -0,0 +1,429 @@
+/**
+ * @file This script provides a function to generate points along an arc on a unit sphere.
+ * The arc is defined by a start point, an end point, and a rotation axis.
+ * The density of the sampled points can be biased towards an 'attraction point'
+ * using a deterministic inverse transform sampling approach.
+ */
+
+// Define a simple 3D vector type
+type Vec3 = [number, number, number];
+
+// --- Utility Functions for 3D Vector Operations ---
+
+/**
+ * Normalizes a 3D vector to unit length.
+ * @param v The input vector.
+ * @returns The normalized vector. Returns [0,0,0] if the input vector is a zero vector.
+ */
+function vec3Normalize(v: Vec3): Vec3 {
+    const len = Math.sqrt(v[0] * v[0] + v[1] * v[1] + v[2] * v[2]);
+    if (len < 1e-9) { // Use a small epsilon to handle near-zero vectors
+        return [0, 0, 0];
+    }
+    return [v[0] / len, v[1] / len, v[2] / len];
+}
+
+/**
+ * Calculates the dot product of two 3D vectors.
+ * @param v1 The first vector.
+ * @param v2 The second vector.
+ * @returns The dot product.
+ */
+function vec3Dot(v1: Vec3, v2: Vec3): number {
+    return v1[0] * v2[0] + v1[1] * v2[1] + v1[2] * v2[2];
+}
+
+/**
+ * Calculates the cross product of two 3D vectors.
+ * @param v1 The first vector.
+ * @param v2 The second vector.
+ * @returns The cross product vector.
+ */
+function vec3Cross(v1: Vec3, v2: Vec3): Vec3 {
+    return [
+        v1[1] * v2[2] - v1[2] * v2[1],
+        v1[2] * v2[0] - v1[0] * v2[2],
+        v1[0] * v2[1] - v1[1] * v2[0]
+    ];
+}
+
+/**
+ * Scales a 3D vector by a scalar.
+ * @param v The input vector.
+ * @param s The scalar value.
+ * @returns The scaled vector.
+ */
+function vec3Scale(v: Vec3, s: number): Vec3 {
+    return [v[0] * s, v[1] * s, v[2] * s];
+}
+
+/**
+ * Adds two 3D vectors.
+ * @param v1 The first vector.
+ * @param v2 The second vector.
+ * @returns The resulting vector.
+ */
+function vec3Add(v1: Vec3, v2: Vec3): Vec3 {
+    return [v1[0] + v2[0], v1[1] + v2[1], v1[2] + v2[2]];
+}
+
+/**
+ * Subtracts the second 3D vector from the first.
+ * @param v1 The first vector.
+ * @param v2 The second vector.
+ * @returns The resulting vector.
+ */
+function vec3Sub(v1: Vec3, v2: Vec3): Vec3 {
+    return [v1[0] - v2[0], v1[1] - v2[1], v1[2] - v2[2]];
+}
+
+/**
+ * Clamps a numerical value within a specified range.
+ * @param value The value to clamp.
+ * @param min The minimum allowed value.
+ * @param max The maximum allowed value.
+ * @returns The clamped value.
+ */
+function clamp(value: number, min: number, max: number): number {
+    return Math.max(min, Math.min(value, max));
+}
+
+
+function vec3Distance(v1: Vec3, v2: Vec3): number {
+    const dx = v1[0] - v2[0];
+    const dy = v1[1] - v2[1];
+    const dz = v1[2] - v2[2];
+    return Math.sqrt(dx * dx + dy * dy + dz * dz);
+}
+
+/**
+ * Rotates a vector around a given axis by a specified angle using Rodrigues' rotation formula.
+ * The axis must be a unit vector for correct results.
+ * @param v The vector to rotate.
+ * @param axis The unit axis of rotation.
+ * @param angle The angle of rotation in radians.
+ * @returns The rotated vector.
+ */
+function rotateVector(v: Vec3, axis: Vec3, angle: number): Vec3 {
+    const cosAngle = Math.cos(angle);
+    const sinAngle = Math.sin(angle);
+    const oneMinusCos = 1.0 - cosAngle;
+
+    const dotAxisV = vec3Dot(axis, v);
+    const crossAxisV = vec3Cross(axis, v);
+
+    // Rodrigues' rotation formula:
+    // v' = v * cos(angle) + (axis x v) * sin(angle) + axis * (axis . v) * (1 - cos(angle))
+    const term1 = vec3Scale(v, cosAngle);
+    const term2 = vec3Scale(crossAxisV, sinAngle);
+    const term3 = vec3Scale(axis, dotAxisV * oneMinusCos);
+
+    return vec3Add(vec3Add(term1, term2), term3);
+}
+
+/**
+ * Solves a quadratic equation Ax^2 + Bx + C = 0 for x, returning a root within a specified range.
+ * Handles linear cases (A approx 0) and multiple roots, selecting the most appropriate one for CDF inversion.
+ * @param a Coefficient A.
+ * @param b Coefficient B.
+ * @param c Coefficient C.
+ * @param minVal The minimum expected value for the root.
+ * @param maxVal The maximum expected value for the root.
+ * @returns The selected root within the range, or null if no valid real root.
+ */
+function solveQuadratic(a: number, b: number, c: number, minVal: number, maxVal: number): number | null {
+    const epsilon = 1e-12; // Small value for floating point comparisons
+
+    // Case 1: Linear equation (A is close to zero)
+    if (Math.abs(a) < epsilon) {
+        if (Math.abs(b) < epsilon) {
+            // Both A and B are zero. If C is also zero, infinitely many solutions, pick minVal.
+            // Otherwise, no solutions.
+            return Math.abs(c) < epsilon ? minVal : null;
+        }
+        const x = -c / b;
+        // Check if the linear solution is within the expected range
+        return (x >= minVal - epsilon && x <= maxVal + epsilon) ? x : null;
+    }
+
+    // Case 2: Quadratic equation
+    const discriminant = b * b - 4 * a * c;
+
+    if (discriminant < -epsilon) { // No real roots (discriminant is significantly negative)
+        return null;
+    }
+
+    if (discriminant < epsilon) { // One real root (discriminant is close to zero)
+        const x = -b / (2 * a);
+        return (x >= minVal - epsilon && x <= maxVal + epsilon) ? x : null;
+    }
+
+    // Case 3: Two distinct real roots
+    const sqrtDisc = Math.sqrt(discriminant);
+    const x1 = (-b + sqrtDisc) / (2 * a);
+    const x2 = (-b - sqrtDisc) / (2 * a);
+
+    const validX1 = (x1 >= minVal - epsilon && x1 <= maxVal + epsilon);
+    const validX2 = (x2 >= minVal - epsilon && x2 <= maxVal + epsilon);
+
+    if (validX1 && validX2) {
+        // If both roots are valid, pick the one that is logically correct for CDF inversion.
+        // For an increasing CDF, we generally want the smallest valid non-negative root.
+        return Math.min(x1, x2);
+    } else if (validX1) {
+        return x1;
+    } else if (validX2) {
+        return x2;
+    } else {
+        return null; // No valid roots within the range
+    }
+}
+
+// --- Main Function for Arc Point Generation ---
+
+/**
+ * Generates points on the shortest arc between p0 and p1 on a unit sphere.
+ * The arc is formed by rotating p0 around axisA. The density of points
+ * is higher closer to the attractionPoint.
+ *
+ * @param p0 The starting point of the arc (will be normalized).
+ * @param p1 The ending point of the arc (will be normalized).
+ * @param axisA The axis of rotation (will be normalized).
+ * @param attractionPoint The point on the unit sphere that attracts sampled points (will be normalized).
+ * @param pointCount The total number of points to generate on the arc, including p0 and p1.
+ * @param strength Controls the density bias. A value of 0 means uniform sampling.
+ * Higher positive values (e.g., 1 to 10) result in stronger attraction.
+ * @returns An array of `Vec3` representing the deterministically sampled points on the arc.
+ */
+function generateArcPoints(
+    p0: Vec3,
+    p1: Vec3,
+    axisA: Vec3,
+    attractionPoint: Vec3,
+    pointCount: number,
+    strength: number
+): Vec3[] {
+    const sampledPoints: Vec3[] = [];
+    const epsilon = 1e-7; // General epsilon for vector comparisons
+
+    // 1. Normalize all input vectors
+    let nP0 = vec3Normalize(p0);
+    let nP1 = vec3Normalize(p1);
+    let nAxisA = vec3Normalize(axisA);
+    let nAttractionPoint = vec3Normalize(attractionPoint);
+
+    // Handle edge cases for pointCount
+    if (pointCount < 1) {
+        return sampledPoints;
+    }
+    if (pointCount === 1) {
+        sampledPoints.push(nP0);
+        return sampledPoints;
+    }
+
+    // 2. Determine the total rotation angle required to go from p0 to p1 around axisA
+    // Project p0 and p1 onto the plane perpendicular to axisA
+    const p0Projected = vec3Sub(nP0, vec3Scale(nAxisA, vec3Dot(nP0, nAxisA)));
+    const p1Projected = vec3Sub(nP1, vec3Scale(nAxisA, vec3Dot(nP1, nAxisA)));
+
+    const lenP0Proj = Math.sqrt(vec3Dot(p0Projected, p0Projected));
+    const lenP1Proj = Math.sqrt(vec3Dot(p1Projected, p1Projected));
+
+    // Handle cases where p0 or p1 are colinear with the rotation axis
+    if (lenP0Proj < epsilon || lenP1Proj < epsilon) {
+        // If start and end points are effectively the same (on or very near the axis)
+        if (Math.abs(vec3Dot(nP0, nP1) - 1.0) < epsilon) {
+            for (let i = 0; i < pointCount; i++) {
+                sampledPoints.push(nP0); // Return identical points as no meaningful arc exists
+            }
+            return sampledPoints;
+        } else {
+            console.warn("generateArcPoints: p0 or p1 is colinear with axisA. Cannot form a valid arc by rotation around axisA to reach p1. Falling back to linear interpolation.");
+            // Fallback: simple linear interpolation and normalize
+            for (let i = 0; i < pointCount; i++) {
+                const t = i / (pointCount - 1);
+                const interpolated = vec3Add(vec3Scale(nP0, (1 - t)), vec3Scale(nP1, t));
+                sampledPoints.push(vec3Normalize(interpolated));
+            }
+            return sampledPoints;
+        }
+    }
+
+    const nP0Projected = vec3Normalize(p0Projected);
+    const nP1Projected = vec3Normalize(p1Projected);
+
+    // Calculate total rotation angle using atan2 for a signed angle
+    const crossProj = vec3Cross(nP0Projected, nP1Projected);
+    const totalRotationAngle = Math.atan2(vec3Dot(crossProj, nAxisA), vec3Dot(nP0Projected, nP1Projected));
+
+    // If total rotation angle is negligible, all points are essentially p0
+    if (Math.abs(totalRotationAngle) < epsilon) {
+        for (let i = 0; i < pointCount; i++) {
+            sampledPoints.push(nP0);
+        }
+        return sampledPoints;
+    }
+
+    // 3. Find alpha_A: the angle parameter (from p0) where the arc point is closest to attractionPoint
+    // We search over `t` from 0 to 1, and map to actual rotation angles.
+    let alpha_A = 0.0; // This will be the actual rotation angle
+    let minAngleToAttraction = Math.PI; // Initialize with max possible angle
+
+    const testSteps = 1000; // Granularity for finding alpha_A
+    for (let i = 0; i <= testSteps; i++) {
+        const t_test = i / testSteps; // Normalized parameter [0, 1]
+        const currentAlpha = totalRotationAngle * t_test; // Actual rotation angle
+        const pArcTest = rotateVector(nP0, nAxisA, currentAlpha); // Point on arc
+
+        const dotProduct = clamp(vec3Dot(pArcTest, nAttractionPoint), -1.0, 1.0);
+        const currentAngle = Math.acos(dotProduct);
+
+        if (currentAngle < minAngleToAttraction) {
+            minAngleToAttraction = currentAngle;
+            alpha_A = currentAlpha;
+        }
+    }
+
+    // 4. Define the PDF parameters (for normalized parameter t in [0,1])
+    // The density function for 't' (normalized angle from 0 to 1)
+    const minDensity = 1.0;
+    // Strength ensures positive density. Higher strength gives more pronounced peak.
+    const maxDensity = minDensity + Math.max(0, strength);
+
+    // Normalize alpha_A to the [0, 1] range for the PDF/CDF calculations
+    // This represents the peak position (t_peak) within the normalized parameter space.
+    const alpha_A_normalized = totalRotationAngle !== 0 ? clamp(alpha_A / totalRotationAngle, 0, 1) : 0;
+
+    // Normalization constant for the PDF (integral over [0,1] must be 1)
+    // Area of trapezoid = 0.5 * (base1 + base2) * height
+    // In our case, the "bases" are minDensity and maxDensity, "height" is 1 (the t-interval length)
+    const pdfArea = 0.5 * (minDensity + maxDensity);
+    const pdfNormalizationConstant = 1.0 / pdfArea;
+
+    // Calculate CDF value at the peak point (alpha_A_normalized)
+    // This splits the CDF into two regions for the quadratic solver
+    const cdfAtAlphaA_norm = pdfNormalizationConstant * (minDensity * alpha_A_normalized + 0.5 * (maxDensity - minDensity) * alpha_A_normalized);
+
+    // 5. Generate deterministic points using inverse transform sampling
+    for (let i = 0; i < pointCount; i++) {
+        // Generate uniformly spaced values `u` in [0, 1]
+        const u = i / (pointCount - 1);
+
+        let t_sampled: number; // This will be the sampled normalized parameter [0, 1]
+
+        if (u <= cdfAtAlphaA_norm) {
+            // Case 1: The sampled point falls in the first part of the PDF (0 to alpha_A_normalized)
+            // F(t) = normConst * (minDensity * t + 0.5 * (maxDensity - minDensity) / alpha_A_normalized * t^2)
+            // Rearrange to A*t^2 + B*t + C = 0 for solving:
+            const A = (alpha_A_normalized !== 0) ? pdfNormalizationConstant * 0.5 * (maxDensity - minDensity) / alpha_A_normalized : 0;
+            const B = pdfNormalizationConstant * minDensity;
+            const C = -u;
+
+            const result = solveQuadratic(A, B, C, 0, alpha_A_normalized);
+            // Fallback for unexpected null (e.g., numerical issues)
+            t_sampled = result !== null ? result : (u / (cdfAtAlphaA_norm || epsilon)) * alpha_A_normalized;
+
+        } else {
+            // Case 2: The sampled point falls in the second part of the PDF (alpha_A_normalized to 1)
+            // F(t) - cdfAtAlphaA_norm = normConst * [ maxDensity * (t - alpha_A_normalized) - 0.5 * (maxDensity - minDensity) / (1 - alpha_A_normalized) * (t - alpha_A_normalized)^2 ]
+            // Let x = t - alpha_A_normalized. Solve for x: A'*x^2 + B'*x + C' = 0
+            const rangeAfterA = 1 - alpha_A_normalized;
+            const A_prime = (rangeAfterA !== 0) ? -pdfNormalizationConstant * 0.5 * (maxDensity - minDensity) / rangeAfterA : 0;
+            const B_prime = pdfNormalizationConstant * maxDensity;
+            const C_prime = -(u - cdfAtAlphaA_norm);
+
+            const result_x = solveQuadratic(A_prime, B_prime, C_prime, 0, rangeAfterA);
+            // Fallback for unexpected null
+            t_sampled = (result_x !== null ? alpha_A_normalized + result_x :
+                alpha_A_normalized + (u - cdfAtAlphaA_norm) / ((1 - cdfAtAlphaA_norm) || epsilon) * rangeAfterA);
+        }
+
+        // Ensure t_sampled is within [0, 1] due to potential float inaccuracies
+        t_sampled = clamp(t_sampled, 0, 1);
+
+        // Convert the normalized parameter 't_sampled' back to the actual rotation angle
+        const actualRotationAngle = totalRotationAngle * t_sampled;
+
+        // Rotate the starting point p0 by this angle around axisA to get the final point
+        const currentPoint = rotateVector(nP0, nAxisA, actualRotationAngle);
+        sampledPoints.push(currentPoint);
+    }
+
+    return sampledPoints;
+}
+
+// --- Example Usage (for demonstration and testing) ---
+
+// Example 1: Basic arc, attraction point in the middle
+const p0_ex1: Vec3 = [1, 0, 0];
+const p1_ex1: Vec3 = [0, 1, 0]; // 90 deg rotation around Z-axis
+const axisA_ex1: Vec3 = [0, 0, 1];
+const attractionPoint_ex1: Vec3 = [Math.sqrt(0.5), Math.sqrt(0.5), 0]; // On the arc, middle of P0-P1
+const numPoints_ex1 = 50;
+const strength_ex1 = 100.0; // Strong attraction
+
+console.log("--- Example 1: Attraction point in the middle of the arc ---");
+const points1 = generateArcPoints(p0_ex1, p1_ex1, axisA_ex1, attractionPoint_ex1, numPoints_ex1, strength_ex1);
+console.log(`Generated ${points1.length} points.`);
+// To observe concentration, you might visualize these points or calculate their 't' parameter distribution.
+// For console output, let's print a few:
+console.log("First 5 points:", points1.slice(0, 5).map(p => p.map(coord => coord.toFixed(4))));
+console.log("Last 5 points:", points1.slice(-5).map(p => p.map(coord => coord.toFixed(4))));
+// Expected: Points should be denser around [0.707, 0.707, 0]
+const sequentialDistances1 = points1.map((p, i) => {
+    if (i === 0) return 0; // Skip the first point
+    return vec3Distance(points1[i - 1], p);
+});
+console.log("Sequential distances between points (should be roughly equal for uniform distribution):", sequentialDistances1.map(d => d.toFixed(4)));
+
+// Example 2: Attraction point near p0
+const p0_ex2: Vec3 = [1, 0, 0];
+const p1_ex2: Vec3 = [0, 1, 0];
+const axisA_ex2: Vec3 = [0, 0, 1];
+const attractionPoint_ex2: Vec3 = [0.99, 0.01, 0]; // Very close to P0
+const numPoints_ex2 = 50;
+const strength_ex2 = 10.0; // Very strong attraction
+
+console.log("\n--- Example 2: Attraction point near the start (p0) ---");
+const points2 = generateArcPoints(p0_ex2, p1_ex2, axisA_ex2, attractionPoint_ex2, numPoints_ex2, strength_ex2);
+console.log(`Generated ${points2.length} points.`);
+console.log("First 5 points:", points2.slice(0, 5).map(p => p.map(coord => coord.toFixed(4))));
+console.log("Last 5 points:", points2.slice(-5).map(p => p.map(coord => coord.toFixed(4))));
+// Expected: Points should be denser near [1, 0, 0]
+
+// Example 3: Attraction point away from the arc (expect less concentration)
+const p0_ex3: Vec3 = [1, 0, 0];
+const p1_ex3: Vec3 = [0, 1, 0];
+const axisA_ex3: Vec3 = [0, 0, 1];
+const attractionPoint_ex3: Vec3 = [0, 0, 1]; // North pole, away from the XY plane arc
+const numPoints_ex3 = 50;
+const strength_ex3 = 5.0;
+
+console.log("\n--- Example 3: Attraction point away from the arc ---");
+const points3 = generateArcPoints(p0_ex3, p1_ex3, axisA_ex3, attractionPoint_ex3, numPoints_ex3, strength_ex3);
+console.log(`Generated ${points3.length} points.`);
+console.log("First 5 points:", points3.slice(0, 5).map(p => p.map(coord => coord.toFixed(4))));
+console.log("Last 5 points:", points3.slice(-5).map(p => p.map(coord => coord.toFixed(4))));
+// Expected: Points should be relatively uniformly distributed, as no point on the arc is significantly closer.
+// The "closest point" on the arc will likely be determined by its closest angular projection.
+
+// Example 4: No attraction (uniform distribution)
+const p0_ex4: Vec3 = [1, 0, 0];
+const p1_ex4: Vec3 = [0, 1, 0];
+const axisA_ex4: Vec3 = [0, 0, 1];
+const attractionPoint_ex4: Vec3 = [Math.sqrt(1 / 2), Math.sqrt(1 / 2), 0]; // Irrelevant when strength is 0
+const numPoints_ex4 = 50;
+const strength_ex4 = 4.0; // No attraction (uniform)
+
+console.log("\n--- Example 4: Uniform distribution (strength = 0) ---");
+const points4 = generateArcPoints(p0_ex4, p1_ex4, axisA_ex4, attractionPoint_ex4, numPoints_ex4, strength_ex4);
+console.log(`Generated ${points4.length} points.`);
+console.log("First 5 points:", points4.slice(0, 5).map(p => p.map(coord => coord.toFixed(4))));
+console.log("Last 5 points:", points4.slice(-5).map(p => p.map(coord => coord.toFixed(4))));
+// Expected: Points should be uniformly spaced.
+
+const sequentialDistances = points4.map((p, i) => {
+    if (i === 0) return 0; // Skip the first point
+    return vec3Distance(points4[i - 1], p);
+});
+console.log("Sequential distances between points (should be roughly equal for uniform distribution):", sequentialDistances.map(d => d.toFixed(4)));

package/tests/Math/arc.test.ts

@@ -0,0 +1,102 @@
+import { Vec3, Plane, Quaternion } from '../../Math/types';
+import * as vec3 from '../../Math/vec3';
+import * as plane from '../../Math/plane';
+import * as arc from '../../Math/arc';
+import * as quaternion from '../../Math/quaternion';
+import { EPSILON } from '../../Math/constants';
+
+
+
+const _p0 = vec3.create(1, 0, 0);
+const _p1 = vec3.create(0, 1, 0);
+const _0arc = arc.create(_p0, _p1);
+const _quaternion = quaternion.create(0, 0, 0, 1);
+
+
+/**
+ * // TODO:
+ * * _oppositePointsHandle while setting
+ */
+
+beforeAll(() => {
+    // Initialize any necessary data or state before running the tests
+    vec3.set(_p0, 1, 0, 0);
+    vec3.set(_p1, 0, 1, 0);
+    quaternion.set(_quaternion, 0, 0, 0, 1);
+    arc.set(_0arc, _p0, _p1);
+
+});
+
+
+test("arc.closestPoint 01", () => {
+    const point = vec3.create(0.5, 0.5, 0);
+
+    const isOnArc = arc.closestPoint(_p0, _0arc, point);
+    expect(isOnArc).toBe(true);
+    vec3.normalize(point, point);
+    expect(vec3.equals(_p0, point)).toBe(true);
+});
+
+
+
+test("arc.closestPoint 02", () => {
+    // set parameters
+    // rotate everything by random quaternion
+
+    const point = vec3.create(0.5, 0.5, 0);
+
+    const isOnArc = arc.closestPoint(_p0, _0arc, point);
+    expect(isOnArc).toBe(true);
+    vec3.normalize(_p1, point);
+    expect(vec3.equals(_p0, _p1)).toBe(true);
+
+
+    for (let i = 0; i < 100; i++) {
+
+        vec3.randomUnit(_p0);
+        quaternion.fromAxisAngle(_quaternion, _p0, Math.random() * Math.PI * 2);
+
+        vec3.copy(_p0, _0arc.p0);
+        vec3.applyQuaternion(_p0, _p0, _quaternion);
+        vec3.copy(_p1, _0arc.p1);
+        vec3.applyQuaternion(_p1, _p1, _quaternion);
+        arc.set(_0arc, _p0, _p1);
+        vec3.applyQuaternion(point, point, _quaternion);
+
+        const isOnArc = arc.closestPoint(_p0, _0arc, point);
+        expect(isOnArc).toBe(true);
+        vec3.normalize(_p1, point);
+        expect(vec3.equals(_p0, _p1)).toBe(true);
+
+    }
+});
+
+
+
+test("arc.closestPoint 03, outside", () => {
+    const point = vec3.create(-2, -2, 0);
+
+    const isOnArc = arc.closestPoint(_p0, _0arc, point);
+    console.log("inArc", _0arc);
+    console.log("point", point);
+    expect(isOnArc).toBe(false);
+
+    for (let i = 0; i < 100; i++) {
+
+        vec3.randomUnit(_p0);
+        quaternion.fromAxisAngle(_quaternion, _p0, Math.random() * Math.PI * 2);
+
+        vec3.copy(_p0, _0arc.p0);
+        vec3.applyQuaternion(_p0, _p0, _quaternion);
+        vec3.copy(_p1, _0arc.p1);
+        vec3.applyQuaternion(_p1, _p1, _quaternion);
+        arc.set(_0arc, _p0, _p1);
+        vec3.applyQuaternion(point, point, _quaternion);
+
+        const isOnArc = arc.closestPoint(_p0, _0arc, point);
+        expect(isOnArc).toBe(false);
+    }
+});
+
+
+

package/tests/Math/junction/arc-plane.test.ts

@@ -0,0 +1,163 @@
+import { Plane, Line, Vec3, Quaternion, Arc, Sphere } from '../../../Math/types';
+import * as plane from '../../../Math/plane';
+import * as line from '../../../Math/line';
+import * as arc from '../../../Math/arc';
+import * as vec3 from '../../../Math/vec3';
+import * as quaternion from '../../../Math/quaternion';
+import { planePlaneJuction } from '../../../Math/juction/plane-plane';
+import { lineSphereIntersection } from '../../../Math/juction/line-sphere';
+import { arcSlice } from '../../../Math/juction/arc-plane';
+import { EPSILON } from '../../../Math/constants';
+
+
+const arcIn = arc.create(vec3.create(0, 0, 1), vec3.create(1, 0, 0));
+const arcOut: [Arc, Arc] = [
+    arc.create(vec3.create(0, 0, 1), vec3.create(1, 0, 0)),
+    arc.create(vec3.create(0, 0, 1), vec3.create(1, 0, 0))
+];
+const arcExpected = arc.create(vec3.create(0, 0, 1), vec3.create(1, 0, 0));
+const junctionPlane = plane.create(vec3.create(0, 0, 1), 0);
+
+const origin = { center: vec3.create(0, 0, 0), radius: 1 } as Sphere;
+
+const r2 = Math.sqrt(2) / 2;
+const r3 = Math.sqrt(3) / 3;
+
+beforeAll(() => {
+    // Initialize any necessary data or state before running the tests
+    arc.set(arcIn, vec3.create(0, 0, 1), vec3.create(1, 0, 0));
+    arc.set(arcOut[0], vec3.create(0, 0, 1), vec3.create(1, 0, 0));
+    arc.set(arcOut[1], vec3.create(0, 0, 1), vec3.create(1, 0, 0));
+
+    plane.set(junctionPlane, vec3.create(0, 0, 1), 0);
+
+});
+
+
+
+
+
+test('arcSlice - No intersection 1', () => {
+    junctionPlane.distance = 2; // Set distance to ensure no intersection
+    const result = arcSlice(arcOut, arcIn, junctionPlane);
+    expect(result).toBe(0);
+});
+
+
+
+test('arcSlice - Full intersection 1', () => {
+    junctionPlane.distance = 0; // Set distance to ensure full intersection
+    const result = arcSlice(arcOut, arcIn, junctionPlane);
+    expect(result).toBe(1);
+    const isEqual = arc.equals(arcOut[0], arcExpected);
+    expect(isEqual).toBe(true);
+});
+
+
+test('arcSlice-1', () => {
+    // Set up a case where the arc intersects with the plane
+
+
+    const r3 = Math.sqrt(3);
+    const juctionNormal = vec3.create(r3, r3, r3);
+
+    plane.set(junctionPlane, juctionNormal, 0);
+
+    const result = arcSlice(arcOut, arcIn, junctionPlane);
+    expect(result).toBe(1);
+});
+
+
+test('arcSlice - Plane intersection line is out of sphere', () => {
+    // Set up a case where the arc intersects with the plane
+
+    const point1 = vec3.create(0, 1, 0);
+    const point2 = vec3.create(0, 0, 1);
+    arc.set(arcIn, point1, point2);
+
+    const juctionNormal = vec3.create(r3, r3, r3);
+
+    const closestPoint = vec3.create(r2, r2, 0);
+    const distance = vec3.dot(juctionNormal, closestPoint) + EPSILON;
+    plane.set(junctionPlane, juctionNormal, distance);
+
+    const result = arcSlice(arcOut, arcIn, junctionPlane);
+    expect(result).toBe(0);
+});
+
+
+test("arcSlice - Planes are parallel", () => {
+
+    const point1 = vec3.create(0, 1, 0);
+    const point2 = vec3.create(0, 0, 1);
+    arc.set(arcIn, point1, point2);
+
+    plane.fromValues(junctionPlane, 1, 0, 0, 0.3); // Set a plane parallel to the arc's normal
+    const result = arcSlice(arcOut, arcIn, junctionPlane);
+    expect(result).toBe(0); // Expect no intersection
+
+    junctionPlane.distance = -0.3;
+
+    const result2 = arcSlice(arcOut, arcIn, junctionPlane);
+    expect(result2).toBe(1); // Expect no intersection
+    const isEqual = arc.equals(arcOut[0], arcIn);
+    expect(isEqual).toBe(true); // Expect the output arc to be equal to the input arc
+});
+
+
+test("arcSlice - Arc sliced in half", () => {
+
+    const point1 = vec3.create(0, 1, 0);
+    const point2 = vec3.create(0, 0, 1);
+    arc.set(arcIn, point1, point2);
+
+    expect(vec3.equals(arcIn.normal, vec3.create(1, 0, 0))).toBe(true); // Arc normal should be (1, 0, 0)
+
+    plane.fromValues(junctionPlane, 0, -r2, r2, 0); // Set a plane parallel to the arc's normal
+
+    const result = arcSlice(arcOut, arcIn, junctionPlane);
+    expect(result).toBe(1); // Expect an intersection
+    const expectedPoint1 = vec3.create(0, r2, r2);
+    const expectedPoint2 = vec3.create(0, 0, 1);
+    arc.set(arcExpected, expectedPoint1, expectedPoint2);
+    const isEqual = arc.equals(arcOut[0], arcExpected);
+    expect(isEqual).toBe(true); // Expect the output arc to be equal to the expected arc
+});
+
+
+test("arcSlice - Arc sliced in middle", () => {
+    const point1 = vec3.create(0, 1, 0);
+    const point2 = vec3.create(0, 0, 1);
+    arc.set(arcIn, point1, point2);
+
+
+    plane.fromValues(junctionPlane, 0, r2, r2, r2);
+
+    const result = arcSlice(arcOut, arcIn, junctionPlane);
+    expect(result).toBe(1);
+    expect(arc.equals(arcOut[0], arcIn)).toBe(true);
+
+
+    const gap = 1 - r2;
+    const stepCount = 100;
+
+    const points: [Vec3, Vec3] = [vec3.create(0, 1, 0), vec3.create(0, 0, 1)];
+    const lineOfPoints = line.create();
+    vec3.set(lineOfPoints.direction, 0, -r2, r2);
+
+    for (let i = 0; i < stepCount - 1; i++) {
+        const distance = gap * i / stepCount + r2;
+        junctionPlane.distance = distance;
+        const result = arcSlice(arcOut, arcIn, junctionPlane);
+        expect(result).toBe(1);
+
+        vec3.set(lineOfPoints.origin, 0, r2 * distance, r2 * distance);
+        const haveIntersections = lineSphereIntersection(points, lineOfPoints, origin);
+        expect(haveIntersections).toBe(true); // Expect the line to intersect with the sphere
+        arc.set(arcExpected, points[0], points[1]);
+
+        const isEqual = arc.equals(arcOut[0], arcExpected);
+        expect(isEqual).toBe(true); // Expect the output arc to be equal to the expected arc
+
+    }
+});