@davepagurek/flo-mat/src/mat/cmp-cp-on-delta.ts

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

import { CpNode } from '../cp-node/cp-node.js';
import { ContactPoint, compareCps } from '../contact-point/contact-point.js';


/**
 * @internal
 * 
 * Note: For debugging only
 * 
 * Checks the position of the ContactPoint (cp) on the boundary piece. 
 * Returns < 0 if the cp is not on δ, > 0 if it is on the boundary piece 
 * excluding the endpoints and 0 if it is on the endpoints. Also returns > 0 if
 * δ === undefined.
 * 
 * @param δ The boundary piece
 * @param cp The contact point
 */
function cmpCpOnδ(
        δ: CpNode[], 
        cp: ContactPoint) {

    if (δ[0] === undefined) { 
        return 1;
    }

    const cpBef = δ[0].cp;
    const cpAft = δ[1].cp;

    const cmp     = compareCps(cpBef, cpAft); 
    const cmpPrev = compareCps(cpBef, cp);
    const cmpNext = compareCps(cp,    cpAft);
    
    if (cmp < 0) {
        if (cmpPrev > 0 || cmpNext > 0) {
            console.log(`2-PRONG (antipode) Order is wrong - cmpPrev and cmpNext should be > 0; cmp: ${cmp}, cmpPrev: ${cmpPrev}, cmpNext ${cmpNext}`);
            //_debug_.fs.draw.dot(cp.pointOnShape.p, 1, "blue");
            return -1;
        }
    } else if (cmp > 0) {
        if (cmpPrev > 0 && cmpNext > 0) {
            console.log(`2-PRONG (antipode) Order is wrong: ${cmpPrev}, ${cmpNext}`);
            //_debug_.fs.draw.dot(cp.pointOnShape.p, 1, "blue");
            return -1;
        }
    } 

    if (cmpPrev === 0 || cmpNext === 0) {
        console.log('2-PRONG orders are equal.');	
        return 0;
    }

    return 1;
}


export { cmpCpOnδ }