Fixed ordering of node addition when object detected, saving map when node added