Add Unit Tests

I started with first unit test and a unit test basic structure while working on issue #2 (closed). Now, with this issue unit tests for all classes and helper functions should follow.