仿真后端

Relevant source files

The following files were used as context for generating this wiki page:

IB-Robot 框架提供统一的仿真抽象层，支持 Gazebo Ignition 和 MuJoCo。该架构允许相同的机器人配置和高层控制代码运行在不同物理引擎上，既支持接触丰富的操作任务（MuJoCo），也支持大规模环境导航（Gazebo）。

仿真架构

仿真系统围绕 SimBackendAdapter 抽象基类构建 src/robot_config/robot_config/launch_builders/sim_backend/base_adapter.py:22-27。该设计模式确保主启动系统（robot.launch.py）不依赖具体仿真器。

系统实体映射

下列图示把高层仿真概念连接到实现它们的具体代码实体和数据结构。

Diagram: Simulation Backend Code Mapping

        graph TD
    subgraph "Natural Language Space"
        A["Simulation Platform Selection"]
        B["Simulator Process"]
        C["Sensor Data Bridge"]
        D["Physics Scene"]
    end

    subgraph "Code Entity Space"
        A -->|"simulation.platform"| E["get_sim_backend()"]
        E --> F["SimBackendAdapter"]
        F --> G["GazeboAdapter"]
        F --> H["MujocoAdapter"]
        
        G -->|"spawns"| I["ros_gz_sim"]
        H -->|"spawns"| J["mujoco_ros2_control_node"]
        
        C --> K["sim_peripheral_bridge.py"]
        K -->|"ros_gz_bridge"| L["bridge_node"]
        
        D --> M["scene_compiler.py"]
        M -->|"generates"| N["pick_banana.xml.template"]
        M -->|"generates"| O["pick_banana.world.template"]
    end

Diagram: Data Flow and Adapter Interfaces

        graph LR
    subgraph "robot_config (Launch Logic)"
        LC["robot.launch.py"]
        BA["SimBackendAdapter"]
    end

    subgraph "Gazebo Implementation"
        GA["GazeboAdapter"]
        GZ["gz_ros2_control"]
        GB["bridge_node"]
    end

    subgraph "MuJoCo Implementation"
        MA["MujocoAdapter"]
        MS["MujocoSystemInterface"]
    end

    LC --> BA
    BA --> GA
    BA --> MA

    GA -->|"start_backend()"| GZ
    GA -->|"spawn_peripheral_bridges()"| GB
    
    MA -->|"start_backend()"| MS
    MS -->|"internal"| MA

来源:

Gazebo 后端实现

GazeboAdapter 管理 Ignition Gazebo（GZ Sim）环境的生命周期。它负责环境变量、world 文件解析和实体生成。

关键组件

  1. 环境设置: 配置 GZ_SIM_RESOURCE_PATH 和 GAZEBO_MODEL_PATH，加入 robot_description 包和 lekiwi_description（如果存在），确保 mesh 可发现 src/robot_config/robot_config/launch_builders/sim_backend/gazebo_adapter.py:68-105。

  2. 实体生成: 使用 ros_gz_sim 的 create 可执行文件，从 /robot_description 话题生成机器人 src/robot_config/robot_config/launch_builders/sim_backend/gazebo_adapter.py:175-188。

  3. 外设桥接: Gazebo 使用自己的传输层，因此需要 ros_gz_bridge 把传感器数据转换为 ROS 2 话题。

数据流：Gazebo 传感器桥接

sim_peripheral_bridge.py 脚本生成 YAML 配置，将 Gazebo 传感器路径映射到 IB-Robot 命名契约。它专门使用 parent_frame 作为 link 名称，因为 Ignition Gazebo 6 会把固定关节子 link 合并到父 link src/robot_config/robot_config/launch_builders/sim_peripheral_bridge.py:30-37。

Diagram: Gazebo Topic Mapping

        sequenceDiagram
    participant G as Gazebo Physics
    participant B as bridge_node (ros_gz_bridge)
    participant R as ROS 2 System

    G->>B: /sensor/top_camera/image
    Note over B: Uses config at /tmp/ros_gz_camera_bridge.yaml
    B->>R: /camera/top/image_raw (sensor_msgs/Image)
    B->>R: /camera/top/camera_info (sensor_msgs/CameraInfo)

来源:

MuJoCo 后端实现

MujocoAdapter 使用 mujoco_ros2_control 提供高性能仿真环境，特别适合抓取等接触丰富任务。

实现细节

物理参数调优

MuJoCo 模型针对 “pick-and-place” 任务做了稳定性调优：

来源:

场景编译器与资源

sim_models 包包含 scene_compiler，用于统一两个后端的场景定义。

场景结构：pick_banana

pick_banana 场景是操作任务的主要基准。

对象

类型

质量

作用

bluetable

static_mesh

N/A

工作台面 src/sim_models/scenes/pick_banana/layout.yaml:21-28

plate

dynamic

0.2 kg

放置目标 src/sim_models/scenes/pick_banana/layout.yaml:39-47

banana

dynamic

0.03 kg

抓取目标 src/sim_models/scenes/pick_banana/layout.yaml:49-57

Scene Compiler（scene_compiler.py）

scene_compiler.py 模块会从模板动态生成 Gazebo 和 MuJoCo 场景文件。它处理占位符替换，并在 MuJoCo 中为特定 mesh 启用基于 SDF 的非凸碰撞。

Diagram: Scene Compilation Process

        graph TD
    A["scene_name (e.g., 'pick_banana')"] --> B{"get_scene_file(scene_name, platform)"}
    B --> C["Template File (e.g., pick_banana.world.template)"]
    C --> D{Read Template Content}
    D --> E["Replace {{MESHES_DIR}} with absolute path"]
    E --> F{Is MuJoCo?}
    F -->|Yes| G["Replace {{ROBOT_XML_PATH}} (if provided)"]
    F -->|Yes| H["Write intermediate XML to /tmp"]
    H --> I{Import mujoco library?}
    I -->|Yes| J["Load XML into MjSpec"]
    J --> K["Set needsdf=True for _SDF_MESH_NAMES"]
    K --> L["Compile to MjModel"]
    L --> M["Save as /tmp/sim_models_{scene_name}.mjb"]
    I -->|"No / Error"| N["Return /tmp/sim_models_{scene_name}.xml"]
    F -->|No| O["Write to /tmp/sim_models_{scene_name}.world"]
    M --> P["Return Path to .mjb"]
    N --> P
    O --> P

_SDF_MESH_NAMES 常量 src/sim_models/sim_models/scene_compiler.py:49-54 指定 MuJoCo 中需要基于 SDF 的非凸碰撞的 mesh，例如夹爪手指（wrist_roll_follower、moving_jaw）。这能为这些复杂几何提供准确的接触物理。

来源:

物理约束

为保证交互真实，场景模板定义了特定接触参数：

来源:

仿真配置摘要

特性

Gazebo Adapter

MuJoCo Adapter

插件

gz_ros2_control-system src/robot_description/urdf/lerobot/so101/so101_gazebo.xacro:9

MujocoSystemInterface src/robot_config/robot_config/launch_builders/sim_backend/mujoco_adapter.py:9

话题桥接

ros_gz_bridge（外部）src/robot_config/robot_config/launch_builders/sim_peripheral_bridge.py:177

直接重映射 src/robot_config/robot_config/launch_builders/sim_backend/mujoco_adapter.py:88

模型格式

URDF / SDF

MJCF (XML) src/robot_description/mujoco/so101.xml.template:1

时间源

来自 Gazebo 的 /clock

ros2_control_node 内部

场景加载

pick_banana.world.template

pick_banana.xml.template

GUI 规避设置

Software GL / QT Platform src/robot_config/robot_config/launch_builders/sim_backend/gazebo_adapter.py:112-122

原生 MuJoCo Viewer

来源: