Added calculation of free areas of local maps and evaluation of how well free...

Added calculation of free areas of local maps and evaluation of how well free area match. This score is now used as part of loop closing