Integrate gtest
link pthread
Merge pull request #47 from ethz-asl/fix/gtest

Integrate gtest