Write unit tests for the codebase

[MarshallAsch]

This will be an important step to include as part of my verification for my defence that the algorithm is in fact actually doing what it is supposed to be doing.

test as much as possible, this process may also involve refactoring some more of the code into smaller components to make them easier to test.

[MarshallAsch]

as of 5a374ed I believe that all of the current components that can have unit tests are being tested.