A random nit as we like:

> I needed to somehow create a function that performs a single step of the algorithm, then gives back control to the main loop (which ironically sounds just like an OS' preemptive scheduling)

That sounds more like cooperative scheduling, no?