Gmapping first try working