Loop closure heuristics working.