Removed debug printouts and added unit tests with Boost Test