[C++] Finished. Cleaned up code. Removed old comments and testing print statements