Simultaneous calibration, localization, and mapping