Add c++ testing code