Started on cpp functions
1. Defined all functions in the cpp
2. Deleted unused variables from hpp
3. Deleted main, going to make another one
- Defined all functions in cpp
- Modified hpp
- Added main.cpp to test functions