fixed sparsity
fixed sparsity - occupancy map was not normalized before return