Fix map mutex use (gmapping issue #11)