ICP is a few lines of code and a source of long afternoons. It converges beautifully in the demo, and then, in the building, it slides the robot down a corridor, or locks a wall onto the wrong wall.
You write it, push it until it breaks to learn where it breaks, and then make it tolerate the things real scans contain: people, and parts of the scene the other scan never saw.