Add CMake tests and incorporate them into GitLab's CI

• [Create Tests] Create tests by modifying the current Catkin-dependent tests in the tests/ directory.
• [Add to CMake] Add tests to CMake build structure
• [Test] Test that the tests are doing what they are supposed to.