Advances for metric-topological KF-SLAM