Simple init mapping

Now after the localization the map is initialize. In this way we are sure that the Mapping Task doesn't run because MainController has bigger priority and also resolves the problem when the robot has to turn