Add source code + CMakeLists.txt file + modify README.md file