ROS1与ROS2兼容层设计与实现指南

1. 项目背景与核心挑战

在机器人操作系统（ROS）的演进历程中，ROS1与ROS2的架构差异给开发者带来了显著的兼容性挑战。作为长期从事工业机器人开发的工程师，我亲历了从ROS Kinetic到ROS2 Foxy的过渡期，最头疼的问题莫过于同一套算法代码需要维护两个分支版本。这不仅增加了开发成本，更导致测试、部署环节的工作量成倍增长。

ROS1采用基于TCPROS的集中式通信机制，而ROS2基于DDS实现分布式通信，这种底层架构的变革直接影响了节点初始化、话题订阅、服务调用等核心接口。以最常见的发布/订阅模式为例，ROS1的ros::Publisher和ROS2的rclcpp::Publisher虽然功能相似，但API设计存在明显差异。更棘手的是，像tf2、nav_msgs这些基础工具包的接口也发生了不同程度的变化。

2. 兼容层设计原理

2.1 抽象接口层构建

我们设计的兼容层采用经典的适配器模式（Adapter Pattern），在ROS1/ROS2原生API之上构建统一的抽象接口。核心思路是通过预处理器宏区分编译环境，在头文件中声明通用接口：

cpp复制#ifdef USE_ROS2
#include <rclcpp/rclcpp.hpp>
#else 
#include <ros/ros.h>
#endif

class UnifiedNode {
public:
    virtual void create_publisher(...) = 0;
    virtual void create_subscriber(...) = 0;
    // 其他通用接口...
};

2.2 实现层差异化处理

针对具体实现，我们为每个ROS版本编写对应的适配器类。以话题发布为例，ROS1适配器需要处理ros::NodeHandle的初始化：

cpp复制class ROS1NodeImpl : public UnifiedNode {
    ros::NodeHandle nh_;
public:
    void create_publisher(const std::string& topic, uint32_t queue_size) override {
        pub_ = nh_.advertise<MsgType>(topic, queue_size);
    }
};

而ROS2适配器则需要考虑rclcpp::Node的生命周期管理：

cpp复制class ROS2NodeImpl : public UnifiedNode {
    rclcpp::Node::SharedPtr node_;
public:
    void create_publisher(...) override {
        pub_ = node_->create_publisher<MsgType>(topic, queue_size);
    }
};

3. 关键组件兼容方案

3.1 消息系统适配

消息定义是ROS的核心要素。我们通过以下策略实现消息兼容：

1. 使用#ifdef预处理相同结构的消息定义
2. 为字段差异较大的消息编写转换工具函数
3. 对ROS2独有的QoS策略提供默认配置

cpp复制#ifdef USE_ROS2
#include "std_msgs/msg/string.hpp"
using StringMsg = std_msgs::msg::String;
#else
#include "std_msgs/String.h"
using StringMsg = std_msgs::String;
#endif

3.2 参数系统统一

ROS1的参数服务器与ROS2的参数机制差异显著。我们封装了统一的参数访问接口：

cpp复制template <typename T>
T get_parameter(const std::string& name, T default_val) {
    #ifdef USE_ROS2
    return node_->declare_parameter(name, default_val);
    #else
    T val;
    nh_.param(name, val, default_val);
    return val;
    #endif
}

4. 构建系统配置

4.1 CMake动态配置

通过CMake的option()命令实现编译时切换：

cmake复制option(USE_ROS2 "Build with ROS2 support" OFF)

if(USE_ROS2)
    find_package(rclcpp REQUIRED)
    add_definitions(-DUSE_ROS2)
else()
    find_package(catkin REQUIRED)
endif()

4.2 依赖管理策略

针对不同版本声明对应的依赖项：

cmake复制if(USE_ROS2)
    set(DEPENDENCIES rclcpp std_msgs)
else()
    catkin_package(DEPENDS roscpp std_msgs)
endif()

5. 实战案例：兼容性导航栈

以移动机器人常用的导航栈为例，我们重构了move_base的核心组件：

1. 全局规划器适配层：

cpp复制class UnifiedGlobalPlanner {
public:
    virtual bool makePlan(...) = 0;
    // ROS1实现使用nav_core::BaseGlobalPlanner
    // ROS2实现使用nav2_core::GlobalPlanner
};

2. 代价地图接口：

cpp复制class UnifiedCostmap {
    #ifdef USE_ROS2
    std::shared_ptr<nav2_costmap_2d::Costmap2DROS> costmap_;
    #else
    costmap_2d::Costmap2DROS* costmap_;
    #endif
};

6. 调试与性能优化

6.1 跨版本调试技巧

1. 使用RCLCONSOLE替代ROS_LOG：

cpp复制#define LOG_INFO(fmt, ...) \
    RCLCPP_INFO(rclcpp::get_logger("logger"), fmt, ##__VA_ARGS__)

2. 时间系统统一处理：

cpp复制UnifiedTime now() {
    #ifdef USE_ROS2
    return node_->now();
    #else
    return ros::Time::now();
    #endif
}

6.2 性能对比数据

在Intel NUC上测试相同算法：

7. 常见问题解决方案

7.1 编译错误处理

问题1：catkin与colcon构建冲突

• 解决方案：使用独立的workspace，通过ROS_VERSION环境变量隔离

问题2：消息字段不匹配

• 典型错误：ROS1的Header.seq在ROS2中不存在
• 修复方法：添加转换层处理字段映射

7.2 运行时异常

问题1：ROS2节点无法发现ROS1节点

• 解决方法：启用ros1_bridge并正确配置DDS域ID

问题2：参数动态重配置失效

• 修复方案：为ROS2实现动态参数回调机制

8. 进阶开发建议

1. 工具链统一化：

   • 使用vscode配合ros-industrial/llvm扩展实现代码提示
   • 配置统一的clang-format规则

2. CI/CD集成：

yaml复制jobs:
  build:
    strategy:
      matrix:
        ros_distro: [noetic, foxy, humble]
    steps:
      - uses: ros-tooling/setup-ros@v0.3
        with:
          required-ros-distributions: ${{ matrix.ros_distro }}

3. 性能敏感场景优化：
   • 对ROS2启用零拷贝传输
   • 关键路径使用ROS1的shared_memory传输

这套方案在我们团队的仓储机器人项目中已验证通过，成功将代码维护成本降低60%。特别建议在新建项目中直接采用ROS2架构，对于遗留系统迁移，可以逐步替换组件的方式实现平滑过渡。