Move python code to Python directory and begins port to C++