find_package(ament_cmake_gtest REQUIRED)
ament_add_gtest(test_noise_generator test_noise_generator.cpp)
ament_target_dependencies(test_noise_generator tf2_eigen)
target_link_libraries(test_noise_generator stomp::stomp rsl::rsl)

ament_add_gtest(test_cost_functions test_cost_functions.cpp)
ament_target_dependencies(test_cost_functions moveit_core)
target_link_libraries(test_cost_functions stomp::stomp rsl::rsl)
