Add tests code from copytool branch

Add unit test code from the copytool branch. This needed some re-arrangement of our directory structure due to clashing. Did a small clean-up of our CMakelists also for easier maintenance.