Fix rounding issue in SpatialHashing, add debugDraw function.

Need to add entire boundingbox to grid and not just corners, fix this at
some point.