Add Unit Test Framework

[JosiahJack]

And bugfixes since it has been too long that I didn't realize I was on this branch.