Bug fix: bad translation output by ICP registration with adaptative scale