Add automated tests

[EliuX]

Find a suitable way of a suiteable way of adding tests and implement it, if possible for more than a 90% of coverage.