Adding the .cpp and .h file
Revert "Update README.md"

This reverts commit a142e80cda1c4731678160bfed0872f635395805.