Add unit tests

[ChristianFeldmann]

We should add some testing infrastructure and test the individual classes a bit:

• [x] Add gtest
• [ ] Test threading queue
• [ ] Add test for the whole library (push frames and check the output results)
• [ ] ...