8. Conclusions and future work
We have presented an efficient variation of the Sparse ICP algorithm that is based on a new hybrid optimization which starts with a general Simulated Annealing search and then switches to ADMM-based ICP, to ensure convergence to an optimal solution. We have also provided several insights on how to further improve the efficiency of our method using a combination of approximate distance queries, parallel execution and uniform subsampling. The cumulative performance increase over the original Sparse ICP is more than one order of magnitude when tested on the registration of partially overlapping scans. At the same time, we have demonstrated that the hybrid optimization approach in our method avoids undesired local minima, increasing the robustness of the registration process in very challenging alignment problems that involve a large number of outliers and partially overlapping surfaces. An interesting direction of research for the future is the adaptation of our hybrid optimization strategy and the underlying data structures to GPUs and similar massively parallel architectures, in order to achieve further performance improvements. Additionally, it would be interesting to explore possible extensions of our method that use salient features in order to further improve the reliability of the alignment.