Fixed bugs. Alogorithm now runs most the time.
Better print statements