cmake_minimum_required(VERSION 3.10)
project(tf3_geometry_msgs)

set(CMAKE_CXX_STANDARD 17)
set(CMAKE_CXX_STANDARD_REQUIRED ON)
set(CMAKE_POSITION_INDEPENDENT_CODE ON)

# Find dependencies
find_package(Boost COMPONENTS thread REQUIRED)
find_package(GTest REQUIRED)
# Finding Eigen3
find_package(Eigen3 REQUIRED)

if (NOT TARGET tf3)
    add_subdirectory(/home/duongtd/robotics_core/tf3 ${CMAKE_BINARY_DIR}/tf3_build)
endif()

if (NOT TARGET geometry_msgs)
    add_subdirectory(/home/duongtd/robotics_core/common_msgs/geometry_msgs ${CMAKE_BINARY_DIR}/geometry_msgs_build)
endif()


# Include directories
include_directories(
  include
  ${EIGEN3_INCLUDE_DIRS}
  ${Boost_INCLUDE_DIRS}
  ${GTEST_INCLUDE_DIRS}
)

# Install headers
install(DIRECTORY include/${PROJECT_NAME}/
  DESTINATION include/${PROJECT_NAME}
)

add_library(tf3_geometry_msgs INTERFACE
)

target_include_directories(tf3_geometry_msgs INTERFACE
  ${CMAKE_CURRENT_SOURCE_DIR}/include
)

# Liên kết với std_msgs nếu bạn có file Header.h trong include/std_msgs/
target_link_libraries(tf3_geometry_msgs INTERFACE 
                      geometry_msgs
                      )
  
#   # Test: tomsg_frommsg
  add_executable(test_tomsg_frommsg test/test_tomsg_frommsg.cpp)
  target_link_libraries(test_tomsg_frommsg 
    ${GTEST_LIBRARIES}
    tf3_geometry_msgs
    Threads::Threads
    tf3
  )
#   # Test: tf2_geometry_msgs
  add_executable(test_geometry_msgs test/test_tf2_geometry_msgs.cpp)
  target_link_libraries(test_geometry_msgs 
    ${GTEST_LIBRARIES}
    Threads::Threads
    tf3
    tf3_geometry_msgs
  )
