Added Loop Closure
Merge pull request #24 from markrosoft/master

Loop Closure Fix (initially the wrong old map was committed)