Sigma-FP: Robot Mapping of 3D Floor Plans With an RGB-D Camera Under Uncertainty