Fixed #9
Fixed #10. Was not returning first voxel
Use if statement instead of continue