Robot localization
merge stuff