Added C++ code

Git is a pain in the ass.