Move general functionality from KalmanLocalizer to Localizer