Probabilistic, 3D occupancy grid building
