Switchable Constraints for Robust Simultaneous Localization and Mapping and Satellite-Based Localization