A robust and efficient mapping and positioning system | IEEE Conference Publication | IEEE Xplore