Add more cmake structure and test directory

I am having trouble getting test directory to link to files in src/.
It works when I write the full relative path to the file, but there
has to be a better solution available