Bug fixes in Topological Mapping and in KFSphereSLAM