The Graph SLAM Algorithm with Applications to Large-Scale Mapping of Urban Structures