Add C++ implementation
Merge pull request #1 from Chocti/master

Add C++ implementation