Added code and some testvectors
Updated README