Multi-scale point and line range data algorithms for mapping and localization