Move blocks of code from the sws main loop into their own functions for easier refactoring later.

The next step will be to call the correct function after a poll, rather than looping unconditionally