update for ROS

2026-01-07 16:56:13 +07:00
parent e0db8d0e20
commit ff90ea2f29
6 changed files with 343 additions and 145 deletions
--- a/robot_tf3_sensor_msgs/CMakeLists.txt
+++ b/robot_tf3_sensor_msgs/CMakeLists.txt
@@ -1,98 +1,176 @@
-cmake_minimum_required(VERSION 3.10)
+cmake_minimum_required(VERSION 3.0.2)
+project(robot_tf3_sensor_msgs VERSION 1.0.0 LANGUAGES CXX)

-# ========================================================
-# Dual-mode CMakeLists.txt: Supports both Catkin and Standalone CMake
-# ========================================================
-
-# Detect if building with Catkin
 if(DEFINED CATKIN_DEVEL_PREFIX OR DEFINED CATKIN_TOPLEVEL)
  set(BUILDING_WITH_CATKIN TRUE)
  message(STATUS "Building robot_tf3_sensor_msgs with Catkin")
-  find_package(catkin REQUIRED)
+
 else()
  set(BUILDING_WITH_CATKIN FALSE)
  message(STATUS "Building robot_tf3_sensor_msgs with Standalone CMake")
 endif()

-project(robot_tf3_sensor_msgs)
-
+# C++ Standard - must be set before find_package
 set(CMAKE_CXX_STANDARD 17)
 set(CMAKE_CXX_STANDARD_REQUIRED ON)
-set(CMAKE_POSITION_INDEPENDENT_CODE ON)
+set(CMAKE_CXX_EXTENSIONS OFF)
+
+# Find dependencies
+find_package(Boost REQUIRED COMPONENTS thread)
+find_package(Eigen3 REQUIRED)
+find_package(GTest REQUIRED)
+
+if (NOT BUILDING_WITH_CATKIN)
+
+  # Enable Position Independent Code
+  set(CMAKE_POSITION_INDEPENDENT_CODE ON)
+
+  # Cấu hình RPATH để tránh cycle trong runtime search path
+  set(CMAKE_BUILD_RPATH_USE_ORIGIN TRUE)
+  set(CMAKE_INSTALL_RPATH_USE_LINK_PATH TRUE)
+  set(CMAKE_BUILD_RPATH "${CMAKE_BINARY_DIR}")
+
+  set(PACKAGES_DIR  
+    robot_sensor_msgs
+    data_convert
+    tf3
+    robot_geometry_msgs
+  )
+
+else()

 # ========================================================
 # Catkin specific configuration
 # ========================================================
+  find_package(catkin REQUIRED COMPONENTS         
+    robot_sensor_msgs
+    data_convert
+    tf3
+    robot_geometry_msgs
+  )

-if(BUILDING_WITH_CATKIN)
  catkin_package(
    INCLUDE_DIRS include
    # LIBRARIES không cần vì đây là header-only library
-    # CATKIN_DEPENDS không cần vì dependencies không phải Catkin packages
+    CATKIN_DEPENDS robot_sensor_msgs data_convert tf3 robot_geometry_msgs
    DEPENDS Eigen3 Boost
  )
+
+  include_directories(
+    include
+    ${catkin_INCLUDE_DIRS}
+    ${EIGEN3_INCLUDE_DIRS}
+    ${Boost_INCLUDE_DIRS}
+  )
 endif()

-# Find dependencies
-find_package(Boost COMPONENTS thread REQUIRED)
-find_package(GTest REQUIRED)
+# Tìm tất cả header files
+file(GLOB_RECURSE HEADERS "include/robot_tf3_sensor_msgs/*.h")

-# Finding Eigen3
-find_package(Eigen3 REQUIRED)
+# Tạo INTERFACE library (header-only)
+add_library(${PROJECT_NAME} INTERFACE)

+if(BUILDING_WITH_CATKIN)
+  add_dependencies(${PROJECT_NAME} ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS})

-# Include directories
-include_directories(
-  include
-  ${EIGEN3_INCLUDE_DIRS}
-  ${Boost_INCLUDE_DIRS}
-  ${GTEST_INCLUDE_DIRS}
-)
+  # Set include directories
+  target_include_directories(${PROJECT_NAME}
+    INTERFACE 
+      $<BUILD_INTERFACE:${CMAKE_CURRENT_SOURCE_DIR}/include>
+      $<INSTALL_INTERFACE:include>
+  )

-add_library(robot_tf3_sensor_msgs INTERFACE
-)
-
-target_include_directories(robot_tf3_sensor_msgs
+  # Link dependencies (header-only, chỉ cần include paths)
+  target_link_libraries(${PROJECT_NAME}
    INTERFACE
-        $<BUILD_INTERFACE:${CMAKE_CURRENT_SOURCE_DIR}/include>
-        $<INSTALL_INTERFACE:include>
-)
+      ${catkin_LIBRARIES}
+  )

-target_link_libraries(robot_tf3_sensor_msgs INTERFACE 
-                      robot_sensor_msgs
-                      data_convert
-                      )
+else()

-# --- Cài đặt thư viện vào hệ thống khi chạy make install ---
-install(TARGETS robot_tf3_sensor_msgs
-  EXPORT robot_tf3_sensor_msgs-targets
-  INCLUDES DESTINATION include # Cài đặt include
-)
+  # Set include directories
+  target_include_directories(${PROJECT_NAME}
+    INTERFACE 
+      $<BUILD_INTERFACE:${CMAKE_CURRENT_SOURCE_DIR}/include>
+      $<INSTALL_INTERFACE:include>
+  )

-# --- Xuất export set robot_tf3_sensor_msgs-targets thành file CMake module ---
-# --- Tạo file lib/cmake/robot_tf3_sensor_msgs/robot_tf3_sensor_msgs-targets.cmake ---
-# --- File này chứa cấu hình giúp project khác có thể dùng ---
-# --- Find_package(robot_tf3_sensor_msgs REQUIRED) ---
-# --- Target_link_libraries(my_app PRIVATE robot_tf3_sensor_msgs::robot_tf3_sensor_msgs) ---
-install(EXPORT robot_tf3_sensor_msgs-targets 
-  FILE robot_tf3_sensor_msgs-targets.cmake
-  NAMESPACE robot_tf3_sensor_msgs::
-  DESTINATION lib/cmake/robot_tf3_sensor_msgs
-)
-  
-add_executable(test_tf2_sensor_msgs test/test_tf2_sensor_msgs.cpp)
-target_include_directories(test_tf2_sensor_msgs PUBLIC 
-  ${EIGEN3_INCLUDE_DIRS}
-  ${GTEST_INCLUDE_DIRS}
-  robot_tf3_sensor_msgs
-  geometry_msgs
-  tf3
-)
-target_link_libraries(test_tf2_sensor_msgs 
-  ${GTEST_LIBRARIES}
-  Threads::Threads
-  robot_tf3_sensor_msgs
-  geometry_msgs
-  tf3
-  data_convert
-)
+  # Link dependencies (header-only, chỉ cần include paths)
+  target_link_libraries(${PROJECT_NAME}
+    INTERFACE
+      ${PACKAGES_DIR}
+  )
+
+endif()
+
+if(BUILDING_WITH_CATKIN)
+  ## Mark libraries for installation
+  ## See http://docs.ros.org/melodic/api/catkin/html/howto/format1/building_libraries.html
+  install(TARGETS ${PROJECT_NAME}
+    ARCHIVE DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION}
+    LIBRARY DESTINATION ${CATKIN_PACKAGE_LIB_DESTINATION}
+    RUNTIME DESTINATION ${CATKIN_GLOBAL_BIN_DESTINATION}
+  )
+
+  ## Mark cpp header files for installation
+  install(DIRECTORY include/${PROJECT_NAME}/
+    DESTINATION ${CATKIN_PACKAGE_INCLUDE_DESTINATION}
+    FILES_MATCHING PATTERN "*.h"
+    PATTERN ".svn" EXCLUDE
+  )
+
+else()
+
+  install(TARGETS ${PROJECT_NAME}
+    EXPORT ${PROJECT_NAME}-targets
+    ARCHIVE DESTINATION lib
+    LIBRARY DESTINATION lib
+    RUNTIME DESTINATION bin
+  )
+
+  # Export targets
+  install(EXPORT ${PROJECT_NAME}-targets
+    FILE ${PROJECT_NAME}-targets.cmake
+    NAMESPACE ${PROJECT_NAME}::
+    DESTINATION lib/cmake/${PROJECT_NAME}
+  )
+
+  ## Mark cpp header files for installation
+  install(DIRECTORY include/${PROJECT_NAME}/
+    DESTINATION include
+    FILES_MATCHING PATTERN "*.h"
+    PATTERN ".svn" EXCLUDE
+  )
+
+  # Print configuration info
+  message(STATUS "=================================")
+  message(STATUS "Project: ${PROJECT_NAME} (Header-Only)")
+  message(STATUS "Version: ${PROJECT_VERSION}")
+  message(STATUS "C++ Standard: ${CMAKE_CXX_STANDARD}")
+  message(STATUS "Headers found:")
+  foreach(hdr ${HEADERS})
+    message(STATUS "  - ${hdr}")
+  endforeach()
+  message(STATUS "Dependencies: robot_sensor_msgs, data_convert, tf3, robot_geometry_msgs, Eigen3, Boost")
+  message(STATUS "=================================")
+endif()
+
+# ========================================================
+# Test executables
+# ========================================================
+if(EXISTS ${CMAKE_CURRENT_SOURCE_DIR}/test/test_tf2_sensor_msgs.cpp)
+  add_executable(${PROJECT_NAME}_test test/test_tf2_sensor_msgs.cpp)
+  target_include_directories(${PROJECT_NAME}_test PUBLIC 
+    ${EIGEN3_INCLUDE_DIRS}
+    ${GTEST_INCLUDE_DIRS}
+  )
+  target_link_libraries(${PROJECT_NAME}_test PRIVATE 
+    ${PROJECT_NAME}
+    GTest::GTest
+    GTest::Main
+    Threads::Threads
+    robot_geometry_msgs
+    tf3
+    data_convert
+  )
+endif()
--- a/robot_tf3_sensor_msgs/include/robot_tf3_sensor_msgs/tf3_sensor_msgs.h
+++ b/robot_tf3_sensor_msgs/include/robot_tf3_sensor_msgs/tf3_sensor_msgs.h
@@ -52,7 +52,11 @@ namespace tf3
 */
 template <>
 inline
-const tf3::Time& getTimestamp(const robot_sensor_msgs::PointCloud2& p) {return data_convert::convertTime(p.header.stamp);}
+const tf3::Time& getTimestamp(const robot_sensor_msgs::PointCloud2& p) {
+  static thread_local tf3::Time cached_time;
+  cached_time = data_convert::convertTime(p.header.stamp);
+  return cached_time;
+}

 /** \brief Extract a frame ID from the header of a PointCloud2 message.
 * This function is a specialization of the getFrameId template defined in tf3/convert.h.
--- a/robot_tf3_sensor_msgs/package.xml
+++ b/robot_tf3_sensor_msgs/package.xml
@@ -19,6 +19,13 @@
    
  <buildtool_depend version_gte="0.5.68">catkin</buildtool_depend>

-
-
+  <build_depend>robot_sensor_msgs</build_depend>
+  <build_depend>tf3</build_depend>
+  <build_depend>robot_geometry_msgs</build_depend>
+  <build_depend>data_convert</build_depend>
+  
+  <run_depend>robot_sensor_msgs</run_depend>
+  <run_depend>robot_geometry_msgs</run_depend>
+  <run_depend>data_convert</run_depend>
+  <run_depend>tf3</run_depend>
 </package>