Fixed some of the 2d problems, most folds still not working specifically in algorithm B, but 2 examples working so far (one 3d one 2d)