Working version
Documentated source in readme