rewrote some fuctions to handle streamed data from the kinect
Rewrote occupancy grid for speed