Added a feature correspondence threshold constraint to avoid some false positve loop closures, inspired by Whelan's IROS13 paper