Getting rid of obstacle_voxel set as it just slows things down