Initial working commit, add simple test codes, CMakeLists.txt and Makefile