Cleaning up the CMakeLists and adding a trivial pose_test.cpp