Add basic test and cmake build file