Moved TestBench to main sources, fixes #5