Copy-past import of my implementation from my own project.
Converted my code to allow copy pasting the cpp/header files into a project.
Added README content.