Put params in right order & comment
Add close function, optimize angleBetween
Switch to gtest

cpptest doesn't print out expected/actual values, gtest is also a little
easier to maintain