improved slef localisation algorithm