@davepagurek/flo-mat/src/closest-boundary-point/get-best-distance-squared.ts

Medial / Scale Axis Transform (MAT/SAT) Library.

import { evalDeCasteljau } from 'flo-bezier3';
import { squaredDistanceBetween } from 'flo-vector2d';
import { BezierPiece } from "../mat/bezier-piece.js";


/**
 * @internal
 * Finds an initial distance such that the closest point can not be further than 
 * this distance away.
 */ 
function getBestDistanceSquared(
        bezierPieces: BezierPiece[], 
        p: number[]) {

    let bestSquaredDistance = Number.POSITIVE_INFINITY;
    for (let i=0; i<bezierPieces.length; i++) {
        const bezierPiece = bezierPieces[i];

        const ps = bezierPiece.curve.ps;
        
        const p1 = evalDeCasteljau(ps, bezierPiece.ts[0]);
        const p2 = evalDeCasteljau(ps, bezierPiece.ts[1]);
        
        const d = Math.min(
            squaredDistanceBetween(p, p1),
            squaredDistanceBetween(p, p2)
        ); 
        
        if (d < bestSquaredDistance) {
            bestSquaredDistance = d;  
        }
    }

    // The extra multiplier is to account for floating point precision.
    return (1 + 2**-10)*bestSquaredDistance;
}


export { getBestDistanceSquared }