Take look at the IPython Notebook

Integrates Range Sensor Measurements in an 3D Occupancy Grid with Inverse Sensor Model.

to

(a 2D slice out of the 3D Occupancy Grid)

Thanks to Anton Fletcher for the Bresenham3D Algorithm