Add simple readme
Add new algorithm and refactor tests