Refactored scan test program.
Refactored CMake file in regard to tests. Added some MC test skeleton