Added util.h for general structs
Better logging
More voxelisation pre-compute porting