ProSLAM: Graph SLAM from a Programmer's Perspective
A method for registration of 3d shapes