Refactor scheduler code to make it easier to follow

[frandorr]

There is a big for loop that should be refactored to an outside function.