cmake_minimum_required(VERSION 3.8)
project(g2_2025_odometry_pkg)

if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
  add_compile_options(-Wall -Wextra -Wpedantic)
endif()


# external packages
include(FetchContent)

FetchContent_Declare(
    tomlplusplus
    GIT_REPOSITORY https://github.com/marzer/tomlplusplus.git
    GIT_TAG v3.4.0
)

FetchContent_MakeAvailable(tomlplusplus)

# find dependencies
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED)
find_package(nav_msgs REQUIRED)
find_package(geometry_msgs REQUIRED)
find_package(std_msgs REQUIRED)
find_package(sensor_msgs REQUIRED)
find_package(rclcpp REQUIRED)
find_package(sensor_msgs REQUIRED)
find_package(geometry_msgs REQUIRED)

# Add executable for g2_2025_imu_position_approximator_node
add_executable(g2_2025_imu_position_approximator_node
  src/g2_2025_imu_position_approximator_node/nodes/IMUPositionApproximator.cpp
  src/g2_2025_imu_position_approximator_node/Main.cpp
)

target_include_directories(g2_2025_imu_position_approximator_node PRIVATE
  ${CMAKE_CURRENT_SOURCE_DIR}/src
  ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_imu_position_approximator_node
)

ament_target_dependencies(g2_2025_imu_position_approximator_node
  rclcpp
  sensor_msgs
  geometry_msgs
)

add_executable(g2_2025_database_node
  src/g2_2025_database_node/Main.cpp
  src/g2_2025_database_node/nodes/DatabaseHandlerNode.cpp
  src/database/DatabaseManager.cpp
  src/config/ConfigManager.cpp
)

target_include_directories(g2_2025_database_node PRIVATE
  ${CMAKE_CURRENT_SOURCE_DIR}/src
  ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_database_node
)

target_link_libraries(g2_2025_database_node tomlplusplus::tomlplusplus pqxx pq)

ament_target_dependencies(g2_2025_database_node
  rclcpp
  sensor_msgs
  geometry_msgs
)

add_executable(g2_2025_imu_data_simulator_node
    src/g2_2025_imu_data_simulator_node/nodes/ImuDataSimulator.cpp
    src/g2_2025_imu_data_simulator_node/main.cpp
    src/simulator/Simulator.cpp)

target_include_directories(g2_2025_imu_data_simulator_node PRIVATE
    ${CMAKE_CURRENT_SOURCE_DIR}/src
    ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_imu_data_simulator_node
)

ament_target_dependencies(g2_2025_imu_data_simulator_node rclcpp sensor_msgs geometry_msgs)

add_executable(g2_2025_wheel_data_simulator_node
    src/g2_2025_wheel_data_simulator_node/nodes/WheelDataSimulator.cpp
    src/g2_2025_wheel_data_simulator_node/main.cpp
    src/simulator/Simulator.cpp)

target_include_directories(g2_2025_wheel_data_simulator_node PRIVATE
    ${CMAKE_CURRENT_SOURCE_DIR}/src
    ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_wheel_data_simulator_node
)

ament_target_dependencies(g2_2025_wheel_data_simulator_node rclcpp std_msgs)

add_executable(g2_2025_wheel_approximator_node
 src/g2_2025_wheel_approximator_node/nodes/WheelPositionApproximator.cpp
 src/g2_2025_wheel_approximator_node/main.cpp
 )

ament_target_dependencies(g2_2025_wheel_approximator_node rclcpp nav_msgs geometry_msgs)

install(
    DIRECTORY launch config
    DESTINATION share/${PROJECT_NAME}/
)

install(TARGETS
  g2_2025_imu_position_approximator_node
  g2_2025_wheel_approximator_node
  g2_2025_imu_data_simulator_node
  g2_2025_wheel_data_simulator_node
  g2_2025_database_node
  DESTINATION lib/${PROJECT_NAME}
)

if(BUILD_TESTING)
  find_package(ament_cmake_gtest REQUIRED)

  # Simulator unit tests
  ament_add_gtest(test_simulator test/Simulator.test.cpp src/simulator/Simulator.cpp)
  target_include_directories(test_simulator PRIVATE ${CMAKE_CURRENT_SOURCE_DIR}/src)
  ament_target_dependencies(test_simulator rclcpp)

  # IMU simulator integration tests
  ament_add_gtest(test_imu_simulator test/ImuSimulator.test.cpp
    src/g2_2025_imu_data_simulator_node/nodes/ImuDataSimulator.cpp
    src/simulator/Simulator.cpp)
  target_include_directories(test_imu_simulator PRIVATE
    ${CMAKE_CURRENT_SOURCE_DIR}/src
    ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_imu_data_simulator_node)
  ament_target_dependencies(test_imu_simulator rclcpp sensor_msgs geometry_msgs)

  # Wheel simulator integration tests
  ament_add_gtest(test_wheel_simulator test/WheelSimulator.test.cpp
    src/g2_2025_wheel_data_simulator_node/nodes/WheelDataSimulator.cpp
    src/simulator/Simulator.cpp)
  target_include_directories(test_wheel_simulator PRIVATE
    ${CMAKE_CURRENT_SOURCE_DIR}/src
    ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_wheel_data_simulator_node)
  ament_target_dependencies(test_wheel_simulator rclcpp std_msgs)

  # Wheel position approximator tests
  ament_add_gtest(test_wheel_position_approximator test/WheelPositionApproximator.test.cpp
    src/g2_2025_wheel_approximator_node/nodes/WheelPositionApproximator.cpp)
  target_include_directories(test_wheel_position_approximator PRIVATE
    ${CMAKE_CURRENT_SOURCE_DIR}/src
    ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_wheel_approximator_node)
  ament_target_dependencies(test_wheel_position_approximator rclcpp nav_msgs geometry_msgs)

#   IMU position approximator tests
  ament_add_gtest(test_imu_position_approximator test/IMUApproximatorNode.test.cpp
      src/g2_2025_imu_position_approximator_node/nodes/IMUPositionApproximator.cpp)
  target_include_directories(test_imu_position_approximator PRIVATE
      ${CMAKE_CURRENT_SOURCE_DIR}/src
      ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_imu_position_approximator_node)
  ament_target_dependencies(test_imu_position_approximator rclcpp sensor_msgs geometry_msgs)

  # ConfigManager tests
  ament_add_gtest(test_config_manager test/ConfigManager.test.cpp
      src/config/ConfigManager.cpp)
  target_include_directories(test_config_manager PRIVATE
      ${CMAKE_CURRENT_SOURCE_DIR}/src)
  target_link_libraries(test_config_manager tomlplusplus::tomlplusplus)
  ament_target_dependencies(test_config_manager rclcpp)

  # DatabaseManager tests
  ament_add_gtest(test_database_manager test/DatabaseManager.test.cpp
      src/database/DatabaseManager.cpp
      src/config/ConfigManager.cpp)
  target_include_directories(test_database_manager PRIVATE
      ${CMAKE_CURRENT_SOURCE_DIR}/src)
  target_link_libraries(test_database_manager pqxx tomlplusplus::tomlplusplus)
  ament_target_dependencies(test_database_manager rclcpp)

  # DatabaseHandlerNode tests
  ament_add_gtest(test_database_handler_node test/DatabaseHandlerNode.test.cpp
      src/g2_2025_database_node/nodes/DatabaseHandlerNode.cpp
      src/database/DatabaseManager.cpp
      src/config/ConfigManager.cpp)
  target_include_directories(test_database_handler_node PRIVATE
      ${CMAKE_CURRENT_SOURCE_DIR}/src
      ${CMAKE_CURRENT_SOURCE_DIR}/src/g2_2025_database_node)
  target_link_libraries(test_database_handler_node pqxx tomlplusplus::tomlplusplus)
  ament_target_dependencies(test_database_handler_node rclcpp geometry_msgs sensor_msgs)
endif()

ament_package()
