Adds testing to CMake, also adds test_depends to package.xml
adds profiler check for /enable_statistics, will not run unless set