Added test to CMakeList, removed some debug printing.