Dynamic robot localization and mapping using uncertainty sets