Hi, thank you for the interesting work!
I found that when constructing semantic voxel maps, it appears that occupancy_grid is being permuted twice: once inside create_occupancy_grid, and again right before concatenation with grid_2d). This double permutation reverts the grid to the original xyz order, and leads to a dimension mismatch errors when the number of grid points differs between y and z axes. Should one of these permutations removed?