Finished Makefile. Cleaned up Tests

Added TestUtils.hpp for some code re-use.