Improve residuals weighting
- Fix duplicated weighing of each residual
- Use TukeyLoss instead of ArctanLoss for ICP residuals robustifier (more aggressive to outliers)
- Replace messy LossScale parameter by intuitive SaturationDistance
- Add ICP match quality weight in debug arrays
Edited by Nicolas Cadart