Fixes more accurate bresenham implementation
Adds publisher for cleared voxel points
Some fixes for the old bresenham implementation