Basic ICP working with no local minimum suppression and numerical minimisation.