a tutorial on graph - based slam .
A method for registration of 3d shapes