Contact "Iterative Kalman smoother for robust 3D localization for vision-aided inertial navigation" support