Added experimental support for 3D occupancy grids.

Occupied cells (occupancy value larger than 0.5) are drawn as opaque cubes;
free and unexplored is not drawn at all.