Split up code into a separate file with tests

[peterfpeterson]

This is just to make the code a bit more stable.