A method supported by Simultaneous Localization And Mapping, Marianne Løvås, Master thesis, NTNU, July 2017, Part of R&D project “Infrastructure in 3D” in cooperation between Innovation Norge, Trafikverket and TerraTec Part of the R&D project “Infrastructure in 3D” in cooperation between Innovation Norge, Trafikverket and TerraTec, Report 6B