3D Robotic Mapping: The Simultaneous Localization and Mapping Problem with Six Degrees of Freedom (Springer Tracts in Advanced Robotics)