Added gmapping 2D and octomapping 3D map