Cannot compile without rostest in CMakeLists.txt and package.xml