A complete frontier-based exploration method for Pose-SLAM
Covariance recovery from a square root information matrix for data association