前言

在ROS2工作空间创建和使用自定义消息的比较简单,基本上上只要创建msg文件,修改cmakelists.txt和package.xml,并完成编译,就能在ROS2包中使用自定义的消息了。

但如果在一个已有的使用Cmake的Qt工程中,要集成ROS2,并使用自定义的消息,则步骤比较复杂。
基本思路还是:在ROS2中编译自定义消息,生成c++头文件,lib和dll,然后在Qt工程中引入。

创建ROS2 工作空间

新建一个目录:
E:\ROS2\antidrone_ros2
执行:
Colcon build 初始化工作空间,在目录下生成如下文件:

在这里插入图片描述
命令行如下:
在这里插入图片描述

创建ROS2 包

执行:

ros2 pkg create --build-type ament_cmake --destination-directory src antidrone_interfaces

如下图所示:
在这里插入图片描述
创建后目录结构:
在这里插入图片描述
添加编译依赖:

call "C:\Program Files\Microsoft Visual Studio\2022\Professional\VC\Auxiliary\Build\vcvarsall.bat" x64

编译

colcon build

在这里插入图片描述

新建msg文件并编译

创建msg目录
在这里插入图片描述
在msg下新建两个文件
SearchResult.msg

int32 id
int32 trackid
int32 cameraid
int32 posx
int32 posy

SearchResults.msg

SearchResult[] results

Package.XML文件加入:

  <build_depend>rosidl_default_generators</build_depend>
  <exec_depend>rosidl_default_runtime</exec_depend>
  <member_of_group>rosidl_interface_packages</member_of_group>

整个文件如下:
在这里插入图片描述
执行clocon build 编译

msg编译结果在

将install目录下的编译结果拷贝到其他的Cmake工程下。
在cmakelist文件中添加如下:

# ROS2 相关
if(NOT DEFINED Python3_EXECUTABLE)
    set(Python3_EXECUTABLE "C:/pixi_ws/.pixi/envs/default/python.exe")
endif()

set(ROS2_DIR "C:/pixi_ws/ros2-windows")
list(APPEND CMAKE_PREFIX_PATH "${ROS2_DIR}")

# 查找ROS2依赖
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED)
find_package(std_msgs REQUIRED)
find_package(geometry_msgs REQUIRED)

link_directories("C:/pixi_ws/ros2-windows/Lib")

target_link_libraries(${PROJECT_NAME}
  ${rclcpp_TARGETS}
  ${std_msgs_TARGETS}
  ${geometry_msgs_TARGETS}
)

target_include_directories(${PROJECT_NAME} PRIVATE "${CMAKE_CURRENT_SOURCE_DIR}/antidrone_interfaces/include/antidrone_interfaces")
target_link_libraries(${PROJECT_NAME} "${CMAKE_CURRENT_SOURCE_DIR}/antidrone_interfaces/lib/antidrone_interfaces__rosidl_typesupport_cpp.lib"
)

然后启动一个发布和一个订阅节点:

rclcpp::Publisher<antidrone_interfaces::msg::SearchResults>::SharedPtr publisher2_;
rclcpp::Subscription<antidrone_interfaces::msg::SearchResults>::SharedPtr test_subscription_;

publisher2_ = node_->create_publisher<antidrone_interfaces::msg::SearchResults>(
     "/antidrone/info", rclcpp::QoS(10).best_effort());

 test_subscription_ = node_->create_subscription<antidrone_interfaces::msg::SearchResults>(
     "/antidrone/info", rclcpp::QoS(10).best_effort(),
     [this](const antidrone_interfaces::msg::SearchResults::SharedPtr msg) {
         for (const auto& result : msg->results)
         {
             RCLCPP_INFO(node_->get_logger(),
                         "Received SearchResult: id=%d, trackid=%d, cameraid=%d, posx=%d, posy=%d",
                         result.id, result.trackid, result.cameraid, result.posx, result.posy);
         }
     });

    auto test_msg2 = std::make_shared<antidrone_interfaces::msg::SearchResults>();
    antidrone_interfaces::msg::SearchResult result;
    result.id = 1;
    result.trackid = 100;
    result.cameraid = cameraindex;
    result.posx = x;
    result.posy = y;
    test_msg2->results.push_back(result);

    result.id = 2;
    result.trackid = 100;
    result.cameraid = cameraindex;
    result.posx = x;
    result.posy = y;
    test_msg2->results.push_back(result);

    // 发布测试消息
publisher2_->publish(*test_msg2);

运行后,可以在控制台看到:
在这里插入图片描述
说明自定义消息在非ROS2工作空间中使用成功

Logo

聚焦RDK与具身智能,汇集机器人开发教程、开源案例和技术交流

更多推荐