The localization and the map publisher are working

There are still more things to do and a code cleanup, but we should merge