Spaces:
Running
Running
File size: 1,006 Bytes
7bd1cc6 | 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 | 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.');
|