import assert from 'node:assert/strict'; import {referenceCloud,transformCloud,rigidFit,nearestRMSE,pairedRMSE,stepICP} from './icp.js'; const reference=referenceCloud(), moved=transformCloud(reference,23,.29,0); const fit=rigidFit(moved,reference), recovered=moved.map(fit.apply); assert.ok(pairedRMSE(recovered,reference)<1e-9,'Rigid fit should recover an exactly paired transformation'); let cloud=transformCloud(reference,12,.14,0),last=nearestRMSE(cloud,reference); for(let i=0;i<70;i++){ const result=stepICP(cloud,reference); assert.ok(result.rmse<=last+1e-10,'Nearest-neighbour RMSE must not increase in ordinary ICP'); cloud=result.points;last=result.rmse; } assert.ok(pairedRMSE(cloud,reference)<1e-6,'ICP should recover this well-initialized noiseless example'); const noisy=transformCloud(reference,0,0,.02); assert.ok(nearestRMSE(noisy,reference)>0,'Noisy observations should retain residual error'); console.log('Passed: rigid fit, ICP convergence, monotonic RMSE and noise checks.');