Better tests CMakeLists.txt
Set up first benchmark, added a utility function.
Merge branch 'benchmark' into cmake