Work on gmapping launch, create map and plots