Adding Readme and some tests

Adding readme with instructions, some tests and some bugfixing.