self localization working