Added code to change optimisation procedure depending on how loops were...

Added code to change optimisation procedure depending on how loops were closed. Partial loop closures are now rejected if a full loop closure moves the maps too far apart