Add CMakeLists.txt and working program