Robust simultaneous UWB-anchor calibration and robot localization for emergency situations