Localization working while standing still. Minor issues with pole assignment check.