Typical off by one.
ToDo:
Cleanup
Visualize
Ensure Multithreads work
Implement other algorithms.