(a) Experimental results of the proposed ranging and SLAM algorithm with state observer odometer trail. Actual floor-plan of the building is superimposed later on a mature map to illustrate the accuracy of our method. Note that the floor plan was not provided to the system a priori. (b) The same environment mapped by a ground robot with a different starting point, to illustrate that our algorithm is compatible with different platforms.