Voxel class created. Some functions added to VoxelGridTracking class.